Closed dfridovi closed 3 years ago
https://github.com/HJReachability/ilqgames/blob/5a0554090c79b26455ad69049359478ffbcf5bd8/src/ilq_solver.cpp#L383
Pretty sure this is right...
https://github.com/HJReachability/ilqgames/blob/5a0554090c79b26455ad69049359478ffbcf5bd8/src/ilq_solver.cpp#L383