Added encoders to drive train
Merge branch 'drive_train' into iterative