Fixing catkin_package for humanoid_planner_2d