A novel augmented graph approach for estimation in localisation and mapping. - Paul Robert Thompson (2009)