2D Occupency Grid SLAM

Introduction

A simple python implement of Grid-based Rao-Blackwellized particle filter(RBPF) SLAM.
Run the code: python test.py

Demo

(Left is the environment; Right top is the ground truth map; Right down is the map build by SLAM algorithm.)