Probabilistic Implicit Surfaces For Localisation, Mapping And Planning