add PID I-part in position and speed controller -> to reach setpoint exactly, and to deal with outdoor turbulences