A method used to detect anomaly and estimate the state of vehicle in driving was proposed.The kinematics model of the vehicle was constructed and nonholonomic constraint conditions were added,which refer to that once the vehicle encounters the faults that could not be controlled,the constraint conditions are violated.Estimation equations of the velocity errors of the vehicle were given out to estimate the velocity errors of side and forward.So the stability of the whole vehicle could be judged by the velocity errors of the vehicle.Conclusions were validated through the vehicle experiment.This method is based on GPS/INS integrated navigation system,and can provide foundation for fault detections in unmanned autonomous vehicles.
A trajectory generator based on vehicle kinematics model was presented and an integrated navigation simulation system was designed.Considering that the tight relation between vehicle motion and topography,a new trajectory generator for vehicle was proposed for more actual simulation.Firstly,a vehicle kinematics model was built based on conversion of attitude vector in different coordinate systems.Then,the principle of common trajectory generators was analyzed.Besides,combining the vehicle kinematics model with the principle of dead reckoning,a new vehicle trajectory generator was presented,which can provide process parameters of carrier anytime and achieve simulation of typical actions of running vehicle.Moreover,IMU(inertial measurement unit) elements were simulated,including accelerometer and gyroscope.After setting up the simulation conditions,the integrated navigation simulation system was verified by final performance test.The result proves the validity and flexibility of this design.
