Apparatus and method for vehicle control for autonomous driving
A vehicle control apparatus and method are disclosed. A vehicle control apparatus for autonomous driving includes a receiver configured to receive a local path based on a trajectory planner, and a controller configured to generate a steering command for lateral control of the vehicle based on the local path, generate a compensated steering command by compensating the steering command based on a movement state of a vehicle to be controlled, and control the vehicle based on the compensated steering command.
1 . A vehicle control apparatus for autonomous driving comprising:
a receiver configured to receive a local path based on a trajectory planner; and
a controller configured to:
generate a steering command for lateral control of the vehicle based on the local path;
calculate a yaw rate of the vehicle by compensating an initial yaw rate measured using an inertial measurement unit (IMU) based on a bias;
generate a compensated steering command by compensating the steering command based on a movement state of a vehicle to be controlled,
wherein the controller is configured to compensate the steering command based on a speed of the vehicle, an acceleration of the vehicle, the yaw rate of the vehicle, and a steering angle of the vehicle; and
control the vehicle based on the compensated steering command.
2 . The vehicle control apparatus of claim 1 , wherein the controller is configured to:
calculate a tire angle of the vehicle based on a wheel base of the vehicle, the speed, and the yaw rate; and
compensate the steering command based on the tire angle.
3 . The vehicle control apparatus of claim 1 , wherein the controller is configured to:
perform filtering on an initial yaw rate measured at a time point at which the vehicle stops; and
determine the bias based on the initial yaw rate subjected to the filtering.
4 . The vehicle control apparatus of claim 1 , wherein the controller is configured to:
calculate an inverse function value by inputting the movement state to an inverse vehicle model;
calculate a disturbance value by performing filtering based on the inverse function value and the steering command; and
compensate the steering command based on the disturbance value.
5 . The vehicle control apparatus of claim 4 , wherein the inverse vehicle model is generated based on a mathematical model used to generate the steering command.
6 . The vehicle control apparatus of claim 4 , wherein the controller is configured to:
calculate the disturbance value by filtering a value obtained by subtracting the steering command, from which the disturbance value is removed, from the inverse function value; and
compensate the steering command by removing the disturbance value from the steering command.
7 . The vehicle control apparatus of claim 4 , wherein the controller is configured to calculate the disturbance value by performing low pass filtering on a value obtained by subtracting the steering command, from which the disturbance value is removed, from the inverse function value.
8 . A vehicle control method for autonomous driving, the method comprising:
receiving a local path based on a trajectory planner;
generating a steering command for lateral control of the vehicle based on the local path;
calculating a yaw rate of the vehicle by compensating an initial yaw rate measured using an inertial measurement unit (IMU) based on a bias;
generating a compensated steering command by compensating the steering command based on a movement state of a vehicle to be controlled;
controlling the vehicle based on the compensated steering command; and
wherein the generating of the compensated steering command comprises compensating the steering command based on a speed of the vehicle, an acceleration of the vehicle, the yaw rate of the vehicle, and a steering angle of the vehicle.
9 . The method of claim 8 , wherein the compensating of the steering command comprises:
calculating a tire angle of the vehicle based on a wheel base of the vehicle, the speed, and the yaw rate; and
compensating the steering command based on the tire angle.
10 . The method of claim 8 , wherein the calculating of the yaw rate comprises:
performing filtering on the initial yaw rate measured at a time point at which the vehicle stops; and
determining the bias based on the initial yaw rate subjected to the filtering.
11 . The method of claim 8 , wherein the generating of the compensated steering command comprises:
calculating an inverse function value by inputting the movement state to an inverse vehicle model;
calculating a disturbance value by performing filtering based on the inverse function value and the steering command; and
compensating the steering command based on the disturbance value.
12 . The method of claim 11 , wherein the inverse vehicle model is generated based on a mathematical model used to generate the steering command.
13 . The method of claim 11 , wherein the calculating of the disturbance value comprises calculating the disturbance value by filtering a value obtained by subtracting the steering command, from which the disturbance value is removed, from the inverse function value, and
wherein the compensating of the steering command based on the disturbance value comprises compensating the steering command by removing the disturbance value from the steering command.
14 . The method of claim 11 , wherein the calculating of the disturbance value comprises:
calculating the disturbance value by performing low pass filtering on a value obtained by subtracting the steering command, from which the disturbance value is removed, from the inverse function value.
15 . A non-transitory computer-readable storage medium storing instructions that, when executed by a processor, cause the processor to perform the method of claim 8 .