This article was also presented at ICRA 2018, IEEE International Conference on Robotics and Automation 2018, Brisbane, Australia