Fixed/Added to EncodeDistance && DriveTrain

In DriveTrain:
- worked on autoTurn
- deleted the loop in autoDrive
- setup for teleTurn

In EncodeDistance
- added some more encoder functions
- actually put code in the functions