This is a video of my robot with hand rolled GraphSLAM and ICP. Its objective is to reach the three green goal positions by mapping and planning routs in unknown environments.
No download links available.