Trajectory generation and control for four wheeled omnidirectional vehicles