DriveEncoder sample rate and buffer size adjusted.
PID tuned on blocks (performs quite well)