. Author manuscript; available in PMC: 2019 Aug 16.
Published in final edited form as: IEEE Trans Autom Sci Eng. 2017 Jan 17;15(1):290–306. doi: 10.1109/TASE.2016.2635106
Personal use is permitted, but republication/redistribution requires IEEE permission. See http://www.ieee.org/publications_standards/publications/rights/index.html for more information.