Tested and working ReadEncoders velocity output