Motion_planning_mobile_robot ROS c++ code for mobile robot TODO convex optimazition for swarm basic framework for trajectory/motion planning final project