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

buttonpress finished

Browse Source
This commit is contained in:
LinoSchmidt
2022-01-13 07:21:07 +01:00
parent d606b78c5f
commit 2bdb53f53b
1 changed files with 11 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

19
Firmware 2.0/src/main.cpp
View File

@@ -71,21 +71,23 @@ void setup(){
} }
void joystickButtonPress(){ void joystickButtonPress(){
int Code[5] = {0 ,0 ,0 ,0 ,0}; //0 = short, 1 = long int Code[30] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; //0 = short, 1 = long
int CodeLenght = 0; int CodeLenght = 0;
bool Finished = false; bool Finished = false;
bool abort = false; bool abort = false;
while(!Finished && !abort){ while(!Finished && !abort){
if(CodeLenght > 5)abort = true; if(CodeLenght > 29){
abort = true;
Serial.println("Code aborted!");
}
int buttonTime = 0; int buttonTime = 0;
while(digitalRead(joystick_button_Pin) == HIGH){ while(digitalRead(joystick_button_Pin) == LOW){
buttonTime+= 10; buttonTime+= 10;
delay(10); delay(10);
} }
if(buttonTime < 250){ if(buttonTime < 300){
Code[CodeLenght] = 0; Code[CodeLenght] = 0;
Serial.println("short press"); Serial.println("short press");
} }
@@ -101,7 +103,7 @@ void joystickButtonPress(){
CodeLenght++; CodeLenght++;
buttonTime = 0; buttonTime = 0;
while(digitalRead(joystick_button_Pin) == LOW && !Finished && !abort){ while(digitalRead(joystick_button_Pin) == HIGH && !Finished && !abort){
buttonTime+= 10; buttonTime+= 10;
delay(10); delay(10);
@@ -113,8 +115,9 @@ void joystickButtonPress(){
} }
if(!abort){ if(!abort){
if(Code == {0, 1, 0, 1, 0} && CodeLenght == 6){ Serial.println(String(Code[0]) + String(Code[1]) + String(Code[2]) + String(Code[3]) + String(Code[4]) + " Len:" + String(CodeLenght));
if(Code[0] == 0 && Code[1] == 1 && Code[2] == 0 && Code[3] == 1 && Code[4] == 0 && CodeLenght == 4){
Serial.println("Calibrate...");
} }
} }
} }