Gaussian Process Simultaneous localization and mapping