Working linear speed control function
Merge branch 'linearMove'