This code is based on https://kr.mathworks.com/matlabcentral/fileexchange/52069-ilqg-ddp-trajectory-optimization [2].
(1) qpOASES in Matlab
(1) open the demo_car.m
(2) run this script
ps. Maybe this code is not perfect. So, if you find some bugs in this code, plz send to me by mail ([email protected])
[1] Differential dynamic programming with nonlinear constraints (https://ieeexplore.ieee.org/document/7989086)
[2] Control-Limited Differential Dynamic Programming (https://homes.cs.washington.edu/~todorov/papers/TassaICRA14.pdf)