This paper was presented at the Southern California Robotics Symposium, Apr. 22, 2016, San Diego, CA