Start revamp of PID implementation/usage

Because the GEFS PID controller is actually incorrectly implemented,
start work on redoing it and also stop making the results dependent on
arbitrary speed ratio which makes it difficult to set limits on PID
controller.