Compare commits
2 Commits
Author | SHA1 | Date | |
---|---|---|---|
399fffb187 | |||
6a140d1538 |
@ -189,8 +189,8 @@ sequenceDiagram
|
|||||||
|
|
||||||
### Quick demo v0.2
|
### Quick demo v0.2
|
||||||
|
|
||||||
<a href="https://www.youtube.com/watch?v=0JR1YQoTmgw" title="quick demo">
|
<a href="https://www.youtube.com/watch?v=WXJ52hnwTxs" title="quick demo">
|
||||||
<img src="https://img.youtube.com/vi/0JR1YQoTmgw/hqdefault.jpg" alt="demo" />
|
<img src="https://img.youtube.com/vi/WXJ52hnwTxs/hqdefault.jpg" alt="demo" />
|
||||||
</a>
|
</a>
|
||||||
|
|
||||||
|
|
||||||
|
@ -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,27 +180,20 @@ 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;
|
|
||||||
cont++;
|
|
||||||
previoMillisTermo=millis();
|
|
||||||
}
|
}
|
||||||
|
sentido=!sentido;
|
||||||
|
cont++;
|
||||||
|
previoMillisTermo=millis();
|
||||||
}
|
}
|
||||||
} while (cont<4);
|
} while (cont<4);
|
||||||
}
|
}
|
||||||
|
Loading…
x
Reference in New Issue
Block a user