Vehicle Dynamics Control in MAGV: Forces Estimation and Motion Planning Methods