Added encoder-based velocity calculation
Added comment for velocity units