reduces drive ramp time. changed to fix inc/decrements of 40 or, if smaller, the difference between current and desired speed. removed avg, min, max calculations for compass, gyro and accelero