Completed drive class

Finished very basic driving class
TODO: work on basic shoot