The mrsDiffDriveWaypointLogicModel file is not running properly and does not move along waypoint.  