ocs2_slp 0.0.0 A numerical implementation of a first order primal-dual MPC basee on PIPG. Farbod Farshidian Zhengyu Fu BSD3 catkin ocs2_core ocs2_mpc ocs2_oc ocs2_qp_solver