small fix

This commit is contained in:
Thefeli73 2021-04-17 15:23:11 +02:00
parent 5f559bb895
commit bc7a9a6ec4

View File

@ -150,8 +150,7 @@ void setSpeed(){
//speed = 8*safe_angle;
float position_m = countA/174.76;
float angle_r = angle_pitch_output * 0.318;
speed = inputToControlSystem(position_m, angle_r);
speed *= 22;
speed = 22 * inputToControlSystem(position_m, angle_r);
if(speed<0){
digitalWrite(MotorPinB, CW);
digitalWrite(MotorPinA, CCW);