HJReachability / ilqgames

Iterative Linear-Quadratic Games!
https://hjreachability.github.io/ilqgames/
BSD 3-Clause "New" or "Revised" License
132 stars 41 forks source link

Fix use of initial state in LQ solvers #57

Closed dfridovi closed 3 years ago

dfridovi commented 3 years ago

Now, LQ solvers ought to use relative coordinates to propagate x0 (given) through the linearized dynamics and to compute costates. That is, when passed into an LQSolver.Solve() function the x0 argument on line: https://github.com/HJReachability/ilqgames/blob/f2ce1fc9c3c6e8086a16b483ef551d14789886b5/include/ilqgames/solver/lq_solver.h#L68 should be x0 - operating_point.xs[0].