Grizzly: Enable more than four speeds using PID control

Switches from constant delta time measurement to constant delta position measurement for speed control only
Can still be improved
Needs to be tested