int matang[1][5];
int servo[3]={3,5,6};
int button[2]={8,9};
bool save=LOW;
bool load=LOW;
long cont=0,i=0,j=0,pos=0,pass=0;
void setup()
{
Serial.begin(9600);
for(int i=0;i<3;i++){
pinMode(servo[i],OUTPUT);
}
for(int i=0;i<2;i++){
pinMode(button[i],INPUT);
}
Serial.println("alo?");
for (int i = 180; i <= 0; i--) {
digitalWrite(servo[0], HIGH);
delayMicroseconds(500 + (i * 11)); // Ajusta el tiempo según el servo
digitalWrite(servo[0], LOW);
delay(15);
}
}
void loop()
{
save=digitalRead(button[0]);
load=digitalRead(button[1]);
if(save==HIGH && load==LOW){
if(j<5){
pos=analogRead(A0);
Serial.println(pos);
pass=map(pos,0,1023,0,180);
matang[0][j]=pass;
delay(500);
j++;
}
}
if(load==HIGH && save==LOW){
for(int i=0;i<5;i++){
Serial.print(matang[0][i]);
delay(500);
Serial.println("");
}
for(int j=0;j<5;j++){
if(matang[0][j]<matang[0][j+1]){ //servo 1
for (int i = matang[0][j]; i <= matang[0][j+1]; i++) {
digitalWrite(servo[0], HIGH);
delayMicroseconds(500 + (i * 11)); // Ajusta el tiempo según el servo
digitalWrite(servo[0], LOW);
delay(15);
}
Serial.println(matang[0][j]);
delay(1000);
}
else if(matang[0][j]>matang[0][j+1]){
for (int i = matang[0][j]; i <= matang[0][j+1]; i--) {
digitalWrite(servo[0], HIGH);
delayMicroseconds(500 + (i * 11)); // Ajusta el tiempo según el servo
digitalWrite(servo[0], LOW);
delay(15);
}
Serial.println(matang[0][j]);
delay(1000);
}
}
}
}