Use position encode to determine motor position

[killenb]

Currently the actual motor position is just calculated from the number of steps, which does not include slippage or hysteresis.
If a position encode is available, it should be used as the actual motor position. In case no encode is available, the calculation stays as it is.

What needs to be taken into account is that the encode value is jittering (detector noise).