ocs2_sqp 0.0.0 The ocs2_hpipm package huier TODO catkin ocs2_core ocs2_mpc ocs2_oc ocs2_qp_solver blasfeo_catkin hpipm_catkin