Route prediction system
The route prediction system according to the invention includes a measurement unit to measure an area including a host vehicle and other moving vehicles, a vehicle detection unit to detect the host vehicle and at least two of the surrounding vehicles having collision possibilities on the basis of observation results observed by the observation unit, a hypothesis generation unit to generate plural hypotheses for the at least two of the surrounding vehicles detected by the vehicle detection unit to avoid collision, a likelihood calculation unit to calculate a likelihood indicating probability of occurrence of each of the plural hypotheses generated by the hypothesis generation unit, and a predicted route analysis unit to analyze, on the basis of the likelihood calculated by the likelihood calculation unit, predicted routes of the at least two of the surrounding vehicles, and output the analysis result. With such a configuration, in a case where plural vehicles may collide in future, predicted routes of the plural surrounding vehicles can be calculated without contradiction, improving performance on predicting the routes of the surrounding vehicles.
1. A route prediction system comprising:
a processor to execute a program;
a memory to store the program which, when executed by the processor, performs processes of
observing a position of a host vehicle and positions and speeds of vehicles surrounding the host vehicle,
based on results of the observation, detecting that at least two of the surrounding vehicles have a possibility of collision with each other,
generating a plurality of hypotheses for avoiding collision that may be taken by the at least two of the surrounding vehicles,
calculating a likelihood indicating probability of occurrence of each of the plurality of hypotheses,
analyzing predicted routes of the at least two of the surrounding vehicles based on the likelihood, and
outputting the analysis result; and
a display to display the predicted routes of the at least two of the surrounding vehicles, wherein
the program performs, in the process of calculating the likelihood,
a route prediction process, that is a process of predicting future positions of the at least two of the surrounding vehicles for each of the plurality of hypotheses, and
a hypothesis likelihood calculation process, that is a process of calculating the likelihood indicating the probability of occurrence of each of the plurality of hypotheses, based on the future positions of the at least two of the surrounding vehicles.
2. The route prediction system according to claim 1 , wherein the program performs, in the process of detection, processes of
detecting a lane where the host vehicle is located, based on the observation results,
tracking the surrounding vehicles based on results of the observation, and
detecting, among the tracked surrounding vehicles, the at least two of the surrounding vehicles having a possibility of collision.
3. The route prediction system according to claim 1 , wherein the program performs, in the hypothesis likelihood calculation process, a process of calculating, based on estimated speeds and estimated speed errors at a current time of the at least two surrounding vehicles, the likelihood indicating the probability of occurrence of each of the plurality of hypotheses.
4. The route prediction system according to claim 1 , wherein the program performs, in the hypothesis likelihood calculation process, a process of calculating, based on estimated accelerations and estimated acceleration errors at a current time of the at least two surrounding vehicles, the likelihood indicating the probability of occurrence of each of the plurality of hypotheses.
5. The route prediction system according to claim 1 , wherein the program performs, in the process of analyzing predicted routes, processes of selecting and outputting the predicted routes of the at least two of the surrounding vehicles based on the likelihood.
6. The route prediction system according to claim 1 , wherein the program performs, in the process of analyzing predicted routes, a predicted route confidence level process, that is a process of calculating, based on the likelihood, a predicted route confidence level indicating probability of occurrence of each of the predicted routes of the at least two of the surrounding vehicles for each of the predicted routes.
7. The route prediction system according to claim 1 , wherein the program performs, in the process of analyzing predicted routes, a predicted route confidence level process, that is a process of calculating, based on the likelihood, a confidence level of each of the plurality of hypotheses including the predicted routes of the at least two of the surrounding vehicles.
8. The route prediction system according to claim 6 , wherein the program performs, in the predicted route confidence level process, a process of calculating the predicted route confidence level for each of the predicted routes, based on a confidence level of each of the plurality of hypotheses including the predicted routes of the at least two of the surrounding vehicles calculated at a preceding time.
9. The route prediction system according to claim 7 , wherein the program performs, in the predicted route confidence level process, a process of calculating a predicted route confidence level for each of the predicted routes, based on a confidence level of each of the plurality of hypotheses including the predicted routes of the at least two of the surrounding vehicles calculated at a preceding time.
10. A route prediction system comprising:
a processor to execute a program;
a memory to store the program which, when executed by the processor, performs processes of
observing a position of a host vehicle and positions and speeds of vehicles surrounding the host vehicle,
generating, based on results of the observation, a plurality of hypotheses expressing collision avoidance models for at least two of the detected surrounding vehicles having a possibility of collision with each other, and
calculating predicted route confidence levels of predicted routes of the at least two of the surrounding vehicles corresponding to each of the plurality of hypotheses; and
a display to display, based on the predicted route confidence levels, the predicted routes and the predicted route confidence levels of the at least two of the surrounding vehicles.
11. A route prediction system comprising:
a sensor to observe a position of a host vehicle and positions and speeds of vehicles surrounding the host vehicle;
a processor to execute a program;
a memory to store the program which, when executed by the processor, performs processes of
generating, based on results of the observation by the sensor, a plurality of hypotheses expressing collision avoidance models for at least two of the detected surrounding vehicles having a possibility of collision with each other, and
calculating predicted route confidence levels of predicted routes of the at least two of the surrounding vehicles corresponding to each of the plurality of hypotheses; and
a display to display, based on the predicted route confidence levels, the predicted routes and the predicted route confidence levels of the at least two of the surrounding vehicles.
12. A route prediction system comprising processing circuitry configured
to observe a position of a host vehicle and positions and speeds of vehicles surrounding the host vehicle,
to detect the host vehicle and at least two of the surrounding vehicles having a possibility of collision with each other based on results of the observation,
to generate a plurality of hypotheses for avoiding collision that may be taken by the at least two of the surrounding vehicles,
to calculate a likelihood indicating probability of occurrence of each of the plurality of hypotheses,
to analyze predicted routes of the at least two of the surrounding vehicles based on the likelihood, and
to output the analysis result; and
a display to display the predicted routes of the at least two of the surrounding vehicles, wherein
the processing circuitry, in the calculation of the likelihood,
predicts future positions of the at least two of the surrounding vehicles for each of the plurality of hypotheses, and
calculates hypothesis likelihood indicating the probability of occurrence of each of the plurality of hypotheses, based on the future positions of the at least two of the surrounding vehicles.
13. The route prediction system according to claim 12 , wherein the processing circuitry, in detection of the vehicles,
detects a lane where the host vehicle is located, based on results of the observation,
tracks the surrounding vehicles based on results the observation, and
detects, among the tracked surrounding vehicles, the at least two of the surrounding vehicles having collision possibilities.
14. The route prediction system according to claim 12 , wherein the processing circuitry, in the calculation of the hypothesis likelihood, calculates the likelihood indicating the probability of occurrence of each of the plurality of hypotheses, based on estimated speeds and estimated speed errors at a current time of the at least two surrounding vehicles.
15. The route prediction system according to claim 12 , wherein the processing circuitry, in the calculation of the hypothesis likelihood, calculates the likelihood indicating the probability of occurrence of each of the plurality of hypotheses, based on estimated accelerations and estimated acceleration errors at a current time of the at least two surrounding vehicles.
16. The route prediction system according to claim 12 , wherein the processing circuitry, in the analysis of the predicted routes, selects and outputs the predicted routes of the at least two of the surrounding vehicles based on the likelihood.
17. The route prediction system according to claim 12 , wherein the processing circuitry, in the analysis of the predicted routes, calculates based on the likelihood, a predicted route confidence level indicating probability of occurrence of each of the predicted routes of the at least two of the surrounding vehicles for each of the predicted routes.
18. The route prediction system according to claim 12 , wherein the processing circuitry, in the analysis of the predicted routes, calculates based on the likelihood, a confidence level of each of the plurality of hypotheses including the predicted routes of the at least two of the surrounding vehicles.
19. The route prediction system according to claim 17 , wherein the processing circuitry, in the prediction of the route confidence level, calculates the predicted route confidence level for each of the predicted routes, based on a confidence level of each of the plurality of hypotheses including the predicted routes of the at least two of the surrounding vehicles calculated at a preceding time.
20. The route prediction system according to claim 18 , wherein the processing circuitry, in the prediction of the route confidence level, calculates a predicted route confidence level for each of the predicted routes, based on a confidence level of each of the plurality of hypotheses including the predicted routes of the at least two of the surrounding vehicles calculated at a preceding time.
21. A route prediction system comprising processing circuitry configured
to observe a position of a host vehicle and positions and speeds of vehicles surrounding the host vehicle,
to generate, based on results of the observation, a plurality of hypotheses expressing collision avoidance models for at least two of the detected surrounding vehicles having a possibility of collision with each other, and
to calculate predicted route confidence levels of predicted routes of the at least two of the surrounding vehicles corresponding to each of the plurality of hypotheses; and
a display to display, based on the predicted route confidence levels, the predicted routes and the predicted route confidence levels of the at least two of the surrounding vehicles.
22. A route prediction system comprising:
processing circuitry to observe a position of a host vehicle and positions and speeds of vehicles surrounding the host vehicle;
processing circuitry
to generate, based on results of the observation, a plurality of hypotheses expressing collision avoidance models for at least two of the detected surrounding vehicles having a possibility of collision with each other, and
to calculate predicted route confidence levels of predicted routes of the at least two of the surrounding vehicles corresponding to each of the plurality of hypotheses; and
a display to display, based on the predicted route confidence levels, the predicted routes and the predicted route confidence levels of the at least two of the surrounding vehicles.
23. A route prediction system comprising:
a sensor to observe a position of a host vehicle and positions and speeds of vehicles surrounding the host vehicle;
processing circuitry
to generate, based on results of the observation by the sensor, a plurality of hypotheses expressing collision avoidance models for at least two of the detected surrounding vehicles having a possibility of collision with each other, and
to calculate predicted route confidence levels of predicted routes of the at least two of the surrounding vehicles corresponding to each of the plurality of hypotheses; and
a display to display, based on the predicted route confidence levels, the predicted routes and the predicted route confidence levels of the at least two of the surrounding vehicles.