Added rpm convertion functions.
Add good odometry formula