Fixed bug in core gather wheel position.

The wheel position was not keeping track of position from wheel encoder
0.
Therefore, the positions were wrong!