1. a Autonomous Systems Laboratory, Department of Mechanical Engineering, State University of New York at Stony Brook, Stony Brook, NY 11794, USA;, Email: Zhe.Zhang@sunysb.edu
2. b Department of Mechanical and Industrial Engineering, University of Toronto, Ontario M5S 3G8, Canada