Inertial Measurement Units (IMUs) – Theory and Practice

Post on 08-Jan-2016

90 views 4 download

Tags:

description

Inertial Measurement Units (IMUs) – Theory and Practice. H.J. Sommer III, Ph.D. The Pennsylvania State University University Park, PA 16802 hjs1@psu.edu www.mne.psu.edu/sommer. Inertial Measurement Unit ?. Kinematic measurements using inertial references Attitude and magnetic heading - PowerPoint PPT Presentation

Transcript of Inertial Measurement Units (IMUs) – Theory and Practice

IMU Tutorial 10.05.12 1

H.J. Sommer III, Ph.D.The Pennsylvania State University

University Park, PA 16802hjs1@psu.edu

www.mne.psu.edu/sommer

Inertial Measurement Units(IMUs) – Theory and Practice

IMU Tutorial 10.05.12 2

Kinematic measurements using inertial references

Attitude and magnetic heading Angular velocity Acceleration

Fuse data to provide more reliable results

Inertial Measurement Unit ?

IMU Tutorial 10.05.12 3

Inertial Measurement Unit ?

14x28 mm

IMU Tutorial 10.05.12 4

Inertial Measurement Unit ?

IMU Tutorial 10.05.12 5

Inertial Measurement Unit ?

hr

s

OP

OP

P

P

P OP+P

m, JP

2O

IMU Tutorial 10.05.12 6

Inertial Measurement Unit ?

IMU Tutorial 10.05.12 7

Inertial Measurement Unit ?

IMU Tutorial 10.05.12 8

Photogrammetry Absolute location of point markers

Goniometry Relative angles across body segments

Electromagnetic digitizers 6DOF of discrete sensors

Traditional KinematicMeasurements

IMU Tutorial 10.05.12 9

Photogrammetry

IMU Tutorial 10.05.12 10

Vanguard or RightGuard?

DLT or BLT?

Lo-Cam or Hi-Cam?

Photogrammetry Quiz(for Oldtimers)

IMU Tutorial 10.05.12 11

Positive Absolute location and attitude of body

segments Multiple IR cameras with ambient lighting Automatic marker tracking No cables to subject > 100 Hz, high resolution Markerless motion capture (MMC)

Photogrammetry

IMU Tutorial 10.05.12 12

Negative Calibration relative to anatomy (joints and

mass centers) Requires finite differences for velocity and

acceleration Marker occlusion Soft tissue artifact Limited workspace in a gait lab

Photogrammetry

IMU Tutorial 10.05.12 13

Goniometry

IMU Tutorial 10.05.12 14

Positive Direct measurement of joint motion Easy to use

Negative Does not measure absolute

position/attitude Physical attachment to subject

Goniometry

IMU Tutorial 10.05.12 15

Electromagnetic Digitizers

IMU Tutorial 10.05.12 16

Positive 6 DOF for each body segment

Negative Limited workspace Cables (new wireless) Physical attachment to subject Accuracy degraded by speed

Electromagnetic Digitizers

IMU Tutorial 10.05.12 17

IMUsIntegrated Kinematic Sensor (IKS) Wu and Ladin, 1993

IMU Tutorial 10.05.12 18

Attitude relative to gravity vector Magnetic heading Rotational velocity Translational acceleration

IMUs

IMU Tutorial 10.05.12 19

Positive Absolute attitude of body segments Direct measurement of angular velocity Direct measurement of acceleration No marker occlusion Large work space in unstructured

environment

IMUs

IMU Tutorial 10.05.12 20

Negative Does not provide absolute location,

translational velocity or rotational acceleration

Calibration relative to anatomy Soft tissue artifact Data communication < 100 Hz, medium resolution

IMUs

IMU Tutorial 10.05.12 21

Vehicle navigation Intercontinental ballistic missiles (ICBM) Nuclear submarines Cruise missiles

MicroElectroMechanical Systems (MEMS) Automotive Consumer products

History of IMUs

IMU Tutorial 10.05.12 22

Automotive Accelerometers to deploy airbags Vehicle roll handling

MEMS IMUs - Automotive

IMU Tutorial 10.05.12 23

Games (WiiMote) PDA (iPhone) Camera stabilization Hard disks

MEMS IMUs – Consumer Products

IMU Tutorial 10.05.12 24

MEMS Fabrication

IMU Tutorial 10.05.12 25

MEMS Comb Sensor/Drive

IMU Tutorial 10.05.12 26

acceleration

gravity

MEMS accelerometer(proof mass)

IMU Tutorial 10.05.12 27

MEMS accelerometer

IMU Tutorial 10.05.12 28

MEMS gyro (tuning fork)

IMU Tutorial 10.05.12 29

MEMS magnetometer (magnetoresistive)

IMU Tutorial 10.05.12 30

Signal Analog voltage (0 to 3V) Fixed frequency, variable duty cycle Digital (internal A/D converter)

Bandwidth < 150 Hz

MEMS IMU Outputs

IMU Tutorial 10.05.12 31

Biaxial accelerometer Uniaxial gyro

Two-Dimensional (2D) IMU

IMU Tutorial 10.05.12 32

Triaxial accelerometer Triaxial gyro Triaxial magnetometer

Required to determine spin about gravity vector

Three-Dimensional (3D) IMU

ax

ayaz

IMU Tutorial 10.05.12 33

Triaxial accelerometer ±3g, 300 mV/g, 550 Hz

Triaxial gyro ±300 deg/sec (dps), 3.3mV/dps, 140 Hz

Triaxial magnetometer 50 Hz

On-board CPU, serial I/O

MEMS 9DOF IMU

IMU Tutorial 10.05.12 34

Break Time

Stand upStretch

Say hello to your neighbor

IMU Tutorial 10.05.12 35

Sensor uncertainty Geometric

Rigid body Articulated model

State space Kalman filter

Data Fusion

IMU Tutorial 10.05.12 36

s = measured signal b = zero drift or bias (function of

temp) f = scale factor (function of temp) w = Gaussian white noise 2 = variance

Sensor Uncertainty

wsfb GYRO

IMU Tutorial 10.05.12 37

Nonlinearity ±1% b = 1.23 V, 0.05 degps/C° f = 300 degps/V, 0.05 %/C° = 0.035 degps/sqrt(Hz) pink noise

LSY530 gyro ±300 degps

wsfb GYRO

IMU Tutorial 10.05.12 38

Rigid Body Fusion

r/aa xCxD

axC

r

ayC

axD

ayD

C

D

Multiple IMUs per body Parallel axes Rejects gravity effects

IMU Tutorial 10.05.12 39

Articulated Model - Pendulum

2G

2G

PGmJ/sinPGgm

0sinPGgmPGmJ

pendulumsimple

axD

ayD

P

D

G

PD/singa

singPDa

xD

xD

PGPDfor0aroduniform

PGmJ

PDPGm1singa

34

xD

2G

xD

IMU Tutorial 10.05.12 40

Multiple Segment Model

1x27DR

REV

1x27

r

27x27DRrDR

REVrREV

q

q

qq

qq

6G/6RNK6G

6G26G10G/10RNK

10G10G

210G

8G/8RWR8G

8G28G9G/9RWR

9G9G

29G

7G/7REL7G

7G27G8G/8REL

8G8G

28G

6G/6RSL6G

6G26G7G/7RSL

7G7G

27G

5G/5RWA5G

5G25G6G/6RWA

6G6G

26G

4G/4RHP4G

4G24G5G/5RHP

5G5G

25G

3G/3RKN3G

3G23G4G/4RKN

4G4G

24G

2G/2RAN2G

2G22G3G/3RAN

3G3G

23G

2G/2RHL2G

2G22G

1x18REV

sAsA

sAsA

sAsA

sAsA

sAsA

sAsA

sAsA

sAsA

sA

IMU Tutorial 10.05.12 41

Uses state space model Position Velocity

Adaptive time domain filter Combines states Tracks variance-covariance Rejects zero drift

Kalman Filter

IMU Tutorial 10.05.12 42

Kalman Filter - 2D IMU

IMU Tutorial 10.05.12 43

Kalman Filter - Simplified

tt

ttt

tt

tttt

tt

toCompare

tCompute

toCompare

t/Compute

ttimeatandMeasure

IMU Tutorial 10.05.12 44

Kalman Filter – Prediction

latitude

probability

IMU Tutorial 10.05.12 45

Kalman Filter - Measurement

latitude

probability

IMU Tutorial 10.05.12 46

Kalman Filter - Correction

latitude

probability

IMU Tutorial 10.05.12 47

Kalman Filter - Prediction

latitude

probability

constant speed

fixed time

IMU Tutorial 10.05.12 48

Kalman Filter – 2D IMU

angle

probability

elmoddynamic

ttCORRPRED

IMU Tutorial 10.05.12 49

State space Include acceleration

Nonlinear state relationships ax-ay-dot versus dot

Include geometric multisegment model

Include states for multiple bodies

Kalman Filter - Extended

IMU Tutorial 10.05.12 50

Kalman Filter

kk

kkk

1k1kk

xofcovvarPtrack

vxHztsmeasuremenonbased

wxAxstateestimate

noisesensorv

matrixdynamicsensorH

noiseprocessw

matrixdynamicstateA

estimatepriorx

k

1k

1k

matrixgainadaptiveK

vofcovvarR

wofcovvarQ

k

IMU Tutorial 10.05.12 51

Kalman Filter

k

kk

k

PHKIP

xHzKxx

RHPHHPK

correction

APAP

xAx

prediction

kk

kkkkk

1TTk

Tk

1kk

IMU Tutorial 10.05.12 52

Stationary Simple attitude Simple motion Coordinated movement Inverse dynamics

Applications

IMU Tutorial 10.05.12 53

Minimal change in sensor orientation Hand/arm tremor

Extended arm, tracing spiral Triaxial accelerometer, >150 Hz

Postural sway Supracranial accelerometer Lumbar accelerometer

Stationary

IMU Tutorial 10.05.12 54

Body position during sleep Treatment for sleep apnea Triaxial accelerometer, very low sample rate Not interested in spin about gravity vector

Restless Leg Syndrome (RLS) Monitor sudden movement High frequency sample rate Interested in event itself, not characterization

Simple Attitude

IMU Tutorial 10.05.12 55

Planar lifting or reaching Simple articulated model 2D IMU provides position, velocity,

acceleration Passive manipulation or drop

Assess spasticity Compute jerk from acceleration

Simple Motion

IMU Tutorial 10.05.12 56

Basic assessment Triaxial accelerometer, >100 Hz Number of strides, timing Asymmetry of motion

Rehabilitation, prosthetic fitting

Full body motion Thirteen 9DOF IMUs Multiple segment model

Coordinated Movement

IMU Tutorial 10.05.12 57

2D Lower data throughput (3ch versus 9ch) Require sagittal and frontal IMUs Does not require magnetometers

3D Lifting or reaching most promising Difficulty in assessing absolute location of

feet

Inverse Dynamics

IMU Tutorial 10.05.12 58

Motion variables Consider alternate signals to describe

motion Number of IMUs

May require two per segment Synchronization

In-shoe pressure transducers

Practical Considerations

IMU Tutorial 10.05.12 59

Umbilical with local A/D Belt-pack data logger

SD card Belt-pack wireless

Bluetooth, longer battery life Network wireless

Dropouts, battery life

Data Transfer

IMU Tutorial 10.05.12 60

Xsens MVN Biosyn FAB NexGen Ergonomics Microstrain wireless MEMSense Sparkfun WiTilt Nintendo WiiMote

Commercial Systems