Implemented Drive Functions

The drive functions were finished and are now implemented in the main
file.