3/12/02 - 1 fundamentals of strapdown inertial and gps-aided navigation by professor dominick...
Post on 21-Dec-2015
236 views
TRANSCRIPT
3/12/02 - 1
Fundamentals of Strapdown Inertial and GPS-Aided
NavigationBy
Professor Dominick Andrisani
Purdue University, West Lafayette, IN 47907-1282
[email protected] 765-494-5135
Tactical Imagery Geopositioning Workshop
March 12, 2002
Chantilly, VA
3/12/02 - 2
•To provide a tutorial overview of inertial navigation systems (INS).
•Illustrate ideas with a 2-D navigator.•Discuss inertial sensors (simple rate gyros and linear accelerometers).•Discuss characteristic errors in the INS.
•To demonstrate the need by the INS for altitude aiding.•To show how GPS aids the INS and leads to far superior navigation accuracy.
Purposes of this talk
3/12/02 - 3
Types of Inertial Navigation Systems (INS)
Inertial Platform based INSStrapdown INS <<(emphasized here)Aided Navigators of either type
Altitude-aidedAltitude and X-aidedHeading-aidedGPS aided
3/12/02 - 4
Inertial Platform
Ref 4.
3/12/02 - 5
Mechanization of Inertial Platform
Ref 4.
3/12/02 - 6
Strapdown INS
Ref 4.
3/12/02 - 7
Mechanization of Strapdown INS
Ref 4.
3/12/02 - 8
Properties of Platforms
AdvantagesSimpler gyros (platform rotates at small
rates, lower dynamic range).High accuracy (North and East
accelerometers do not see a component of gravity).
Self alignment by gyro compassing.Sensor calibration by platform rotations.
DisadvantagesComplexity and cost.Gimbal magnetics (torquers must not leak
magnetic flux).Reliability (bearings and slip rings tend to
wear).
3/12/02 - 9
Properties of Strapdown Systems
AdvantagesSimple structure, low cost.More rugged and lighter.Reliability (no gimbal magnetics, no slip
rings, no bearings, electronics more reliable then machinery).Disadvantages
More difficult to align.More difficult to calibrate.Motion induced errors which can only be
partly compensated for.Accelerometer errors (each accelerometer
may feel 1 g from gravity).Requires a computer that can perform
coordinate rotations in <.01 sec).
3/12/02 - 10
Simple Example: Two Dimensional Motion
Xb
Zb
XNED
ZNED
North Pole
South Pole
Yb=YNED.
XNED is northerlyYNED is easterlyZNED is down
Xb, Yb, and Zb
are body fixed
Pitch angle
3/12/02 - 11
Equations of Motion of the Aircraft
ddt=vx/(Ro+h) + y
dvxdt =vxvy/(Ro+h) + fx
dvzdt =-vz2/(Ro+h) + fz + g(h)
dxdt =vx
dhdt =-vz
wherefx=fxbcos()+fzbsin()fz=-fxbsin() + fzbcos()
is pitch anglevx is velocity in northerly directionvz is velocity in down directionx is northerly positionh is altitude (positive up)
3/12/02 - 12
Inertial Sensors
Rate gyros measure the components of inertial angular rate of the aircraft in the sensitive direction of the instrument.
Linear accelerometers are used to measure the components of aircraft linear acceleration minus the components of gravity in its sensitive direction.
Newton’s Law for the aircraft isF=ma=Faero+Fthrust+mg
Accelerometer measures a-g=(Faero+Fthrust)/m=specific force
In this simple two-dimensional example, two linear accelerometers and one rate gyro are used.
3/12/02 - 13
A Single Axis Angular Rate Gyro
This device measures inertial angular rate about its sensitive direction. Three of these arranged orthogonally measure the components of the angular velocity vector.
Ref 3.
3/12/02 - 14
A Simple “Open Loop” Accelerometer
This device measures specific force= a-g=(Faero+Fthrust)/m.They cannot distinguish between acceleration and gravity.
g
Ref 3.
3/12/02 - 15
Simulation of Aircraft and INS
3/12/02 - 16
Aircraft Simulation
Coriolis acceleration
Coriolis acceleration
Transport rate
3/12/02 - 17
INS Simulation
3/12/02 - 18
INS Simulation (Free integrator)
3/12/02 - 19
INS Free Integrator
The free integrator will create the following types of errors.
•For initial condition errors on x, the resulting x-position error will neither decay or grow.
•For initial condition errors on Vx, the resulting x-position errors will grow linearly with time.
3/12/02 - 20
INS Simulation (Unstable Altitude Loop)Unstable Altitude Loop
3/12/02 - 21
INS Unstable Altitude Loop
The unstable altitude loop results because errors in altitude means that there will be errors in the determination of the acceleration of gravity.
This in turn will propagate into an error in vertical acceleration which will be in the direction to drive the altitude error further from the correct value. This is an unstable mechanism since altitude error leads to greater altitude error.
3/12/02 - 22
INS Simulation (Schuler Pendulum)
Schuler Pendulum Loop
3/12/02 - 23
Schuler Pendulum Loop
The Schuler pendulum loop creates dynamic errors that oscillate with an 84 minute period.
The Schuler pendulum loop, while creating persistent oscillations, does limit the growth of errors in velocity (Vx).
3/12/02 - 24
The Schuler Pendulum
•Imagine we have a pendulum to provide a vertical reference.
•As we accelerate horizontally, the pendulum tilts, giving a false vertical indication.
•Schuler showed that this would not occur with a pendulum having a period of 84 minutes (a ball on a string with length equal to the radius of the Earth has this period).
•Correcting an inertial system so that it does not tilt when accelerated is known as Schuler tuning.
3/12/02 - 25
Error Analysis Via Linearization
Nonlinear navigator equations of motion
dX/dt=f(X,U)
Error modele=XINS-Xsimulation
u=UINS-Usimulation
Linear error equations of motion de/dt=Ae+Bu
whereA=f/X evaluated at the a
reference state X and input U)
B=f/U evaluated at the a reference state X and input U)
3/12/02 - 26
Error Analysis Via Linearization, continued
Linear error equations of motion
de/dt=Ae+Bu with initial condition e(0)
System matrix A will have 5 poles (eigenvalues), two complex poles for the Schuler Pendulum, two real poles for the altitude modes (one unstable, one stable, equal magnitude), and one pole at zero (X-pole).
The error system provides a useful way to study INS error propagation using linear methods and as the basis for designing Kalman filters to implement the various aiding techniques (e.g. altitude aiding).
3/12/02 - 27
Nonlinear Simulation of Aircraft and INS
Given three inputs, we can find all outputs including errors.
3/12/02 - 28
Results of Typical Simulation
3/12/02 - 29
Error Analysis Using Nonlinear Simulation
3/12/02 - 30
Error Analysis Using Nonlinear Simulation
Examine navigation errors when the IC on X is in error.
3/12/02 - 31
Error Due to X Initial Condition
Errors remain constant.
3/12/02 - 32
Simulation of Aircraft and INS
Examine navigation errors when the IC on H is in error.
3/12/02 - 33
Errors Due to H initial Condition
Errors are dominated by unstable altitude mode.
3/12/02 - 34
Simulation of Aircraft and INS
Examine navigation errors when IC on Vx is in error.
3/12/02 - 35
Errors Due to Vx Initial Condition
Note both Schuler oscillation and unstable altitude mode.
In the flat earth navigator the X-error would go to infinity. The Schuler pendulum mode limits the X-error.
3/12/02 - 36
INS Aiding
Velocity and position errors in the vertical channel are not bounded and can quickly become quite large.
Barometric altitude provides a measure of height above sea level, typically to an accuracy of 0.1%.
Most airborne INS operate with barometric aiding in order to bound the growth of vertical channel errors.
Altitude Aiding
Many other types of aiding are typically used
3/12/02 - 37
Simulation of Several Aided INS
3/12/02 - 38
Altitude-aided INS
Includes a steady state (constant gain) Kalman filter withgains on (Hmeasured-Hestimated).
3/12/02 - 39
Stabilized altitude errors in altitude-aided INS
3/12/02 - 40
Altitude and X-aided INS
Includes a steady state (constant gain) Kalman filter with gains on (Hmeasured-Hestimated) and (Hmeasured-Hestimated).
3/12/02 - 41
Stabilized errors in Alt. and H-aided INS
3/12/02 - 42
GPS Aiding of INS
GPS can provide aiding to an INS by providing an independent measurement of x, y, and z (altitude).
Furthermore, certain GPS implementation can provide velocity aiding by providing independent measurements of Vx, Vy and Vz.
A Kalman filter is often used to help blend the GPS measurements with the INS outputs in an optimal way.
3/12/02 - 43
Integrated INS/GPS Block Diagram
Velocity
Position
Orientation
accelerations
angular rates
3/12/02 - 44
Measurements from the GPS Receiver Model
2GPS
1GPS
wΔtdt
dc
dt
dρ
dt
dρ
wΔtc2z)(Z2y)(Y2x)(Xρ
: Platform Position
21 w,w
Δtdt
dc
Δtczy,x,ZY,X, : Satellite Position
: Pseudorange equvalent
Clock Bias (Random Walk)
: Pseudorange rate equivalent
Clock Drift (Random Walk)
: Normally Distributed Random Numbers
Pseudorange
Pseudorange Rate
3/12/02 - 45
Benefits of Integrated INS/GPS Systems
•INS gives accurate estimates of aircraft orientation.•GPS provides accurate estimates of aircraft position.•INS solutions are generally computed 100 times per second.•GPS solutions are computed once per second.•GPS in subject to jamming, INS is not.•Combining GPS and INS provides accurate and robust determination of both translational and rotational motion of the aircraft.•Both translational and rotational motion are required to locate targets on the ground from the aircraft.
3/12/02 - 46
Conclusions
Unaided INS have troublesome errors that grow with time or oscillate with an 84 minute period.
Various aiding schemes are often implemented to stabilize the INS errors.
GPS aiding of INS is an effective means to stabilize INS position and velocity errors.
Integrated INS and GPS systems are useful for determining both the position and orientation of an aircraft. Such systems are therefore helpful in locating of targets on the ground.
3/12/02 - 47
Presented at the The Motion Imagery Geolocation Workshop, SAIC Signal Hill Complex,
10/31/01 1. Dominick Andrisani, Simultaneous Estimation of Aircraft and Target Position With a Control Point
2. Ade Mulyana, Takayuki Hoshizaki, Simulation of Tightly Coupled INS/GPS Navigator
3. James Bethel, Error Propagation in Photogrammetric Geopositioning
4. Aaron Braun, Estimation Models and Precision of Target Determination
Additional Purdue Resources
Presented at the The Motion Imagery Geopositioning Review and Workshop, Purdue University, 24/25 July, 2001
1. Dominick Andrisani, Simultaneous Estimation of Aircraft and Target Position
2. Jim Bethel, Motion Imagery Modeling Study Overview
3. Jim Bethel, Data Hiding in Imagery
4. Aaron Braun, Estimation and Target Accuracy
5. Takayuki Hoshizaki and Dominick Andrisani, Aircraft Simulation Study Including Inertial Navigation System (INS) Model with Errors
6. Ade Mulyana, Platform Position Accuracy from GPS
3/12/02 - 48
1. B.H. Hafskjold, B. Jalving, P.E. Hagen, K. Grade, Integrated Camera-Based Navigation, Journal of Navigation, Volume 53, No. 2, pp. 237-245.
2. Daniel J. Biezad, Integrated Navigation and Guidance Systems, AIAA Education Series, 1999.
3. D.H. Titterton and J.L. Weston, Strapdown Inertial Navigation Technology, Peter Peregrinus, Ltd., 1997.
4. A. Lawrence, Modern Inertial Technology, Springer, 1998.
5. B. Stietler and H. Winter, Gyroscopic Instruments and Their Application to Flight Testing, AGARDograph No. 160, Vol. 15,1982.
6. A.K. Brown, High Accuracy Targeting Using a GPS-Aided Inertial Measurement Unit, ION 54th Annual Meeting, June 1998, Denver, CO.
References
3/12/02 - 49
Errors due to Theta Initial Condition
3/12/02 - 50
Errors Due to Vz Initial Condition
3/12/02 - 51
Errors Due to y Measurement Bias
3/12/02 - 52
Errors Due to Fxb Measurement Bias
3/12/02 - 53
Errors Due to Fzb Measurement Bias
3/12/02 - 54
Poles of Various systems
Poles of various systemsOLpoles = 0 0.00002389235751 + 0.00123800034072i 0.00002389235751 - 0.00123800034072i -0.00175119624036 0.00175119562360
Poles of H and X aided observer
Wn52 = 0.0110 0.0110 0.1430 0.1430 0.1430
Z52 = 0.7161 0.7161 1.0000 0.5000 0.5000
P52 = -0.0078 + 0.0076i -0.0078 - 0.0076i -0.1430 -0.0715 + 0.1238i -0.0715 - 0.1238i
Poles of H aided observer
Wn41 = 0.0129 0.0129 0.0130 0.0130
Z41 = 0.4427 0.4427 0.8973 0.8973
P41 = -0.0057 + 0.0116i -0.0057 - 0.0116i -0.0116 + 0.0057i -0.0116 - 0.0057i