ROS code for UPenn's scarab robot - View it on GitHub