Original code developed by members of the Johns Hopkins University Laboratory for Computational Sensing and Robotics