1. Laboratory of Robotics and Intelligent Systems, Quanzhou Institute of Equipment Manufacturing, Haixi Institute, Chinese Academy of Sciences, Quanzhou, Fujian, China
2. Department of Traffic and Assistance, Institute of Automation and Communication, Magdeburg, Germany