nlmpc를 활용한 주차 알고리즘
while ~isDestinationReached(currentPose, xRef(end,:),0.1) % 목적지에 도달할 때까지 루프 % 현재 상태를 GPS 데이터로 업데이트 currentPose = updateVehiclePose(modelStatesSub, tftree); x = [currentPose(1); currentPose(2); currentPose(3)]; xk = x; onlinedata.ref = Xref(k:min(k+pTracking-1,Tsteps),:); [mv,onlinedata,info] = mexfcn(xk,mv,onlinedata); % NMPC를 사용하여 속도 및 각속도 계산 %[mv, info] = nlmpcmove(nlobjTracking, x0, lastMV, r..