Fixed Autoplay

This commit is contained in:
2022-05-15 19:42:58 +02:00
parent 1249ccafec
commit 0fc31498a2

View File

@@ -261,11 +261,6 @@ void joystickButtonPress(){
} }
void Autoplay(){ void Autoplay(){
if(autoplayLoop+1 >= sizeof(autoplayPos)/sizeof(autoplayPos[0])) {
autoplayLoop = 0;
calibrateMiddle();
}
if(autoplayStart) { if(autoplayStart) {
autoplayStart = false; autoplayStart = false;
servoEase(autoplayPos[autoplayLoop][0], autoplayPos[autoplayLoop][1], autoplayPos[autoplayLoop][2], autoplayPos[autoplayLoop][3], AutoplayEaseSpeed); servoEase(autoplayPos[autoplayLoop][0], autoplayPos[autoplayLoop][1], autoplayPos[autoplayLoop][2], autoplayPos[autoplayLoop][3], AutoplayEaseSpeed);
@@ -274,6 +269,7 @@ void Autoplay(){
if(DrehungPos == autoplayPos[autoplayLoop][0] && ArmPos == autoplayPos[autoplayLoop][1] && OberarmPos == autoplayPos[autoplayLoop][2] && HandPos == autoplayPos[autoplayLoop][3]) { if(DrehungPos == autoplayPos[autoplayLoop][0] && ArmPos == autoplayPos[autoplayLoop][1] && OberarmPos == autoplayPos[autoplayLoop][2] && HandPos == autoplayPos[autoplayLoop][3]) {
if(autoplayLoop+1 >= sizeof(autoplayPos)/sizeof(autoplayPos[0])) { if(autoplayLoop+1 >= sizeof(autoplayPos)/sizeof(autoplayPos[0])) {
autoplayLoop = 0; autoplayLoop = 0;
calibrateMiddle();
} else { } else {
autoplayLoop++; autoplayLoop++;
} }