Robust Mpc Based Motion Planning And Control Of Autonomous Ground Vehicles