Improving unmanned ground vehicle navigation by exploiting virtual sensors and multisensor fusion

Abstract

This paper investigates techniques on improving navigation accuracy using multiple sensors mounted on a mobile platform and exploiting the inherent characteristic of a ground vehicle that does not move along the cross-track and off the ground, often termed nonholonomic constraints (NHC) for car-like vehicles that assume no slip or skid. The forward velocity of the vehicle is obtained using a wheel encoder. The 3D velocity vector becomes observable during the normal moving state of the vehicle by using NHC, which produces one virtual sensor. Another virtual sensor is the zero-velocity update (ZVU) condition of the vehicle; when the condition is true, the 3D velocity vector (which is zero) becomes observable. These observables were employed in an extended Kalman filter (EKF) update to limit the growth of inertial navigation system error. We designed an EKF for data fusion of inertial measurement units, global positioning systems (GPS), and motion constraints (i.e., NHC and ZVU). We analyzed the effects of utilizing these constraints on improving navigation accuracy in stationary and dynamic cases. Our proposed navigation suite provides reliable accuracy for unmanned ground vehicle applications in a GPS-denied environment (e.g., forest canopy and urban canyon).