ROS code for UPenn's scarab robot