Trajectory setting device and trajectory setting method
A trajectory setting device that sets a trajectory of a host vehicle includes a first path generation unit configured to generate a first path by assuming all obstacles around the host vehicle to be stationary obstacles, a second path generation unit configured to generate a second path when the moving obstacle is assumed to move independently, a third path generation unit configured to generate a third path when the moving obstacle is assumed to move while interacting with at least one of the other obstacles or the host vehicle, a reliability calculation unit configured to calculate reliability of the second path and reliability of the third path, and a trajectory setting unit configured to set the trajectory for traveling from the first path, the second path, and the third path based on the reliability of the second path and the reliability of the third path.
1. A trajectory setting device that sets a trajectory of a host vehicle for traveling, the trajectory setting device comprising an electronic control unit (ECU) configured to:
recognize obstacles around the host vehicle;
generate a first path of the host vehicle by assuming all of the obstacles to be stationary obstacles;
detect a moving obstacle from the obstacles;
generate a second path of the host vehicle when the moving obstacle is assumed to move independently;
generate a third path of the host vehicle when the moving obstacle is assumed to move while interacting with at least one of the other obstacles or the host vehicle;
calculate reliability of the second path and reliability of the third path; and
set the trajectory of the host vehicle for traveling from the first path, the second path, and the third path based on the reliability of the second path and the reliability of the third path.
2. The trajectory setting device according to claim 1 , wherein:
when the reliability of the third path is higher than or equal to a third reliability threshold, the ECU is configured to set the trajectory of the host vehicle for traveling from the third path;
when the reliability of the third path is lower than the third reliability threshold, and the reliability of the second path is higher than or equal to a second reliability threshold, the ECU is configured to set the trajectory of the host vehicle for traveling from the second path; and
when the reliability of the third path is lower than the third reliability threshold, and the reliability of the second path is lower than the second reliability threshold, the ECU is configured to set the trajectory of the host vehicle for traveling from the first path.
3. The trajectory setting device according to claim 1 , wherein the ECU is configured to calculate the reliability of the second path based on reliability of sensing of the host vehicle and reliability of prediction of a candidate path of the moving obstacle when the moving obstacle is assumed to move independently.
4. The trajectory setting device according to claim 1 , wherein the ECU is configured to calculate the reliability of the third path based on reliability of sensing of the host vehicle and reliability of prediction of a candidate path of the moving obstacle when the moving obstacle is assumed to move while interacting with at least one of the other obstacles or the host vehicle.
5. A trajectory setting device that sets a trajectory of a host vehicle for traveling, the trajectory setting device comprising an electronic control unit (ECU) configured to:
recognize obstacles around the host vehicle;
detect a moving obstacle from the obstacles;
generate a second path of the host vehicle when the moving obstacle is assumed to move independently;
generate a third path of the host vehicle when the moving obstacle is assumed to move while interacting with at least one of the other obstacles or the host vehicle;
calculate reliability of the second path and reliability of the third path; and
set the trajectory of the host vehicle for traveling from the second path and the third path based on the reliability of the second path and the reliability of the third path.
6. A trajectory setting method of setting a trajectory of a host vehicle to avoid obstacles, the trajectory setting method comprising:
generating a first path of the host vehicle by assuming all obstacles around the host vehicle to be stationary obstacles;
generating a second path of the host vehicle when a moving obstacle detected from the obstacles is assumed to move independently;
generating a third path of the host vehicle when the moving obstacle is assumed to move while interacting with at least one of the other obstacles or the host vehicle;
calculating reliability of the second path and reliability of the third path; and
setting the trajectory of the host vehicle from the first path, the second path, and the third path based on the reliability of the second path and the reliability of the third path.
7. The trajectory setting method according to claim 6 , wherein:
in the setting of the trajectory, when the reliability of the third path is higher than or equal to a third reliability threshold, the trajectory of the host vehicle for traveling is set from the third path;
in the setting of the trajectory, when the reliability of the third path is lower than the third reliability threshold, and the reliability of the second path is higher than or equal to a second reliability threshold, the trajectory of the host vehicle for traveling is set from the second path; and
in the setting of the trajectory, when the reliability of the third path is lower than the third reliability threshold, and the reliability of the second path is lower than the second reliability threshold, the trajectory of the host vehicle for traveling is set from the first path.
8. The trajectory setting method according to claim 6 , wherein in the calculating of the reliability, the reliability of the second path is calculated based on reliability of sensing of the host vehicle and reliability of prediction of a candidate path of the moving obstacle when the moving obstacle is assumed to move independently.
9. The trajectory setting method according to claim 6 , wherein in the calculating of the reliability, the reliability of the third path is calculated based on reliability of sensing of the host vehicle and reliability of prediction of a candidate path of the moving obstacle when the moving obstacle is assumed to move while interacting with at least one of the other obstacles or the host vehicle.
10. A trajectory setting system comprising:
an actuator configured to control a host vehicle; and
an electronic control unit (ECU) programmed to:
recognize obstacles around the host vehicle,
generate a first path of the host vehicle by assuming all of the obstacles to be stationary obstacles,
detect a moving obstacle from the obstacles,
generate a second path of the host vehicle when the moving obstacle is assumed to move independently,
generate a third path of the host vehicle when the moving obstacle is assumed to move while interacting with at least one of the other obstacles or the host vehicle,
calculate reliability of the second path and reliability of the third path,
set a trajectory of the host vehicle for traveling from the first path, the second path, and the third path based on the reliability of the second path and the reliability of the third path, and
control the actuator based on the trajectory of the host vehicle for traveling.
11. A trajectory setting system comprising:
an actuator configured to control a host vehicle; and
an electronic control unit (ECU) programmed to:
recognize obstacles around the host vehicle,
detect a moving obstacle from the obstacles,
generate a second path of the host vehicle when the moving obstacle is assumed to move independently,
generate a third path of the host vehicle when the moving obstacle is assumed to move while interacting with at least one of the other obstacles or the host vehicle,
calculate reliability of the second path and reliability of the third path,
set a trajectory of the host vehicle for traveling from the second path and the third path based on the reliability of the second path and the reliability of the third path, and
control the actuator based on the trajectory of the host vehicle for traveling.