Zhao Hongzhe e-mail: [email protected] Bi Shusheng e-mail: [email protected] Yu Jingjun e-mail: [email protected] Robotics Institute, Beihang University, Beijing 100191,…