This report presents the results of a research effort undertaken by the Carnegie Mellon University Robotics Institute and the University of California PATH Program under funding provided by the Federal Transit Administration under Federal ID # 250969449000. The direction of Brian Cronin is gratefull