Arduino Locomotion code