Looks really good, if I knowed this before I started myself I probably would have ordered a I2C version instead

..But I might borrow some of your code anyway

I was thinking of using a timer and calculate speed from it, but I dont know how accurate it would be.