finalized MotionSimulator and RoutePlanner