refact bool espera -> sentido (giro servo)
mejora en función de accionamiento del servo
This commit is contained in:
parent
e56c9f0267
commit
6a140d1538
@ -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);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user