Encoder testing, fixed drivetrain, adjusted the way jag works, bug fixes