Abnormality determination device, abnormality determination method, vehicle state estimation device, and non-transitory computer-readable storage medium
In an abnormality determination device for determining presence or absence of an abnormality of a 6-axis inertial measurement sensor installed in a vehicle to detect a forward-backward acceleration, a lateral acceleration, a vertical acceleration, a roll rate, a pitch rate, and a yaw rate of the vehicle, the abnormality determination device includes: a 3-axis inertial measurement sensor that detects the forward-backward acceleration, the lateral acceleration, and the yaw rate; and an abnormality determination unit that determines presence or absence of an abnormality of the 6-axis inertial measurement sensor, wherein the abnormality determination unit determines the presence or absence of an abnormality of the 6-axis inertial measurement sensor by comparing the forward-backward acceleration, the lateral acceleration, and the yaw rate acquired by the 6-axis inertial measurement sensor with the forward-backward acceleration, the lateral acceleration, and the yaw rate acquired by the 3-axis inertial measurement sensor, respectively.
1. A vehicle control system for controlling a behavior of a vehicle to make the vehicle travel autonomously comprising:
a 6-axis inertial measurement sensor installed in the vehicle to detect a forward-backward acceleration, a lateral acceleration, a vertical acceleration, a roll rate, a pitch rate, and a yaw rate of the vehicle;
a 3-axis inertial measurement sensor that detects the forward-backward acceleration, the lateral acceleration, and the yaw rate;
a wheel speed sensor that measures a wheel speed of a wheel provided on the vehicle; and
a control device including a vehicle state estimation unit for estimating a vehicle state based on measured values acquired by a 6-axis inertial measurement sensor, an abnormality determination unit for determining an abnormality of the 6-axis inertial measurement sensor, an own vehicle position estimation unit that estimates a position of the vehicle, a travel control unit that controls the vehicle to make the vehicle travel autonomously based on the vehicle state estimated by the vehicle state estimation unit and the position of the vehicle estimated by the own vehicle position estimation unit, and a state management unit that manages the autonomous traveling level of the vehicle and allows the vehicle to travel autonomously,
wherein the vehicle state estimation unit calculates an attitude angle of the vehicle based on the measured values measured by the wheel speed sensor and the 6-axis inertial measurement sensor,
wherein the abnormality determination unit determines that there is an abnormality in the 6-axis inertial measurement sensor or the wheel speed sensor when a difference between the attitude angle calculated by the vehicle state estimation unit and a steady-state attitude angle based on a direction of gravity calculated by using the wheel speed when the vehicle travels without slipping of the wheel becomes greater than or equal to a prescribed threshold value, and
wherein the state management unit stops the autonomous traveling by the travel control unit and makes the vehicle transition to a manual driving state when the abnormality determination unit determines that there is an abnormality during the autonomous traveling of the vehicle.
2. The vehicle control system according to claim 1 , wherein the abnormality determination unit determines that there is an abnormality in the 6-axis inertial measurement sensor or the wheel speed sensor when a difference between a roll angle calculated by the vehicle state estimation unit and a roll angle of the steady-state attitude angle is greater than or equal to a prescribed threshold value or when a difference between a pitch angle calculated by the vehicle state estimation unit and a pitch angle of the steady-state attitude angle is greater than or equal to a prescribed threshold value.