diff --git a/arduino/arduino.ino b/arduino/arduino.ino index 8567fc2..52106b7 100644 --- a/arduino/arduino.ino +++ b/arduino/arduino.ino @@ -74,23 +74,30 @@ void loop() { pwm.setPWM(i, 0, ((SERVOMAX-SERVOMIN)/2)+SERVOMIN); } } else { - - if(tag == A_TAG) { - for(int i=0; i<8; i++) { - pwm.setPWM(i, 0, SERVOMIN+50); - delay(100*SERVODIVIDER); - pwm.setPWM(i, 0, ((SERVOMAX-SERVOMIN)/2)+SERVOMIN-50); - } - } for(int i=0; i<8; i++) { + if(tag == A_TAG) { + pwm.setPWM(i, 0, SERVOMAX+50); + delay(100*SERVODIVIDER); + pwm.setPWM(i, 0, SERVOMAX-50); + delay(100*SERVODIVIDER); + } pwm.setPWM(i, 0, SERVOMIN); delay(values[i]*SERVODIVIDER); pwm.setPWM(i, 0, ((SERVOMAX-SERVOMIN)/2)+SERVOMIN); } + + /* + for(int i=0; i<8; i++) { + pwm.setPWM(i, 0, SERVOMIN); + delay(values[i]*SERVODIVIDER); + pwm.setPWM(i, 0, ((SERVOMAX-SERVOMIN)/2)+SERVOMIN); + } + */ if(tag == A_TAG) { while(cycle < 8) { + cycle = 0; for(int i=0; i<8; i++) { Serial.print(values[i]); Serial.print(" "); @@ -101,7 +108,9 @@ void loop() { cycle++; digitalWrite(atomPins[i], LOW); } - } + } else { + cycle++; + } } Serial.println(""); delay(TIMER); @@ -110,5 +119,4 @@ void loop() { } } } - -} +} \ No newline at end of file