Beruflich Dokumente
Kultur Dokumente
Accelerometer
Gyroscope
Magnetometer
Inertial Measurement Unit (IMU)
Accelerometer
Gyroscope
Magnetometer
Inertial Measurement Unit (IMU)
Accelerometer
Gyroscope
Magnetometer
IMU 3D
Data Motion Trajectory
Tracking
Algorithm
IMU 3D
Data Motion Trajectory
Tracking
Algorithm
IMU 3D
Data Motion Trajectory
Tracking
Algorithm
• Rotation is a function
0 90° 0
Y: X:
1 −1 1
𝑅𝑜𝑡 90° = = Y:
0
1
X:
0
Map
Initial Location
3D
Algorithm
IMU = Accel + Gyro + Mag Trajectory
Let’s Understand the Inputs
𝑥0 𝑦0 𝑧0 𝑇
Initial Location
Algorithm
IMU = Accel + Gyro + Mag
𝑥0 𝑦0 𝑧0 𝑇
Initial Location ? 𝑥𝑡
Algorithm 𝑦𝑡
IMU = Accel + Gyro + Mag
𝑧𝑡
One possibility is:
𝑥0 𝑦0 𝑧0 𝑇
Initial Location 𝑥0 𝑡 𝑥𝑡
𝑦0 + ඵ 𝐴𝑐𝑐𝑒𝑙. 𝑑𝑡 2 𝑦𝑡
Accel., Gyro., Mag.
IMU 𝑧0 0 𝑧𝑡
𝑎𝑥
But there is one BIG problem: Accel. = 𝑎𝑦 is in local reference frame
𝑎𝑧
𝑎𝑥
But there is one BIG problem: Accel. = 𝑎𝑦 is in local reference frame
𝑎𝑧
𝑎𝑥
But there is one BIG problem: Accel. = 𝑎𝑦 is in local reference frame
𝑎𝑧
As an analogy
New Delhi Airport What is Map
- Frontwards
3D
- Rightwards
Accelerating Trajectory
- Upwards
𝑎𝑥 : Frontwards w.r.t. the earth?
𝑎𝑦 : Rightwards
𝑎𝑧 : Upwards
This makes orientation necessary
This makes orientation necessary
Up
Right
This makes orientation necessary
Up: Vertical
Front: North
Right: East
So, how will orientation solve the problem?
What we need to do is:
Initial Location 𝑥𝑡
Accel. Accel. + 𝑦𝑡
Gyro. 3D IMU ඵ 𝑧𝑡
IMU (Local) 𝑡
Mag. Orient. (Global)
Gravity Downward
So how to get 3D orientation?
My orientation
North Frontward
So is Gravity + North enough to get 3D Orientation?
Time
Rely mostly on Rely mostly on ……
gravity + North gyro integration
Time
• Use magnetometer as our main anchor
• Joint estimation of orientation and location
What does MUSE do?
MUSE = Estimate 3D Orientation even for moving object
Time
• Use magnetometer as our main anchor
• Joint estimation of orientation and location
Earth’s North Pole
Z: Up
X: East
North
Horizontal Plane
Main Anchor
Magnetic Field Direction
Earth’s Magnetic Field as Main Anchor
Three questions:
Three questions:
[Local] [Local]
X: Right X: Right
𝒗𝑚𝑒𝑎𝑠𝑢𝑟𝑒 𝒗𝑖𝑛𝑓𝑒𝑟
[Local] [Local]
X: Right X: Right
𝒗𝑚𝑒𝑎𝑠𝑢𝑟𝑒 and 𝒗𝑖𝑛𝑓𝑒𝑟 are equal, if our orientation is estimated perfectly …
𝒗𝑚𝑒𝑎𝑠𝑢𝑟𝑒 𝒗𝑖𝑛𝑓𝑒𝑟
Z: Outward Y: Front
[Local]
X: Right
𝒗𝑚𝑒𝑎𝑠𝑢𝑟𝑒
𝒗𝑖𝑛𝑓𝑒𝑟
Z: Outward Y: Front
∆𝑜𝑟𝑖𝑒𝑛𝑡
[Local]
X: Right
𝒗𝑚𝑒𝑎𝑠𝑢𝑟𝑒
𝒗𝑖𝑛𝑓𝑒𝑟
Z: Outward Y: Front
∆𝑜𝑟𝑖𝑒𝑛𝑡
[Local]
X: Right
𝒗𝑚𝑒𝑎𝑠𝑢𝑟𝑒
𝒗𝑖𝑛𝑓𝑒𝑟
Three questions:
Ground Truth: Periodically bringing the phone to the same orientation, and excluding
those moments from calibration opportunities
Natural Activities
A Sample Trace
OK, we have 3D Orientation now… how to estimate location?
OK, we have 3D Orientation now… how to estimate location?
Initial Location 𝑥𝑡
Accel. Accel. + 𝑦𝑡
Gyro. 3D IMU ඵ 𝑧𝑡
IMU (Local) 𝑡
Mag. Orient. (Global)
OK, we have 3D Orientation now… how to estimate location?
Initial Location 𝑥𝑡
Accel. Accel. + 𝑦𝑡
Gyro. 3D IMU ඵ 𝑧𝑡
IMU (Local) 𝑡
Mag. Orient. (Global)
Localization impossible if
accelerometer has any noise … why?
Motion models can bound location error
Initial Location 𝑥𝑡
Accel. Accel. + 𝑦𝑡
Gyro. 3D IMU ඵ 𝑧𝑡
IMU (Local) 𝑡
Mag. Orient. (Global)
Motion models can bound location error
Initial Location 𝑥𝑡
Accel. Accel. + 𝑦𝑡
Gyro. 3D IMU ඵ 𝑧𝑡
IMU (Local) 𝑡
Mag. Orient. (Global)
Initial Location 𝑥𝑡
Accel. Accel. + 𝑦𝑡
Gyro. 3D IMU ඵ 𝑧𝑡
IMU (Local) 𝑡
Mag. Orient. (Global)
Initial Location 𝑥𝑡
Accel. Accel. + 𝑦𝑡
Gyro. 3D IMU ඵ 𝑧𝑡
IMU (Local) 𝑡
Mag. Orient. (Global)
Initial Location 𝑥𝑡
Accel. Accel. + 𝑦𝑡
Gyro. 3D IMU ඵ 𝑧𝑡
IMU (Local) 𝑡
Mag. Orient. (Global)
Fits motion
model the best
(cm)
Motion model breaks
Conclusion
Conventional Systems This paper
Use magnetometer as
Orientation
a new “gravity” sensor
Joint estimation of
orientation and location
Location