Created Subroutines.h

- Created header file subroutines.h to hold all subroutines
- Renamed motors to leftDrive and rightDrive