Add some arduino testing code to run some gaits on the snake robot