cs325 artificial intelligence robotics ii navigation ch 25
play

CS325 Artificial Intelligence Robotics II Navigation (Ch. 25) Dr. - PowerPoint PPT Presentation

CS325 Artificial Intelligence Robotics II Navigation (Ch. 25) Dr. Cengiz Gnay, Emory Univ. Gnay Robotics II Navigation (Ch. 25) Spring 2013 1 / 18 Spring 2013 Robots with Different Degrees of Freedom Different robots has


  1. CS325 Artificial Intelligence Robotics II – Navigation (Ch. 25) Dr. Cengiz Günay, Emory Univ. Günay Robotics II – Navigation (Ch. 25) Spring 2013 1 / 18 Spring 2013

  2. Robots with Different Degrees of Freedom Different robots has different movements and degrees of freedom: Günay Robotics II – Navigation (Ch. 25) Spring 2013 2 / 18

  3. Robots with Different Degrees of Freedom Different robots has different movements and degrees of freedom: robotic arm: only joints Günay Robotics II – Navigation (Ch. 25) Spring 2013 2 / 18

  4. Robots with Different Degrees of Freedom Different robots has different movements and degrees of freedom: robotic arm: only joints quadcopter/predator: all directions Günay Robotics II – Navigation (Ch. 25) Spring 2013 2 / 18

  5. Robots with Different Degrees of Freedom Different robots has different movements and degrees of freedom: robotic arm: only joints quadcopter/predator: all directions roomba: location + heading Günay Robotics II – Navigation (Ch. 25) Spring 2013 2 / 18

  6. Robots with Different Degrees of Freedom Different robots has different movements and degrees of freedom: robotic arm: only joints quadcopter/predator: all directions roomba: location + heading Navigate these with: particle filters: for state estimation and future prediction Günay Robotics II – Navigation (Ch. 25) Spring 2013 2 / 18

  7. Robots with Different Degrees of Freedom Different robots has different movements and degrees of freedom: robotic arm: only joints quadcopter/predator: all directions roomba: location + heading Navigate these with: particle filters: for state estimation and future prediction planning: reach target from current state Günay Robotics II – Navigation (Ch. 25) Spring 2013 2 / 18

  8. Robots with Different Degrees of Freedom Different robots has different movements and degrees of freedom: robotic arm: only joints quadcopter/predator: all directions roomba: location + heading Navigate these with: particle filters: for state estimation and future prediction planning: reach target from current state We’ll make our own self driving car :) Günay Robotics II – Navigation (Ch. 25) Spring 2013 2 / 18

  9. Entry/Exit Surveys Exit survey: Robotics I – Autonomous Robots Which parameters do you have in the dynamic state of the roomba? How can we use the dynamic state parameters to estimate the current robot state? Entry survey: Robotics II – Navigation (0.25 pts) What were the steps in the particle filter algorithm? In what task would a robot need to combine a particle filter with planning? Briefly explain their roles in at least one example. Günay Robotics II – Navigation (Ch. 25) Spring 2013 3 / 18

  10. Remember Particle Filters? Günay Robotics II – Navigation (Ch. 25) Spring 2013 4 / 18

  11. Remember Particle Filters? Remember why we needed location and heading in particles? Günay Robotics II – Navigation (Ch. 25) Spring 2013 4 / 18

  12. Localization with Particle Filters Particle filtering: weights show likelihood; pick particles, shift, and repeat. Step 1: Initialize particles from homogeneous distribution. Günay Robotics II – Navigation (Ch. 25) Spring 2013 5 / 18

  13. Localization with Particle Filters Particle filtering: weights show likelihood; pick particles, shift, and repeat. Step 2: Use sensors to estimate likely locations . Günay Robotics II – Navigation (Ch. 25) Spring 2013 5 / 18

  14. Localization with Particle Filters Particle filtering: weights show likelihood; pick particles, shift, and repeat. Step 3: Resample likely particles and predict next state . Günay Robotics II – Navigation (Ch. 25) Spring 2013 5 / 18

  15. Localization with Particle Filters Particle filtering: weights show likelihood; pick particles, shift, and repeat. Step 4: (again) Estimate location from sensors. Günay Robotics II – Navigation (Ch. 25) Spring 2013 5 / 18

  16. Localization with Particle Filters Particle filtering: weights show likelihood; pick particles, shift, and repeat. Step 5: (again) Resample and predict state from movement. Günay Robotics II – Navigation (Ch. 25) Spring 2013 5 / 18

  17. Particle Filter Algorithm S: Particle set { < x , w >, . . . } , U: Control vector (e.g., map), Z: Measure vector S ′ = Ø , η = 0 For i=1. . . n sample j ∼ { w } w/ replacement x ′ ∼ P ( x ′ | U , S j ) w ′ = P ( Z | x ′ ) η = η + w ′ S ′ = S ′ ∪ { < x ′ , w ′ > } End For i=1. . . n // Normalization step w i = 1 η w i End Günay Robotics II – Navigation (Ch. 25) Spring 2013 6 / 18

  18. Particle Filter for Finding Road Boundaries Günay Robotics II – Navigation (Ch. 25) Spring 2013 7 / 18

  19. Particle Filter for Finding Road Boundaries Particles following the white lane lines so the car knows where it is. Günay Robotics II – Navigation (Ch. 25) Spring 2013 7 / 18

  20. Particles are Like Small Cars Particle’s dynamic state to estimate next state:   x y   θ Günay Robotics II – Navigation (Ch. 25) Spring 2013 8 / 18

  21. Particles are Like Small Cars Particle’s dynamic state to estimate next state: � v   x � y &   ω θ Günay Robotics II – Navigation (Ch. 25) Spring 2013 8 / 18

  22. Particles are Like Small Cars Particle’s dynamic state to estimate next state: � v     x x ′ � y ′ y & →     ω θ θ ′ Günay Robotics II – Navigation (Ch. 25) Spring 2013 8 / 18

  23. Particles are Like Small Cars Particle’s dynamic state to estimate next state: � v     x x ′ � y ′ y & →     ω θ θ ′ Also add some noise to account for uncertainty: Günay Robotics II – Navigation (Ch. 25) Spring 2013 8 / 18

  24. Particles are Like Small Cars Particle’s dynamic state to estimate next state: � v     x x ′ � y ′ y & →     ω θ θ ′ Also add some noise to account for uncertainty: Günay Robotics II – Navigation (Ch. 25) Spring 2013 8 / 18

  25. Particles are Like Small Cars Particle’s dynamic state to estimate next state: � v     x x ′ � y ′ y & →     ω θ θ ′ Also add some noise to account for uncertainty: Günay Robotics II – Navigation (Ch. 25) Spring 2013 8 / 18

  26. Factor In Measurements Pacman particles try to stay on the road lines: Measures pattern on ground, z . Günay Robotics II – Navigation (Ch. 25) Spring 2013 9 / 18

  27. Factor In Measurements Pacman particles try to stay on the road lines: Measures pattern on ground, z . Question: Likelihood based on measurement: P ( dashes | on the line ) = 0 . 7 3 2 1 4 Günay Robotics II – Navigation (Ch. 25) Spring 2013 9 / 18

  28. Factor In Measurements Pacman particles try to stay on the road lines: Measures pattern on ground, z . Question: Likelihood based on measurement: P ( dashes | on the line ) = 0 . 7 P ( no dashes | off the line ) = 0 . 8 3 2 1 4 Günay Robotics II – Navigation (Ch. 25) Spring 2013 9 / 18

  29. Factor In Measurements Pacman particles try to stay on the road lines: Measures pattern on ground, z . Question: Likelihood based on measurement: P ( dashes | on the line ) = 0 . 7 P ( no dashes | off the line ) = 0 . 8 3 Particle weights, w , for 1 & 4? 2 1 4 Günay Robotics II – Navigation (Ch. 25) Spring 2013 9 / 18

  30. Factor In Measurements Pacman particles try to stay on the road lines: Measures pattern on ground, z . Question: Likelihood based on measurement: P ( dashes | on the line ) = 0 . 7 P ( no dashes | off the line ) = 0 . 8 3 Particle weights, w , for 1 & 4? w 1 = 0 . 7 2 1 4 Günay Robotics II – Navigation (Ch. 25) Spring 2013 9 / 18

  31. Factor In Measurements Pacman particles try to stay on the road lines: Measures pattern on ground, z . Question: Likelihood based on measurement: P ( dashes | on the line ) = 0 . 7 P ( no dashes | off the line ) = 0 . 8 3 Particle weights, w , for 1 & 4? w 1 = 0 . 7 & w 4 = 0 . 2 2 1 4 Günay Robotics II – Navigation (Ch. 25) Spring 2013 9 / 18

  32. Factor In Measurements Pacman particles try to stay on the road lines: Measures pattern on ground, z . Question: Likelihood based on measurement: P ( dashes | on the line ) = 0 . 7 P ( no dashes | off the line ) = 0 . 8 3 Particle weights, w , for 1 & 4? w 1 = 0 . 7 & w 4 = 0 . 2 2 1 (before normalization) 4 Günay Robotics II – Navigation (Ch. 25) Spring 2013 9 / 18

  33. Factor In Measurements Pacman particles try to stay on the road lines: Measures pattern on ground, z . Question: Likelihood based on measurement: P ( dashes | on the line ) = 0 . 7 P ( no dashes | off the line ) = 0 . 8 3 Particle weights, w , for 1 & 4? w 1 = 0 . 7 & w 4 = 0 . 2 2 1 (before normalization) Total = 0 . 7 + 0 . 7 + 0 . 2 + 0 . 2 = 1 . 8 4 Günay Robotics II – Navigation (Ch. 25) Spring 2013 9 / 18

Recommend


More recommend