Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors
-
Upload
guest5fe3bb -
Category
Technology
-
view
9.422 -
download
5
description
Transcript of Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors
![Page 1: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/1.jpg)
Simultaneous Localization and Mappingfor Pedestrians
using only Foot-Mounted Inertial Sensors
Patrick Robertson, Michael Angermann, Bernhard KrachGerman Aerospace Center (DLR)B. Krach is now with EADS Germany
![Page 2: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/2.jpg)
Raw NavShoe Odometry Results
NavShoe INS produced reasonable resultsstand alone, but still unbounded error growth
NavShoe INS had larger heading slips;unbounded error begins to rise earlier
Algorithm: Extended Kalman Filter with Zero Velcocity Updates (Foxlin)
![Page 3: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/3.jpg)
State of the Art: Use Maps
Inertial sensors used indoors achieve accurate positioning when used in conjunction with maps
Krach, Robertson: WPNC 08, PLANS 08+Widyawan, Klepal, Beauregard: WPNC 08Woodman, Harle: UbiComp 2008
But what if the mapis unknown?
![Page 4: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/4.jpg)
So, could we derive a map from this?
Naïve approach:
“Transfer the raw odometry trace to a piece of wire and bend it bit by bit so that similar areas overlap”
![Page 5: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/5.jpg)
SLAM in Robotics
Simultaneous Localization and Mapping - identified by robotics community in mid ‘80s!Premise:
Localization using odometry and sensing of known landmarks is easy!
Mapping of landmarks given known location and orientation (pose) is easy!
Simultaneous Localization and Mapping is hard!
![Page 6: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/6.jpg)
What about SLAM for Humans?Human pedestrians are not robots but share some similarities with them
Visual sensors (eyes)'Odometry' (in humans: sensed by proprioception)Path and planning and execution
In humans, we usually have little or no direct 'access' to most of these senses and functionsOur central assumption:
The pedestrian is able to actively control motion without violating physical constraints (i.e. walls, etc)
![Page 7: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/7.jpg)
A Person Processes Numerous Visual Inputs
![Page 8: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/8.jpg)
P
U
Zu E
Int
Vis
Map
Visual information„what the person sees“
Intention„what the person wants to do“
Error states of the odometry
U: Actual step taken (pose change vector)
PoseP
U
Zu E
Int
Vis
P
U
Zu E
Int
Vis
Time k-1 Time k Time k+1
MeasuredStep Zu
“Environment” = Map … constant over time
Bayesian Formulation: DBN
![Page 9: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/9.jpg)
Intuitive Explanation of the Sequential Monte Carlo Algorithm
FootSLAM lets particles, or hypotheses, explore the state space of odometry errors, like evolution of driftIn this way, every particle is trying a slightly “differently bent piece of wire”Particles are weighted by their “compatibility” with
their individual mapoptional sensor readings, such as GPS, magnetometer
We can show that this is optimal in the Bayesian sense!
![Page 10: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/10.jpg)
Experiments and Results
Measurement data taken from a pedestrian wearing a foot mounted IMU
Two scenarios:Indoor onlyOutdoor – indoor - outdoor sequence
![Page 11: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/11.jpg)
Video
See
http://www.kn-s.dlr.de/indoornav
![Page 12: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/12.jpg)
Resulting Maps
![Page 13: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/13.jpg)
Resulting Maps
![Page 14: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/14.jpg)
Relative Position Accuracy - Indoors No Scale Adaptation was Performed
![Page 15: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/15.jpg)
Outdoor-Indoor-Outdoor
![Page 16: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/16.jpg)
Concluding NotesFootSLAM effectively bounds the otherwise unbounded error growth without the need for pre-existing maps!
FootSLAM (like all forms of SLAM) is inherently invariant to rotation, translation and scale
In mixed scenarios, the resulting maps are globally and precisely anchored using GPS
Our future work:Map building with multiple users; “crowdsourcing” collaborative mapping
Movies: http://www.kn-s.dlr.de/indoornav/
![Page 17: Simultaneous Localization and Mappingfor Pedestrians using only Foot-Mounted Inertial Sensors](https://reader033.fdocuments.net/reader033/viewer/2022052411/556878b9d8b42a3b7b8b4fdd/html5/thumbnails/17.jpg)
Thank you!
Movies: http://www.kn-s.dlr.de/indoornav/