Moving body control system and moving body control method
A moving body control system executes a localization process that estimates a position of a moving body based on sensor-detected information and feature object map information indicating a position of a feature object. The moving body control system executes driving assist control based on the estimated position of the moving body. A first range includes the estimated position of the moving body and becomes larger as reliability of the localization process becomes lower. A first future range is at least a part of an expected passing range of the first range. When an obstacle is present in the first range or the first future range, the moving body control system makes the moving body decelerate or stop. When no obstacle is present in the first range or the first future range, the moving body control system continues the driving assist control.
1 . A moving body control system for controlling a moving body,
the moving body control system comprising:
one or more processors; and
one or more memory devices configured to store feature object map information indicating a position of a feature object, wherein
the one or more processors are configured to:
recognize a feature object around the moving body based on sensor-detected information detected by an external sensor mounted on the moving body to acquire object information indicating a relative position of the recognized feature object with respect to the moving body;
execute a localization process that estimates a position of the moving body based on a comparison between a position of the recognized feature object obtained from the object information and the position of the feature object obtained from the feature object map information; and
execute driving assist control that generates a target trajectory of the moving body and controls travel of the moving body so as to follow the target trajectory based on the estimated position of the moving body,
a first range includes the estimated position of the moving body and becomes larger as reliability of the localization process becomes lower,
a first future range is at least a part of an expected passing range of the first range, and
the one or more processors are further configured to:
determine whether or not an obstacle is present in the first range or the first future range;
make the moving body decelerate or stop when the obstacle is present in the first range or the first future range; and
continue the driving assist control when no obstacle is present in the first range or the first future range.
2 . The moving body control system according to claim 1 , wherein
the one or more memory devices are further configured to store stationary object map information indicating a position of a stationary object, and
the one or more processors are further configured to:
recognize the stationary object present around the moving body as the obstacle based on the estimated position of the moving body and the stationary object map information;
determine whether or not the stationary object is present in the first range;
make the moving body decelerate or stop when the stationary object is present in the first range; and
continue the driving assist control when the stationary object is not present in the first range.
3 . The moving body control system according to claim 2 , wherein
a second range is narrower than the first range, and
the one or more processors are further configured to:
make the moving body stop when the stationary object is present in the second range; and
make the moving body decelerate when the stationary object is present in the first range and is not present in the second range.
4 . The moving body control system according to claim 1 , wherein
the first future range is a range in the expected passing range of the first range and out of a lane in which the moving body is present, and
the one or more processors are further configured to:
recognize the obstacle present around the moving body based on the sensor-detected information;
determine whether or not the obstacle is present in the first future range;
make the moving body decelerate or stop when the obstacle is present in the first future range; and
continue the driving assist control when no obstacle is present in the first future range.
5 . A moving body control method for controlling a moving body,
the moving body control method comprising:
recognizing a feature object around the moving body based on sensor-detected information detected by an external sensor mounted on the moving body to acquire object information indicating a relative position of the recognized feature object with respect to the moving body;
executing a localization process that estimates a position of the moving body based on a comparison between a position of the recognized feature object obtained from the object information and a position of a feature object obtained from feature object map information; and
executing driving assist control that generates a target trajectory of the moving body and controls travel of the moving body so as to follow the target trajectory based on the estimated position of the moving body, wherein
a first range includes the estimated position of the moving body and becomes larger as reliability of the localization process becomes lower,
a first future range is at least a part of an expected passing range of the first range, and
the moving body control method further comprises:
determining whether or not an obstacle is present in the first range or the first future range;
making the moving body decelerate or stop when the obstacle is present in the first range or the first future range; and
continuing the driving assist control when no obstacle is present in the first range or the first future range.