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 auto Recalibration

Browse Source
This commit is contained in:
Lino Schmidt
2022-05-15 18:40:55 +02:00
parent e9c962b4b7
commit 1249ccafec
1 changed files with 12 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

22
Firmware 2.0/src/main.cpp
View File

@@ -261,7 +261,10 @@ void joystickButtonPress(){
}
void Autoplay(){
if(autoplayLoop+1 >= sizeof(autoplayPos)/sizeof(autoplayPos[0])) autoplayLoop = 0;
if(autoplayLoop+1 >= sizeof(autoplayPos)/sizeof(autoplayPos[0])) {
autoplayLoop = 0;
calibrateMiddle();
}
if(autoplayStart) {
autoplayStart = false;
@@ -308,8 +311,14 @@ void loop(){
if(joystick_LX == 0 && joystick_LY == 0 && joystick_RX == 0 && joystick_RY == 0){
noTone(BuzzerPin);
if (TimeToAutoplay > offtime)
offtime++;
if (TimeToAutoplay > offtime) offtime++;
if(offtime >= TimeToAutoplay) {
Autoplay();
} else if(offtime == TimeToDetach){
detachAttach(true);
}
}
else{
offtime = 0;
@@ -365,13 +374,6 @@ void loop(){
servoWrite();
}
if(offtime >= TimeToAutoplay){
Autoplay();
}
else if(offtime >= TimeToDetach){
detachAttach(true);
}
if(digitalRead(joystick_button_Pin) == LOW){
detachAttach(true);
joystickButtonPress();