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 short Beeps

Browse Source
This commit is contained in:
Lino Schmidt
2022-05-15 18:14:53 +02:00
parent 18a93c78e2
commit e9c962b4b7
2 changed files with 18 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

1
Firmware 2.0/src/config.h
View File

@@ -58,6 +58,7 @@
#define Calibration_messureCount 10
#define Button_LongPressTime 1000
#define Button_ShortPressTime 300
#define buzzSpeed 1
//Buzzer
#define BuzzerPin 7

25
Firmware 2.0/src/main.cpp
View File

@@ -16,6 +16,7 @@ bool detached = true;
int eeprom = 0;
int autoplayLoop = 0;
bool autoplayStart = true;
int buzzTime = 0;
int autoplayPos[][4] = {
{20, 100, 50, 180},
@@ -291,6 +292,14 @@ int joystick_position(int joystick, int joystick_middle, int joystick_min, int j
return(0);
}
void buzz(){
if(buzzTime <= buzzSpeed) tone(BuzzerPin, Buzzer_ShortTon);
else if(buzzTime <= buzzSpeed*2) noTone(BuzzerPin);
else buzzTime = 0;
buzzTime++;
}
void loop(){
joystick_LX = joystick_position(analogRead(joystick_LX_Pin), joystick_LX_middle, joystick_LX_min, joystick_LX_max, joystick_LX_MinSpeed, joystick_LX_MaxSpeed);
joystick_LY = joystick_position(analogRead(joystick_LY_Pin), joystick_LY_middle, joystick_LY_min, joystick_LY_max, joystick_LY_MinSpeed, joystick_LY_MaxSpeed);
@@ -326,29 +335,29 @@ void loop(){
if(HandPos > HandMax) {
HandPos = HandMax;
tone(BuzzerPin, Buzzer_ShortTon);
buzz();
} else if(OberarmPos > OberarmMax) {
OberarmPos = OberarmMax;
tone(BuzzerPin, Buzzer_ShortTon);
buzz();
} else if(DrehungPos > DrehungMax) {
DrehungPos = DrehungMax;
tone(BuzzerPin, Buzzer_ShortTon);
buzz();
} else if(ArmPos > ArmMax) {
ArmPos = ArmMax;
tone(BuzzerPin, Buzzer_ShortTon);
buzz();
}
else if(HandPos < HandMin) {
HandPos = HandMin;
tone(BuzzerPin, Buzzer_ShortTon);
buzz();
} else if(OberarmPos < OberarmMin) {
OberarmPos = OberarmMin;
tone(BuzzerPin, Buzzer_ShortTon);
buzz();
} else if(DrehungPos < DrehungMin) {
DrehungPos = DrehungMin;
tone(BuzzerPin, Buzzer_ShortTon);
buzz();
} else if(ArmPos < ArmMin) {
ArmPos = ArmMin;
tone(BuzzerPin, Buzzer_ShortTon);
buzz();
} else {
noTone(BuzzerPin);
}