ocs2_ipm 0.0.0 The ocs2_ipm package Sotaro Katayama BSD-3 catkin ocs2_core ocs2_mpc ocs2_oc blasfeo_catkin hpipm_catkin ocs2_qp_solver