1st Drive Test

Added the motor configuration and switched to a tank drive