US 12,222,724 B2
Mobile body control device, mobile body control program, and mobile body
Kazuhiro Kuno, Kariya (JP); Yutaka Watanabe, Kariya (JP); Masaki Takahashi, Yokohama (JP); Ayanori Yorozu, Yokohama (JP); and Shunichi Sekiguchi, Yokohama (JP)
Assigned to AISIN CORPORATION, Kariya (JP); and KEIO UNIVERSITY, Tokyo (JP)
Appl. No. 17/797,740
Filed by AISIN CORPORATION, Kariya (JP); and KEIO UNIVERSITY, Tokyo (JP)
PCT Filed Mar. 31, 2021, PCT No. PCT/JP2021/014011
§ 371(c)(1), (2) Date Aug. 5, 2022,
PCT Pub. No. WO2021/201163, PCT Pub. Date Oct. 7, 2021.
Claims priority of application No. 2020-064336 (JP), filed on Mar. 31, 2020.
Prior Publication US 2023/0082797 A1, Mar. 16, 2023
Int. Cl. G05D 1/00 (2024.01)
CPC G05D 1/0217 (2013.01) 6 Claims
OG exemplary drawing
 
1. A mobile body control device that controls a moving unit of a mobile body such that the mobile body moves accompanying a subject at a position ahead of the subject in a traveling direction thereof, the control device comprising:
a processor programmed to:
acquire subject information including the position and traveling direction of the subject;
process the subject information in time-series order to acquire, as an observation trajectory, a trajectory along which the subject has walked until a current time point;
acquire, from a plurality of basic trajectories which are trajectories along which a walker walks toward a plurality of different target points, each of the basic trajectories being added, along its trajectory, with an uncertainty that represents probability distribution deviating from the trajectory, the basic trajectory that matches the observation trajectory as a specific basic trajectory;
acquire from the specific basic trajectory, as a subject predicted trajectory, a trajectory along which the subject walks after the current time point so as to follow the observation trajectory;
calculate, based on the uncertainty added along the subject predicted trajectory, prediction reliability of prediction that the subject walks following the subject predicted trajectory along the subject predicted trajectory;
acquire, as a target trajectory, a trajectory formed by a target position of the mobile body set ahead of the subject in the traveling direction when it is assumed that the subject walks following the subject predicted trajectory;
generate a control command sequence using an evaluation function that uses as input the subject predicted trajectory, prediction reliability, target trajectory, and a control trajectory obtained when the mobile body moves according to the control command sequence in time-series order, the evaluation function adding a control penalty term for the control command sequence, a subject penalty term based on a distance between the subject predicted trajectory and control trajectory, and a target penalty term based on a distance between the target trajectory and control trajectory and multiplies the prediction reliability as a coefficient with the subject penalty term and target penalty term to calculate the evaluation value, the control command sequence being generated so as to minimize the evaluation value; and
control the moving unit based on the control command sequence.