added drive threshold 0.05
more drivetrain code