Funding for this research was provided by:
National Natural Science Foundation of China (51505273)
State Key Laboratory of Robotics and System (HIT) (SKLRS-2014-MS-10)
Jiangsu Provincial Key Laboratory of Advanced Robotics Fund Projects (AR201401)
Fund of MOE Key Laboratory of Image Processing and Intelligence Control (IPIC2015-02)