Control system, control method, and non-transitory computer readable recording medium
A control system according to the present disclosure comprises one or more memories and one or more processors. The one or more memories are configured to store observation data detected by one or more sensors installed in a moving body and an estimated position of the moving body. The one or more processors are configured to execute the following first to third processes. The first process is calculating the estimated position at a current time based on at least the estimated position calculated in a previous process and the observation data up to the current time. The second process is recalculating the estimated position at a past predetermined time. The third process is evaluating accuracy of the estimated position at the current time based on a difference between the estimated position at the past predetermined time stored in the memory and the recalculated estimated position.
1. A control system for controlling a moving body based on an estimated position of the moving body, the control system comprising:
one or more memories storing observation data based on information detected by one or more sensors installed in the moving body, and the estimated position; and
one or more processors configured to execute:
calculating the estimated position at a current time based on at least the estimated position calculated in a previous process and the observation data up to the current time;
recalculating the estimated position at a past predetermined time based on the estimated position up to the current time stored in the memory and the observation data up to the current time;
evaluating accuracy of the estimated position at the current time based on a difference between the estimated position at the past predetermined time stored in the memory and the recalculated estimated position at the past predetermined time;
generating a travel plan from the estimated position;
generating one or more control signals;
operating the moving body based on the evaluated accuracy of the estimated position, including controlling the moving body to travel along the travel plan in accordance with the one or more control signals;
recognizing an object around the moving body based on sensor detection information, and estimating an absolute position of the object by combining a calculated pre-estimated position and a relative position of the object;
correcting the pre-estimated position of the object so that the estimated absolute position of the object and an absolute position of the object coincide with each other; and
calculating a movement amount of the moving body from the estimated position based on a steering angle and a moving body speed, and calculating the pre-estimated position based on the movement amount.
2. The control system according to claim 1 , wherein
the evaluating accuracy of the estimated position at the current time includes determining that the estimated position at the current time is decrease in accuracy when a magnitude of the difference exceeds a first threshold, and
the one or more processors are further configured to execute performing an emergency control corresponding to the magnitude of the difference when it is determined that the estimated position at the current time is decrease in accuracy.
3. The control system according to claim 2 , wherein
the emergency control includes:
a first control of issuing an alarm to be executed when the magnitude of the difference exceeds the first threshold but does not a second threshold;
a second control of performing evacuation by deceleration to be executed when the magnitude of the difference exceeds the second threshold but does not a third threshold; and
a third control of performing evacuation by stop to be executed when the magnitude of the difference exceeds the third threshold.
4. A control method for controlling a moving body based on an estimated position of the moving body, the control method including:
storing and managing, in one or more memories, observation data based on information detected by one or more sensors installed in the moving body, and the estimated position;
calculating the estimated position at a current time based on at least the estimated position calculated in a previous process and the observation data up to the current time;
recalculating the estimated position at a past predetermined time based on the estimated position up to the current time stored in the memory and the observation data up to the current time;
evaluating accuracy of the estimated position at the current time based on a difference between the estimated position at the past predetermined time stored in the memory and the recalculated estimated position at the past predetermined time;
generating a travel plan from the estimated position;
generating one or more control signals; and
operating the moving body based on the evaluated accuracy of the estimated position, including controlling the moving body to travel in accordance with the one or more control signals along the travel plan, the control method further comprising:
recognizing an object around the moving body based on sensor detection information, and estimating an absolute position of the object by combining a calculated pre-estimated position and a relative position of the object;
correcting the pre-estimated position of the object so that the estimated absolute position of the object and an absolute position of the object coincide with each other; and
calculating a movement amount of the moving body from the estimated position based on a steering angle and a moving body speed, and calculating the pre-estimated position based on the movement amount.
5. A non-transitory computer readable recording medium on which a computer program for controlling a moving body based on an estimated position of the moving body, the computer program, when executed by a computer, causing the computer to execute:
storing and managing, in one or more memories, observation data based on information detected by one or more sensors installed in the moving body, and the estimated position;
calculating the estimated position at a current time based on at least the estimated position calculated in a previous process and the observation data up to the current time;
recalculating the estimated position at a past predetermined time based on the estimated position up to the current time stored in the memory and the observation data up to the current time;
evaluating accuracy of the estimated position at the current time based on a difference between the estimated position at the past predetermined time stored in the memory and the recalculated estimated position at the past predetermined time;
generating a travel plan from the estimated position;
generating one or more control signals; and
operating the moving body based on the evaluated accuracy of the estimated position, including controlling the moving body to travel in accordance with the one or more control signals along the travel plan, the computer further caused to execute:
recognizing an object around the moving body based on sensor detection information, and estimating an absolute position of the object by combining a calculated pre-estimated position and a relative position of the object;
correcting the pre-estimated position of the object so that the estimated absolute position of the object and an absolute position of the object coincide with each other; and
calculating a movement amount of the moving body from the estimated position based on a steering angle and a moving body speed, and calculating the pre-estimated position based on the movement amount.