1.National Defense Key Laboratory of Underwater Vehicles Technology,Harbin Engineering University,Harbin 150001,China;2.State Key Laboratory Robot and Systems,Harbin Institute of Technology,Harbin 150001,China;3Institute of Robotics and System Dynamics,German Aerospace Center,Germany Wessling 82230,Germany