-Add the Footstep planner code to the plugin project