changed waypoint system to stack move commands