1. Robotics Institute, Beihang University, Beijing 100191, China e-mail:
2. R&D Center, Sunward Intelligent Equipment Co., Ltd., Changsha 410100, China;
3. Robotics Institute, Beihang University, Beijing 100191, China
4. School of Engineering and Physical Sciences, Heriot-Watt University, Edinburgh EH14 4AS, UK