schulze/EENX15
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

round angles before inting

Browse Source
This commit is contained in:
Thefeli73 2021-04-13 21:51:58 +02:00
parent 7b49d8974c
commit f12389b570
1 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
EENX15_LQR/EENX15_LQR.ino
View File

@ -95,7 +95,7 @@ void loop() {
if(temp_loops>100){
Serial.println("");
Serial.print(" pitch Angle = "); Serial.println(angle_pitch_output);
Serial.print(" pitch Angle abs = "); Serial.println(abs(int(angle_pitch_output)));
Serial.print(" pitch Angle abs = "); Serial.println(abs(int(round(angle_pitch_output))));
Serial.print(" pitch Angle measured = "); Serial.println(angle_pitch);
temp_loops = 0;
}
@ -115,8 +115,8 @@ void loop() {
digitalWrite(MotorPinA, CW);
}
if((abs(int(angle_pitch_output))*8 + 30)<250){
analogWrite(MotorSpeedB,30 + 8*abs(int(angle_pitch_output))); //Wheel close to connections
analogWrite(MotorSpeedA,30 + 8*abs(int(angle_pitch_output))); //First experiment wheel
analogWrite(MotorSpeedB,30 + 8*abs(int(round(angle_pitch_output)))); //Wheel close to connections
analogWrite(MotorSpeedA,30 + 8*abs(int(round(angle_pitch_output)))); //First experiment wheel
}
else{
analogWrite(MotorSpeedB,250); //Wheel close to connections