Fixing speed smoothing
Merge pull request #66 from Gregwar/fixing_speed_smoothing

Fixing speed smoothing