CaixaInutil/caixa_inutil.ino at master · Blog-Proesi/CaixaInutil · GitHub

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
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
/*
* Projeto caixa inútil - Unsless box
* Projeto desenvolvido por Venancio Miranda e Proesi Componentes*/

#include <Servo.h>
#define enablePin  11
#define botao      10
#define servo_pata  9
#define servo_tampa 8

// Posições da tampa

#define fecha   152
#define meio     70
#define abre      0
#define bate    165
#define fresta  140
#define Tbatida 100

// Posições pata

#define guarda 180
#define aceno   60
#define desl    10

boolean limite = true;
int count = 0, button = 0 , enable = 0;

Servo pata;
Servo tampa;

// Função que orienta posição dos servos e delay entre nova movimentação

void comando (Servo nome_servo,int grau ,int tempo)

{
nome_servo.write(grau);
delay(tempo);
}

void setup()
{
pinMode(botao , INPUT_PULLUP);
pinMode(enablePin , OUTPUT);
digitalWrite(enablePin,LOW);
pata.attach(servo_pata);
tampa.attach(servo_tampa);
}

void loop()
{
while(limite)                     //While que executa limite de execuções
{
digitalWrite(enablePin,LOW);
button = digitalRead(botao);

if(button == LOW)
{
switch(count)                 // contagem e sequencia dos movimentos
{
case 0:
digitalWrite(enablePin,HIGH);
delay(500);
comando(tampa , abre , 750);
comando(pata , desl, 1000);
comando(pata , guarda , 1000);
comando(tampa, fecha , 2000);
count++;
break;

case 1:
digitalWrite(enablePin,HIGH);
delay(1000);
comando(tampa , meio, 2000);
comando(tampa, fecha, 1000);
comando(tampa , abre , 1000);
comando(pata , desl, 1000);
comando(pata , guarda , 1000);
comando(tampa, fecha , 2000);
count++;
break;

case 2:
digitalWrite(enablePin,HIGH);
delay(2000);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , abre , 1000);
comando(pata , desl, 1000);
comando(pata,aceno,300);
comando(pata,desl,300);
comando(pata,aceno,300);
comando(pata,desl,300);
comando(pata,aceno,300);
comando(pata,desl,2000);
comando(pata , guarda , 1000);
comando(tampa, fecha , 2000);
count++;
break;

case 3:
digitalWrite(enablePin,HIGH);
delay(3000);
comando(tampa , abre , 750);
comando(pata , desl, 1000);
comando(pata , guarda , 1000);
comando(tampa, fecha , 1500);
comando(tampa , abre , 1500);
comando(pata,desl,300);
comando(pata,aceno,300);
comando(pata,desl,300);
comando(pata,aceno,300);
comando(pata,desl,2000);
comando(pata,guarda,1000);
comando(tampa, fecha , 2000);
comando(tampa , meio, 2000);
comando(tampa, fecha, 1000);
count++;
break;

case 4:
digitalWrite(enablePin,HIGH);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa , fresta , Tbatida);
comando(tampa , bate   , Tbatida);
comando(tampa, abre, 750);
comando(tampa, bate, 750);
comando(tampa, abre, 1250);
comando(pata , desl, 1000);
comando(pata , guarda , 1000);
comando(tampa, fecha , 2000);
limite = false;                         //encerra while
break;

}

}

}

}