Implemented speed filtering
Merge branch 'filter_speed' into dev