Update DriveTrain.c

Better code!
Update DriveTrain.c
Create Old_DriveTrain.c

My original drive train code.
Merge pull request #4 from specialcode/master

Fix DriveTrain.c