. Author manuscript; available in PMC: 2020 Apr 1.
Published in final edited form as: IEEE Trans Robot. 2018 Nov 14;35(2):353–370. doi: 10.1109/TRO.2018.2878906
Personal use is permitted, but republication/redistribution requires IEEE permission.