-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathAntipesto.ino
103 lines (77 loc) · 2.34 KB
/
Antipesto.ino
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
void inicio(){
Serial.println(F("#26 P1600 T100"));
Serial.println(F("#6 P1800 T100"));
Serial.println(F("#18 P2000 T100"));
Serial.println(F("#2 P2000 T100"));
Serial.println(F("#22 P1800 T100"));
Serial.println(F("#10 P1400 T100"));
delay(1000);
//PATA 3
Serial.println(F("#0 P1700 T350"));//a
Serial.println(F("#2 P1800 T350"));//c
//PATA 2
Serial.println(F("#4 P1700 T350"));//a
Serial.println(F("#6 P1500 T350"));//c
//PATA 1
Serial.println(F("#8 P1700 T350"));//a
Serial.println(F("#10 P1100 T350"));//c
//MITAD IZQ
//PATA 6
Serial.println(F("#16 P1300 T350"));//a
Serial.println(F("#18 P1900 T350"));//c
//PATA 5
Serial.println(F("#20 P1300 T350"));//a
Serial.println(F("#22 P1500 T350"));//c
//PATA 4
Serial.println(F("#24 P1300 T350"));//a
Serial.println(F("#26 P1200 T350"));//c
delay(2000);
Serial.println(F("#26 P900 T100"));
Serial.println(F("#6 P1100 T100"));
Serial.println(F("#18 P1300 T100"));
Serial.println(F("#2 P1300 T100"));
Serial.println(F("#22 P1100 T100"));
Serial.println(F("#10 P900 T100"));
Serial.println(F("#9 P1450 T100"));
delay(1000);
//PATA 3
Serial.println(F("#0 P1700 T350"));//a
Serial.println(F("#2 P1800 T350"));//c
//PATA 2
Serial.println(F("#4 P1700 T350"));//a
Serial.println(F("#6 P1500 T350"));//c
//PATA 1
Serial.println(F("#8 P1700 T350"));//a
Serial.println(F("#9 P1500 T350"));//b
Serial.println(F("#10 P1100 T350"));//c
//MITAD IZQ
//PATA 6
Serial.println(F("#16 P1300 T350"));//a
Serial.println(F("#18 P1900 T350"));//c
//PATA 5
Serial.println(F("#20 P1300 T350"));//a
Serial.println(F("#22 P1500 T350"));//c
//PATA 4
Serial.println(F("#24 P1300 T350"));//a
Serial.println(F("#26 P1200 T350"));//c
delay(2000);
}
void inicio2(){
Serial.println(F("#26 P1600 T100"));
Serial.println(F("#6 P1800 T100"));
Serial.println(F("#18 P2000 T100"));
Serial.println(F("#2 P2000 T100"));
Serial.println(F("#22 P1800 T100"));
Serial.println(F("#10 P1400 T100"));
delay(700);
Serial.println(F("#26 P900 T100"));
Serial.println(F("#6 P1100 T100"));
Serial.println(F("#18 P1300 T100"));
Serial.println(F("#2 P1300 T100"));
Serial.println(F("#22 P1100 T100"));
Serial.println(F("#10 P900 T100"));
delay(700);
//a= servo de la pieza negra
//b= servo de la pieza de metal
//c= servo de la base
}