Trajectory generation device and trajectory generation method
AssigneeHonda Motor Co., Ltd.
InventorYuji Yasui
Life of this patent
Estimating the term…
Abstract
A trajectory generation device 1 determines first to third predicted trajectories by using model formulas (1) to (20) that model a trajectory of a host vehicle 3 on the basis of peripheral information of an information detection device 4, calculates a risk potential R_p_mi_vj_v_r by using the first to third predicted trajectories, and determines moving average values P_c1 to P_c3 so that the risk potential R_p_mi_vj_v_r decreases. In a case where the moving average values P_c1 and P_c2 have the same sign, the first predicted trajectory is determined while reflecting the moving average value P_c2 for correcting the second predicted trajectory.
Claims18
A trajectory generation device that generates one future trajectory of a mobile body, the trajectory generation device comprising at least one processor and a memory comprising instructions, that when executed by the at least one processor, cause the at least one processor to implement:
- a surrounding situation recognizer that recognizes a surrounding situation of the mobile body;
- a predicted trajectory generator that generates a plurality of predicted trajectories by dividing the one future trajectory of the mobile body into a plurality of trajectories as the plurality of predicted trajectories, by using a plurality of trajectory models that models a trajectory of the mobile body, on a basis of a result of recognition of the surrounding situation by the surrounding situation recognizer;
- an interference degree parameter calculator that calculates a plurality of interference degree parameters representing a degree of interference of an interference object around the mobile body with the mobile body by using the plurality of predicted trajectories;
- a correction amount determiner that determines a plurality of amounts of correction for respectively correcting the plurality of predicted trajectories to cause the degree of interference represented by the plurality of interference degree parameters to be decreased;
- and
- a controller that controls the mobile body to travel along the plurality of predicted trajectories, wherein
- the predicted trajectory generator generates the plurality of predicted trajectories by using the plurality of trajectory models and the plurality of amounts of correction on the basis of the result of recognition of the surrounding situation, and in a case where two of the amounts of correction for correcting two of the predicted trajectories adjacent to each other are determined to correct the two predicted trajectories in an identical direction, the predicted trajectory generator generates one of the predicted trajectories closer to a current position of the mobile body out of the two predicted trajectories while reflecting one of the amounts of correction for correcting one of the predicted trajectories farther from the current position of the mobile body.
A trajectory generation method for generating one future trajectory of a mobile body by a calculation processing device, the trajectory generation method comprising:
- a surrounding situation recognition step of recognizing a surrounding situation of the mobile body;
- a predicted trajectory generation step of generating a plurality of predicted trajectories by dividing the one future trajectory of the mobile body into a plurality of trajectories as the plurality of predicted trajectories, by using a plurality of trajectory models that models a trajectory of the mobile body, on a basis of a result of recognition of the surrounding situation by the surrounding situation recognition step;
- an interference degree parameter calculation step of calculating a plurality of interference degree parameters representing a degree of interference of an interference object around the mobile body with the mobile body by using the plurality of predicted trajectories;
- a correction amount determination step of determining a plurality of amounts of correction for respectively correcting the plurality of predicted trajectories to cause the degree of interference represented by the plurality of interference degree parameters to be decreased;
- and
- a controlling step of controlling the mobile body to travel along the plurality of predicted trajectories,
- executed by the calculation processing device, wherein
- in the predicted trajectory generation step, the plurality of predicted trajectories is generated by using the plurality of trajectory models and the plurality of amounts of correction on the basis of the result of recognition of the surrounding situation, and in a case where two of the amounts of correction for correcting two of the predicted trajectories adjacent to each other are determined to correct the two predicted trajectories in an identical direction, one of the predicted trajectories closer to a current position of the mobile body out of the two predicted trajectories is generated while reflecting one of the amounts of correction for correcting one of the predicted trajectories farther from the current position of the mobile body.
Dependencies are inferred from the claim text.