System and Method for Controlling Motion of a Vehicle Technical Field

A controller and a method for controlling motion of a vehicle is provided. The method comprises acquiring motion information including a current state of the vehicle and a desired state of the vehicle, determining a combination of a steering angle of the wheels and motor forces for moving the vehicle from the current state into the desired state by using a first model of the motion of the vehicle and a second model of the motion of the chassis of the vehicle, determining a cost function of the motion of the vehicle, optimizing the cost function of the motion of the vehicle to compute a command signal for controlling the steering wheel and the plurality of electric motors, and controlling the steering angle of the wheels and the motor forces based on the command signal.