O'Reilly logo

Bayesian Estimation and Tracking: A Practical Guide by Anton J. Haug

Stay ahead with the world's most comprehensive technology and business learning platform.

With Safari, you learn the way you learn best. Get unlimited access to videos, live online training, learning paths, books, tutorials, and more.

Start Free Trial

No credit card required

20.3 The Sensor Fusion Observational Model

The task is to define the functional dependence for the transformation of the state vector xn into the components of the sensor fusion observation vector zn. If the observation noise is included, this transformation can be written as

(20.2) equation

where img. The observations consist of two separate components, the IMU components and the photogrammetric components, which must be fused together to provide an asynchronous stream of observation data.

20.3.1 The Inertial Measurement Unit Component of the Observation Model

The IMU package outputs data from three orthogonal accelerometers and three orthogonal rate gyroscopes. The IMU observation vector at time tn can be written as

(20.3) equation

where zx,n, zy,n, and zz,n are the accelerations (in G's) measured by the x-forward, y-right, and z-down accelerometers, respectively, and zϕ,n, zθ,n and zϕ,n are rotation rates (in degrees) measured by the roll (counterclockwise about the x-axis), pitch (counterclockwise about the y-axis), and yaw (counterclockwise about the z-axis) rate gyroscopes, respectively. Note that since the IMU package is attached to the rigid body, it rotates as the body rotates so that the measurements ...

With Safari, you learn the way you learn best. Get unlimited access to videos, live online training, learning paths, books, interactive tutorials, and more.

Start Free Trial

No credit card required