1 / 29

Mapping with Known Poses *

Mapping with Known Poses *. CS5391 – AI Robotics. Agenda…. Introduction to mapping: Motivate SLAM. Mapping with known poses. Some examples. Simple counting-based mapping. MAP estimation. Why Mapping?. Maps are a fundamental requirement:

Télécharger la présentation

Mapping with Known Poses *

An Image/Link below is provided (as is) to download presentation Download Policy: Content on the Website is provided to you AS IS for your information and personal use and may not be sold / licensed / shared on other websites without getting consent from its author. Content is provided to you AS IS for your information and personal use only. Download presentation by click this link. While downloading, if for some reason you are not able to download a presentation, the publisher may have deleted the file from their server. During download, if you can't get a presentation, the file might be deleted by the publisher.


Presentation Transcript

  1. Mapping with Known Poses* CS5391 – AI Robotics Based on the slides from the book's website

  2. Agenda… • Introduction to mapping: • Motivate SLAM. • Mapping with known poses. • Some examples. • Simple counting-based mapping. • MAP estimation.

  3. Why Mapping? • Maps are a fundamental requirement: • Provides a frame of reference to humans and robots! • Maps used for localization, path-planning, activity-planning, active-sensing… • Autonomous behavior requires Simultaneous Localization And Mapping (SLAM).

  4. The General Problem of Mapping What does the environment look like?

  5. Mathematical Formulation • Formally, given the sensor data: mapping involves finding the most likely map (mode): • Finding full posterior is easier with independence assumption:

  6. Mapping is a Chicken and Egg Problem • Localization: estimate robot pose given sensor data and map. • Goal: Autonomous mobile robots that require little/no human supervision. • Challenge: simultaneously estimate robot pose and the map (SLAM). • Bootstrap off of localization and map-building with known pose.

  7. Problems in Mapping • Noise in sensing and actuation: • Extract information from noisy sensory data? • Model and account for motion error accumulation? • Ambiguity in perception: • Establish correspondence between sensor readings? • Data association: • Identify that robot is at a previously visited place? • Close the loop? • Large continuous search space: • Binary map with N grid-cells represents 2N maps!!

  8. Types of SLAM-Problems • Grid maps or scans: [Lu & Milios, 97; Gutmann, 98: Thrun 98; Burgard, 99; Konolige & Gutmann, 00; Thrun, 00; Arras, 99; Haehnel, 01;…] • Landmark-based: [Leonard et al., 98; Castelanos et al., 99: Dissanayake et al., 2001; Montemerlo et al., 2002;…

  9. Occupancy Grid Maps (Moravec and Elfes, 1985) • Environment a collection of grid cells. • Estimate the probability that a cell is occupied. • Key assumptions: • Occupancy of individual cells (m[ij]) is independent! • Robot poses are known! • Post-processing tool…

  10. Updating Occupancy Grid Maps • Idea: Update each individual cell within field-of-view using a binary Bayes filter. • Additional assumption: Map is static i.e. control commands can be neglected!!

  11. Binary Bayes Filter (revisited)… • Elegant, avoids truncation errors… • Chapter 4: Table 4.2 in textbook.

  12. Updating Occupancy Grid Maps • Use the log-odds representation. • Cross-check with equation 4.19, Chapter 4…

  13. Updating Occupancy Grid Maps • Update the map cells using theinverse sensor model: • Log-odds of occupancy of grid cell, given the current measurement and known pose. • Information about the world conditioned on measurements caused by the world. • Table 9.2 for an ad-hoc example (typo!). • Task:Section 9.3 for principled function-approximation.

  14. Adhoc Inverse Sensor Model • Incorporate factors involved in the computation of: • Factors: • Relative of robot from cell’s center-of-mass. • Width of obstacle and sensor beams. • Cells outside field-of-view: • Cells within suitable range: • Other cells:

  15. Function Approx. Inv. Sensor Model • Sampling-based approach. • Approach: • Sample a map from feasible maps: • Sample a robot pose: • Sample a measurement: • Get ground-truth occupancy value from map: • Learn predictor that minimizes error over data samples. • Use relative pose, model sensor characteristics.

  16. Incremental Updating of Occupancy Grids (Example)

  17. Recap… • Goal: simultaneously localize and mapping (SLAM). • Occupancy Grid mapping: assume known pose and independence: • Binary Bayes filter and inverse sensor models for updating individual cells. • Adhoc and Sampling-based approaches for the inverse sensor model.

  18. Resulting Map Obtained with Ultrasound Sensors

  19. Occupancy Grids: From scans to maps

  20. occupancy grid map CAD map Tech Museum, San Jose

  21. Agenda… • Introduction to mapping: • Motivate SLAM. • Mapping with known poses. • Some examples. • Simple counting-based mapping. • MAP estimation.

  22. Alternative: Simple Counting • For every cell count: • hits(i, j): no. of times a beam ended at <i, j>. • misses(i, j): no. of times a beam passed through <i, j> • Value of interest:P(reflects(i, j)) • Count how often a cell has reflected a beam.

  23. Pose at time t: • Beam n of scan t: • Beam not reflected: • Beam reflected by an object: n 0 1 The Measurement Model

  24. Maximum A Posteriori (MAP) Mapping • Relax independence assumption: • Output mode of posterior instead of full posterior: • Use measurement models instead of inverse models.

  25. Computing the Most Likely Map • Compute value for m that maximizes: • Assuming a uniform prior probability for p(m), this is equivalent to maximizing (Section 9.4.2): • Use hill climbing to search for (local) maxima. • Algorithm in Table 9.3 – one more task!

  26. Difference between Occupancy Grid Maps and Counting • The counting model (with MAP) determines how often a cell reflects a beam: • No inverse sensor model  • Store all data i.e. incremental updates not possible  • The occupancy model represents whether or not a cell is occupied by an object. • Incremental updates possible  • Inverse sensor models, independence assumption  • Although a cell might be occupied by an object, it says nothing about the reflection probability.

  27. Example Occupancy Map

  28. Example Reflection Map glass panes

  29. Summary • Occupancy grid maps a popular approach to represent the environment of a mobile robot given known poses. • Stores the posterior probability that the corresponding area in the environment is occupied. • Occupancy grid maps can be learned efficiently considering each cell independently from all others. • Reflection maps are an alternative representation; each cell stores probability that a beam is reflected by cell. • Reflection maps are more optimal. • MAP approach relaxes independence constraint but requires batch processing.

More Related