Professional Documents
Culture Documents
ATTITUDE Characterization
~
where w is the measured angular rate, wt is the true angular rate, k is the scale
factor error, bg is the time-varying bias, and ηg is the random Gaussian noise
(defined by the angle random walk (ARW) specification).
The error in the attitude calculation is found by integrating the difference between
the measured angular rate and the true angular rate:
t
~
θerr = ∫ (w − wt )dt (2)
0
~
Substituting the prior definition of w , and the relationship between noise integrals
and ARW yields:
For longer durations, where bias is a non-constant factor, the integral of the bias
must be handled as a variable rather than a constant. Let the variable bias be equal
to some initial bias error, bg , plus a time varying bias, b′g (t) , that will drift over time,
0
such that:
t t
′ ′
∫ bg dt = ∫ (bg + bg (t))dt = bg t + ∫ bg (t)dt (5)
0 0
0 0
Substitute this equation for non-constant bias into the original equation for attitude
error and it results in the following:
′
θerr = bg t + (ARW)√t + ∫ bg (t)dt (6)
0
It is important to note that bg will always be greater than or equal to the in-run bias
0
DYNAMIC
Building on this stationary case, now consider a situation in which the system is
rotating (about a single axis). Under these dynamic conditions, wt is non-zero, and
we will define the integral of the true angular velocity over time to be Δθ . This
yields an updated angular error of:
′
θerr = kΔθ + bg t + (ARW)√t + ∫ bg (t)dt (7)
0
Note that the scale factor error k produces an error proportional to the total angle
traversed over the time period, so oscillatory motions see a negligible contribution
from scale factor errors.
Initial attitude error (prior to start of integration): for multi-axis motion, initial
alignment errors are similar to cross-axis sensitivities.
For the case of position and velocity, we will consider a non-rotating case with
single-axis accelerations. With an understanding of fundamental kinematics, it is
known that given some acceleration vector, velocity can be found by integrating the
acceleration solution over a finite period of time. Likewise with position, it is found
by integrating the velocity solution over a finite period of time.
~
where a is the measured linear acceleration, k is the scale factor error, at is the true
linear acceleration, ba is the bias, ηa is the Gaussian random noise defined by
Velocity Random Walk (VRW), and g is gravity. The gravity terms exist because the
accelerometers measure both linear acceleration and gravity, and the pitch and roll
estimates are required to subtract out the gravity signal - leading to an attitude
dependence for the position and velocity integrals.
Assuming the attitude error is small over the integration time, a small angle
approximation reduces those terms as follows:
Following that simplification, the equation for angular error under static conditions
found in the previous section can be substituted. For the purposes of this analysis,
we assume the accelerometer bias is constant, though it is actually time-varying
like the gyro.
VELOCITY
The velocity error is found by integrating the acceleration and adding that to an
initial velocity error at the start of the integration:
t
~
Verr = Verr0 + ∫ (a − at )dt (10)
0
1 2 3
2
Verr = Verr0 + kΔV + ba t + (VRW)√t + g [ bg t + (ARW)t 2
] (13)
2 3
The final term (multiplied by g ) can be excluded when considering errors in the
vertical channel. As with the attitude integration, scale factor errors only act on the
change in velocity over the time period of interest and are negligible for oscillatory
accelerations.
POSITION
Finding position error takes this one step further by integrating the equation that
was just found for velocity error and adding it to an initial position error.
t
1 2 3
2
Perr = Perr0 + ∫ [Verr0 + kΔV + ba t + (VRW)√t + g ( bg t + (ARW)t 2
)] dt (15)
0
2 3
1 2 3 1 4 5
2 3
Perr = Perr + kΔP + Verr t + ba t + (VRW)t 2 + g[ bg t + (ARW)t 2 ] (16)
0 0
2 3 6 15
Finally, a solution for position error has been found that factors all significant
sources of error found in inertial navigation. As a reminder, this solution takes into
account a linear acceleration in the purely horizontal axis. Removing the last
component in the equation would result in a solution based on vertical linear
acceleration.
This position integration result shows why most INS systems are assessed initially
on their gyro performance, particularly the in-run bias stability: the positioning
errors proportional to the gyro bias grow as a function of time cubed!
Note that these calculations assume the gyro biases are known to the accuracy of
the in-run bias stability (which is unrealistic in a dynamic scenario), and the errors
contributed by the random walk terms represent 1-sigma standard deviations, and
could therefore be ˜3x higher. The other assumptions made (static, no initial
velocity errors) also act to make these numbers lower than would be encountered
in a real-world application. And once you reach the high-end performance of
navigation-grade inertial sensors, additional error sources not discussed here
become relevant.
VELOCITY ANGLE
RANDOM GYRO RANDOM
ACCELEROMETER
GRADE WALK BIAS WALK
BIAS (mg)
(m/s/ (deg/hr) (deg/
−− −−
√hr ) √hr )
Consumer 10 1 100 2
TABLE 3.1
GRADE/TIME 1s 10 s 60 s 10 min 1 hr
Tactical 1 mm 8 cm 5m 2 km 400 km
TABLE 3.2
PREVIOUS | NEXT