Simulation:  fixed some numerical issues with the encoders

Still need to check what the correct values for _cml, _cmr and _b should
be.  0.158 for cml/cmr seems to work.  0.158 seems to result in a match
between robot's calculated theta and theta provided by the simulator,
but need to check _b