-Make some tweaks for includes, and add the base footstep planner class