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

new offtime limit

Browse Source
This commit is contained in:
LinoSchmidt
2021-09-30 11:35:41 +02:00
parent 8c12712a2c
commit 48426588d5
1 changed files with 3 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/main.cpp
View File

@@ -26,6 +26,7 @@
#define loopTime 25
#define PotiFehlerBereich 100
#define AusschaltDelay 80
#define timeToAutoplay 4800 //2min
Servo servoDrehung, servoArm, servoOberarm, servoHand;
@@ -60,7 +61,8 @@ void loop()
if (servoDrehungPos <= servoDrehungPosOLD + PotiFehlerBereich && servoDrehungPos >= servoDrehungPosOLD - PotiFehlerBereich && servoArmPos <= servoArmPosOLD + PotiFehlerBereich && servoArmPos >= servoArmPosOLD - PotiFehlerBereich && servoOberarmPos <= servoOberarmPosOLD + PotiFehlerBereich && servoOberarmPos >= servoOberarmPosOLD - PotiFehlerBereich && servoHandPos <= servoHandPosOLD + PotiFehlerBereich && servoHandPos >= servoHandPosOLD - PotiFehlerBereich)
{
offtime++;
if (timeToAutoplay < offtime)
offtime++;
}
else
{