First commit with basic drive code only

This commit contains just the basic drive code with no autonomous.

Bijan