Code1

This is the first sketch of our test code for the motors