a ROS footsetp_planner modified by Team Sparkle