MapGraphics update
Updates to waypoint planner interaction and kinematic assistance