optimize drivetrain code

[nickquednow]

make sure there are no branching conditions within the code to make sure that the code can run as fast as possible.

Other minor performance improvements are helpful as well.