Servo Speed Limit

Implemented speed limit on servo movement