
This paper has been accepted for publication in IEEE Transactions on Robotics.
DOI: 10.1109/TRO.2017.2705103
IEEE Xplore: http://ieeexplore.ieee.org/document/7946260/
c
2017 IEEE. Personal use of this material is permitted. Permission from IEEE must be obtained for all other uses, in any
current or future media, including reprinting /republishing this material for advertising or promotional purposes, creating new
collective works, for resale or redistribution to servers or lists, or reuse of any copyrighted component of this work in other
works.
arXiv:1610.06475v2 [cs.RO] 19 Jun 2017