Servo library handling speed

when updated I will review it again