Add simple velocity calculation
Refactor and track raw rotation value.