Add main class.

Add main class, include motor set up and open the program.
Add drive function

Include the function as well as conditionals.
Declare direction variables.