Steering and Drive encoders now interrupt driven. Also have steering error detection, sample collection state machine and much more.