21
Precision Personnel Locator System Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA Inertial Filtering for Improved Position Accuracy in Challenging RF Environments 06/29/2011 JNC 2011 2296 Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

  • Upload
    others

  • View
    3

  • Download
    0

Embed Size (px)

Citation preview

Page 1: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Precision Personnel Locator System

Matthew LoweElectrical and Computer Engineering

Worcester Polytechnic InstituteWorcester, MA

Inertial Filtering for Improved Position Accuracy in Challenging RF Environments

06/29/2011

JNC 2011

2296Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 2: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Overall Project Goal

• Indoor LocalizationTracking

• For first responders• No  Pre‐installed 

Infrastructure• Rapid Deployment

2297Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 3: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Inertial RF FusionOverview

• Design an Inertial Tracking solution– Foot Mounted IMU– (Extended) Kalman Filter

• Design an RF algorithm which uses Inertial information at the signal (not range) level– (ISAR) Inverse Synthetic 

Aperture (sART) Singular value Reconciliation Tomography (ISART)

• Close the loop to update the Inertial

2298Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 4: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Inertial RF Fusion

IMUData

Fusion Algorithm

RF Data

Inertial System Model

EKF

PhysicalSystem Model

Noise Model

2299Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 5: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Physical System Model

• Newtonian Physics • Representing Rotation (Charting)

Charts•Rotation Matrix•Unit Quaternion•Euler Angle

Problems•Closure•Differential Form

ContinuousTime Linearize Discretize

2300Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 6: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Inertial RF Fusion

IMUData

Fusion Algorithm

RF Data

Inertial System Model

EKF

PhysicalSystem Model

Noise Model

2301Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 7: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Noise Model(Noise Processes)

WGN

Flicker

Bias Walk

2302Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 8: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Inertial RF Fusion

IMUData

Fusion Algorithm

RF Data

Inertial System Model

EKF

PhysicalSystem Model

Noise Model

2303Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 9: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

EKF

Physical SystemModel

IMU Noise Specifications

(From Spec Sheet)

2304Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 10: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

German Aerospace CenterPublic Data set

2305Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 11: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Inertial RF Fusion

11

IMUData

Fusion Algorithm

RF Data

Inertial System Model

EKF

PhysicalSystem Model

Noise Model

2306Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 12: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

sART

• Combines the data at the signal level

• Each point is rephasedas if the signal originated there

• Metric is computed using Singular Value Decomposition

• Each point is compared via its metric value

2307Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 13: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Religious Center

13

2308Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 14: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

ISART

• Use the benefits of both systems• Inertial is good in the 

short term• RF has no drift

• Use the inertial track to tie together multiple RF measurements

o8

2309Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 15: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Slide 14

o8 This looks like your notes, not a slide for the audience.orr, 6/22/2011

2310Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 16: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

ISART SimulationsART ISART

2311Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 17: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

ISART Real Data

Inertial  TrackISART  Track

sART Track

2312Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 18: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Conclusions

• Designed an Inertial Tracking solution– Contributed a filter creation method which was automated and based on sensor specifications

– Demonstrated validity on a publically available data set

• Design an RF algorithm which uses Inertial information– Contributed an algorithm which mitigates difficult RF environments by using inertial tracks

– Demonstrated preliminary results

2313Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 19: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Acknowledgments

• DHS S&T• Analog Devices• Team members (Andrew and Jamie)• German Aerospace Center DLR

18

2314Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 20: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

PPL Workshop at WPI sponsored by DHS

• In August WPI will be hosting the 6th annual indoor location workshop

• http://www.wpi.edu/academics/ece/ppl/2011workshop.html or Google “ppl workshop”

2315Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO

Page 21: Precision Personnel Locator System · Matthew Lowe Electrical and Computer Engineering Worcester Polytechnic Institute Worcester, MA InertialFiltering for Improved Position Accuracy

Questions?

2316Joint Navigation Conference, June 27-30, 2011, Colorado Springs, CO