Code for Etherbotix-Based SMALdog