System diagnosis in autonomous driving
A lane controller system installed on a vehicle may include components for self-diagnosing malfunctions on the vehicle. The system may include a desired path generator for generating a desired path that keeps the vehicle within a road lane; a steering controller for providing steering a steering correction to keep the vehicle within the road lane; a vehicle state estimator for estimating the state of the vehicle; a lane marking detector for detecting position of road lane markings; a path predictor for predicting a path actively followed by the vehicle; a virtual dynamics module for modeling the anticipated path of the vehicle following input of the steering controller; a comparer that compares the results of actual steering corrections applied with those predicted by the virtual dynamics module, and a diagnostic system that determines a root cause of malfunctions, based on the comparison by the comparer.
1. A diagnostic, autonomous driving system comprising:
a lane controller system configured to:
receive a steering command,
simultaneously apply the steering command to a steering controller and a virtual dynamics module configured to generate corresponding, at least one virtual vehicle dynamics directly from the steering command,
capture at least one vehicle dynamic corresponding to the virtual vehicle dynamic during travel on a travel path resulting from the steering command, and initiate corrective action responsively to an average threshold disparity between the vehicle dynamics and the virtual vehicle dynamic; and
a diagnostic system configured to identify a steering system malfunction responsively to detection of the average threshold disparity between the vehicle dynamic and the virtual vehicle dynamic wherein the steering system malfunction includes electrical-power-steering torque imbalance.
2. The diagnostic, autonomous driving system of claim 1 , wherein the steering system malfunction further includes wheel misalignment.
3. The diagnostic, autonomous driving system of claim 1 , wherein the steering system malfunction further includes under pressured tires.
4. The diagnostic, autonomous driving system of claim 1 , wherein the at least one vehicle dynamics is selected from the group consisting of steering angle, steering torque, steering direction, angular acceleration, linear acceleration, yaw-rate, velocity, speed and wheel rotation.
5. The diagnostic, autonomous driving system of claim 1 , wherein the lane controller system includes a link to at least one vehicle dynamics measurement device selected from the group consisting of an accelerometer, a speedometer, a wheel speed sensor, and an inertial measurement unit (IMU).
6. The diagnostic, autonomous driving system of claim 1 , wherein the diagnostic system is further configured to issue a warning responsibly to detection of a steering system.
7. A diagnostic method in autonomous driving comprising:
applying simultaneously a steering command received from an autonomous steering system to both a steering controller and a virtual dynamics module, the virtual dynamics module configured to generate at least one virtual vehicle dynamics of a predicted path resulting from the steering command;
capturing at least one vehicle dynamic during travel on a travel path resulting from the steering command;
initiating corrective action responsively to an average threshold disparity between the vehicle dynamics and the corresponding virtual vehicle dynamics; and
identifying a steering system malfunction responsively to the average threshold disparity between the vehicle dynamics and the virtual vehicle dynamics wherein the steering system malfunction includes electrical-power-steering torque imbalance.
8. The diagnostic method of claim 7 , wherein the at least one vehicle dynamics are selected from the group consisting of steering angle, steering torque, steering direction, angular acceleration, linear acceleration, yaw-rate, velocity, speed and wheel rotation.
9. The diagnostic method of claim 7 , wherein the steering system malfunction further includes wheel misalignment.
10. The diagnostic method of claim 7 , wherein the steering system malfunction further includes under pressured tires.
11. The diagnostic method of claim 7 , further comprising issuing a warning responsively to detection of a steering system malfunction.