added velocity calculation in ReadEncoders.*
Tested and working ReadEncoders velocity output