Vehicle control system, vehicle control method, and computer-readable medium
When an abnormality is detected in a generating function of a first target trajectory included in a calculation unit that generates the first target trajectory, failover processing is performed to switch a basic target trajectory used to generate a final target trajectory from the first target trajectory to a second target trajectory. In the failover processing, the first target trajectory generated before the detection of the abnormality of the generating function is updated based on an estimated movement amount of the vehicle during the failover processing. Then, a position where at least the target position of the second target trajectory generated after the detection of the abnormality and the target position of the first target trajectory after the update match is set as a switchover position of the basic target trajectory.
1 . A system for controlling a vehicle that performs autonomous driving, comprising:
a first calculation unit configured to generate a first target trajectory in the autonomous driving;
a second calculation unit configured to generate a second target trajectory in the autonomous driving;
a management unit configured to manage the first and second calculation units and to generate a final target trajectory in the autonomous driving; and
a control unit configured to perform autonomous driving control of the vehicle based on the final target trajectory,
wherein the first, second and final target trajectories are composed of a set of a target position and target speed of the vehicle, respectively,
wherein the management unit is further configured to:
generate the final target trajectory using the first target trajectory when a generating function of the first target trajectory in the first calculation unit is normal; and
perform failover processing of switching a basic target trajectory used for generating the final target trajectory from the first target trajectory to the second target trajectory when an abnormality of the generating function is detected,
wherein the management unit is further configured to:
estimate a movement amount of the vehicle during the failover processing based on status information of the vehicle before the detection of the abnormality and final information of the first target trajectory generated before the detection of the abnormality;
calculate an updated target position and an updated target speed of the vehicle by updating the first target trajectory constituting the final information based on the estimated movement amount of the vehicle;
compare a first set indicating a set of the updated target position and the updated target speed with a second set indicating a set of the target position and the target speed constituting the second target trajectory generated after the detection of the abnormality; and
set a position where at least information of the target position matches in the first and second sets as a switchover position of the basic target trajectory.
2 . The system according to claim 1 ,
wherein the management unit is configured to, in the failover processing, set a position where both pieces of information of target position and target speed coincide with each other in the first and second sets to the switchover position of the basic target trajectory.
3 . The system according to claim 1 ,
wherein the second calculation unit is configured to:
wait for generation of the second target trajectory when the generating function of the first target trajectory is normal;
start generation of the second target trajectory after the detection of abnormality; and
perform an initial generation of the second target trajectory after the detection of abnormality based on the final information.
4 . The system according to claim 1 ,
wherein the management unit is configured to calculate an updated target position and an updated target speed of the vehicle only during the failover processing.
5 . The system according to claim 1 ,
wherein the management unit is configured to transmit information of an updated target position and an updated target speed calculated during the failover processing to the second calculation unit, and
wherein, when receiving the information of the updated target position and the updated target speed calculated during the failover processing, the second calculation unit is configured to update the second target trajectory generated before the information of the updated target position and the updated target speed is received based on the received information of the updated target position and the updated target speed.
6 . A method for controlling a vehicle for autonomous driving, the method comprising:
generating a first target trajectory in the autonomous driving;
generating a second target trajectory in the autonomous driving;
generating a final target trajectory in the autonomous driving; and
performing autonomous driving control of the vehicle based on the final target trajectory,
wherein the first, second and final target trajectories are composed of a set of a target position and target speed of the vehicle, respectively,
wherein, when a generating function of the first target trajectory included in a calculation unit that generates the first target trajectory is normal, the final target trajectory is generated using the first target trajectory,
wherein, when an abnormality of the generating function is detected, failover processing is performed to switch a basic target trajectory used to generate the final target trajectory from the first target trajectory to the second target trajectory,
wherein the failover processing includes:
estimating the movement amount of the vehicle during the failover processing based on the status information of the vehicle before the detection of the abnormality and final information of the first target trajectory generated before the detection of the abnormality;
calculating an updated target position and an updated target speed of the vehicle by updating the first target trajectory constituting the final information based on the estimated movement amount of the vehicle;
comparing a first set indicating a set of the updated target position and the updated target speed with a second set indicating a set of the target position and the target speed constituting the second target trajectory generated after the detection of the abnormality; and
setting a position where at least information of the target position matches in the first and second sets as a switchover position of the basic target trajectory.
7 . A non-transitory computer-readable medium storing a program, the program causing a computer to control a vehicle in which autonomous driving is performed,
wherein the program is configured to cause a computer to execute:
generating a first target trajectory in the autonomous driving;
generating a second target trajectory in the autonomous driving;
generating a final target trajectory in the autonomous driving; and
performing autonomous driving control of the vehicle based on the final target trajectory,
wherein the first, second and final target trajectories are composed of a set of a target position and target speed of the vehicle, respectively,
wherein, when a generating function of the first target trajectory included in a calculation unit that generates the first target trajectory is normal, the final target trajectory is generated using the first target trajectory,
wherein, when an abnormality of the generating function is detected, failover processing is performed to switch the basic target trajectory used to generate the final target trajectory from the first target trajectory to the second target trajectory,
wherein the failover processing includes:
estimating the movement amount of the vehicle during the failover processing based on the status information of the vehicle before the detection of the abnormality and final information of the first target trajectory generated before the detection of the abnormality;
calculating an updated target position and an updated target speed of the vehicle by updating the first target trajectory constituting the final information based on the estimated movement amount of the vehicle;
comparing a first set indicating a set of the updated target position and the updated target speed with a second set indicating a set of the target position and the target speed constituting the second target trajectory generated after the detection of the abnormality; and
setting a position where at least information of the target position matches in the first and second sets as a switchover position of the basic target trajectory.