1. National Key Lab of Autonomous Intelligent Unmanned Systems, The School of Automation, Beijing Institute of Technology, Beijing 100081, P. R. China
2. Beijing Advanced Innovation Center for Intelligent Robots and Systems, Beijing Institute of Technology, Beijing 100081, P. R. China
3. Beijing Institute of Technology, Chongqing Innovation Center, Chongqing 401120, P. R. China
4. Department of Control Science and Engineering, Tongji University, Shanghai 201804, P. R. China