exploration and mapping with autonomous robot teams results from the magic 2010 competition .
Simultaneous Localisation and Mapping ( SLAM ) : Part I The Essential Algorithms