1. Department of Automation, Shanghai Jiao Tong University, Key Laboratory of System Control and Information Processing, Ministry of Education of China, Shanghai, China
2. Research Institute of Robotics, Shanghai Jiao Tong University, Shanghai, China
3. Centre for Robotics, MINES ParisTech, PSL Research University, Paris, France
4. California PATH (Partners for Advanced Transportation Technology), University of California, Berkeley, Richmond, CA, USA