Speed regulation now works, instead of power, set target_speed. Next step is ramp up and ramp down to exact position