Made several adjustments for encoder use - includes splitting drivetrain to two classes