130 likes | 234 Views
Probabilistic Robotics. FastSLAM with known correspondences. Path posterior estimated by a particle filter Feature locations estimated by EKFs. M particles M*N EKFs. Each particle contains: Path estimation EKF for each feature location. Pose estimate 1-4 Update features 5-24
E N D
Probabilistic Robotics FastSLAM with known correspondences Richard Mauldin
Path posterior estimated by a particle filter • Feature locations estimated by EKFs
M particles • M*N EKFs
Each particle contains: • Path estimation • EKF for each feature location
Pose estimate • 1-4 • Update features • 5-24 • Resampling • 25-30
3.Retrieves information for particle k • 4.Samples new robot pose based on control • Pose added to particle k’s path estimation
Determine if the observed feature is new • 7.Initialize mean using measurement function h