Add support for negative speed of a wheel

[yaqwsx]

When a turn with small radius is issued, PathPlanner produces a correct shape with one wheel reversed, however the speed computation puts the speed in absolute value. As a result, path reconstructed from wheel speeds or positions differes.