Fix code for Adafruit Motor Shield V2