exploration and mapping with autonomous robot teams results from the magic 2010 competition .
Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing