. Author manuscript; available in PMC: 2017 Apr 1.
Published in final edited form as: IEEE Trans Robot. 2016 Mar 10;32(2):327–338. doi: 10.1109/TRO.2016.2522433
Personal use is permitted, but republication/redistribution requires IEEE permission.