Added rear encoders and logic to always use encoder from
the encoder which reports the least position change, as a
simple way of compensating for wheel slippage.

Also added the maxYawThreshold parameter to ignore wildly gyrating
yaw values.