Point-to-Surfel-Distance- (PSD-) Based 6D Localization Algorithm for Rough Terrain Exploration Using Laser Scanner in GPS-Denied Scenarios.