https://github.com/HJReachability/ilqgames/blob/f3121d1a8e4e21500d228284b20ccba5531c74d6/src/lq_feedback_solver.cpp#L133