3-D LiDAR Localization Based on Novel Nonlinear Optimization Method for Autonomous Ground Robot