Added motor shield testing code

Code for testing 4 DC motors connected to Adafruit Motor Shield V2.
Motors are run in forward for 3 seconds, then in reverse for 3 seconds.