1. School of Automation, Beijing Institute of Technology, Beijing, China
2. Integrated Navigation and Intelligent Navigation Laboratory and the National Key Laboratory of Autonomous Intelligent Unmanned Systems, Beijing Institute of Technology, Beijing, China