Lino/RoboterArm
1
0
Fork 0
mirror of https://github.com/LinoSchmidt/RoboterArm.git synced 2026-03-21 02:31:16 +01:00
Code Issues Packages Projects Releases Wiki Activity

Added MaxMin Beep

Browse Source
This commit is contained in:
Lino Schmidt
2022-05-12 08:59:07 +02:00
parent b9933398cc
commit c4092b53b5
1 changed files with 30 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files

39
Firmware 2.0/src/main.cpp
View File

@@ -283,6 +283,7 @@ void loop(){
joystick_RY = joystick_position(analogRead(joystick_RY_Pin), joystick_RY_middle, joystick_RY_min, joystick_RY_max, joystick_RY_MinSpeed, joystick_RY_MaxSpeed); joystick_RY = joystick_position(analogRead(joystick_RY_Pin), joystick_RY_middle, joystick_RY_min, joystick_RY_max, joystick_RY_MinSpeed, joystick_RY_MaxSpeed);
if(joystick_LX == 0 && joystick_LY == 0 && joystick_RX == 0 && joystick_RY == 0){ if(joystick_LX == 0 && joystick_LY == 0 && joystick_RX == 0 && joystick_RY == 0){
noTone(BuzzerPin);
if (TimeToAutoplay > offtime) if (TimeToAutoplay > offtime)
offtime++; offtime++;
} }
@@ -310,15 +311,35 @@ void loop(){
} }
if(HandPos > HandMax)HandPos = HandMax; if(HandPos > HandMax) {
if(OberarmPos > OberarmMax)OberarmPos = OberarmMax; HandPos = HandMax;
if(DrehungPos > DrehungMax)DrehungPos = DrehungMax; tone(BuzzerPin, Buzzer_ShortTon);
if(ArmPos > ArmMax)ArmPos = ArmMax; } else if(OberarmPos > OberarmMax) {
OberarmPos = OberarmMax;
if(HandPos < HandMin)HandPos = HandMin; tone(BuzzerPin, Buzzer_ShortTon);
if(OberarmPos < OberarmMin)OberarmPos = OberarmMin; } else if(DrehungPos > DrehungMax) {
if(DrehungPos < DrehungMin)DrehungPos = DrehungMin; DrehungPos = DrehungMax;
if(ArmPos < ArmMin)ArmPos = ArmMin; tone(BuzzerPin, Buzzer_ShortTon);
} else if(ArmPos > ArmMax) {
ArmPos = ArmMax;
tone(BuzzerPin, Buzzer_ShortTon);
}
else if(HandPos < HandMin) {
HandPos = HandMin;
tone(BuzzerPin, Buzzer_ShortTon);
} else if(OberarmPos < OberarmMin) {
OberarmPos = OberarmMin;
tone(BuzzerPin, Buzzer_ShortTon);
} else if(DrehungPos < DrehungMin) {
DrehungPos = DrehungMin;
tone(BuzzerPin, Buzzer_ShortTon);
} else if(ArmPos < ArmMin) {
ArmPos = ArmMin;
tone(BuzzerPin, Buzzer_ShortTon);
} else {
noTone(BuzzerPin);
}
servoWrite(); servoWrite();
} }