exercise 4: line-based extended kalman filter for robot localization · 2017-04-25 · simulink...

14
| | Autonomous Systems Lab Timo Hinzmann, Lucas Teixeira 25.04.2017 Timo Hinzmann 1 Autonomous Mobile Robots Exercise 4: Line-based Extended Kalman Filter for Robot Localization

Upload: others

Post on 29-Mar-2020

5 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

Timo Hinzmann, Lucas Teixeira

25.04.2017Timo Hinzmann 1

Autonomous Mobile Robots

Exercise 4: Line-based Extended Kalman Filter

for Robot Localization

Page 2: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

Kalman Filter

Page 3: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

State & Covariance Prediction/Propagation

Page 4: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

State & Covariance Prediction/Propagation

Page 5: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

State & Covariance Prediction/Propagation

Page 6: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

State & Covariance Prediction/Propagation

Page 7: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

State & Covariance Prediction/Propagation

Page 8: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

State Update: Measurement Function

Page 9: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

State Update: Measurement Function

Page 10: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

State Update: Measurement Function

Page 11: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

State Update: Measurement Association

Page 12: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

State Update

Page 13: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

Final EKF solution

Page 14: Exercise 4: Line-based Extended Kalman Filter for Robot Localization · 2017-04-25 · Simulink Library SIMULIN vrep Preferences Set Path Parallel Help ENVIRONMENT ethzasl amr solution4

||Autonomous Systems Lab

V-Rep Simulation