Removed output NaN in ReadEncodersTimeStamp, added an initialization value to PublishOdometry