StateEstimationandOptimizationforMobileRobotNavigation