refact bool espera -> sentido (giro servo)

mejora en función de accionamiento del servo
This commit is contained in:
jp.av.dev 2022-10-26 04:16:55 -03:00
parent e56c9f0267
commit 6a140d1538

View File

@ -31,7 +31,7 @@ byte posOFF2;
byte posTEMP; byte posTEMP;
byte cont; byte cont;
bool estado_termo; bool estado_termo;
bool espera; bool sentido;
bool espera_man; bool espera_man;
bool start; bool start;
byte manual; byte manual;
@ -180,28 +180,21 @@ void limpiaSerial() {
void termoACC(byte pos1, byte pos2) { void termoACC(byte pos1, byte pos2) {
myservo_X.write(pos1); myservo_X.write(pos1);
espera=0; sentido=0;
cont=0; cont=0;
previoMillisTermo=millis(); previoMillisTermo=millis();
do{ do{
actualMillis=millis(); actualMillis=millis();
if(espera==0) {
if ((unsigned long)(actualMillis - previoMillisTermo) >= 500) { if ((unsigned long)(actualMillis - previoMillisTermo) >= 500) {
if(sentido==0) {
myservo_X.write(pos2); myservo_X.write(pos2);
espera=1; } else {
cont++;
previoMillisTermo=millis();
}
}
actualMillis=millis();
if(espera==1) {
if ((unsigned long)(actualMillis - previoMillisTermo) >= 500) {
myservo_X.write(pos1); myservo_X.write(pos1);
espera=0; }
sentido=!sentido;
cont++; cont++;
previoMillisTermo=millis(); previoMillisTermo=millis();
} }
}
} while (cont<4); } while (cont<4);
} }