added velocity calculation in ReadEncoders.*