Read velocity function
Add l3g4200d data ready check.