Projeto Mecatrônico / Mbed 2 deprecated ProjetoMecatronico

testando

Dependencies:   mbed TextLCD2

main_PM.cpp@25:b0db528c1985, 2020-05-26 (annotated)

Committer:
amandarm
Date:
Tue May 26 15:03:18 2020 +0000
Revision:
25:b0db528c1985
Parent:
22:dd336b95db5d
Child:
26:4123b9462158
funcao com clear e iterrupcao

Who changed what in which revision?

UserRevisionLine numberNew contents of line
enricoan 20:81a44a25b21d 1 //local para inclusão de bibliotecas
enricoan 10:4f49e9859535 2 #include "mbed.h"
enricoan 10:4f49e9859535 3 #include "TextLCD.h"
enricoan 10:4f49e9859535 4 #include "Keypad.h"
enricoan 10:4f49e9859535 5
enricoan 17:4d0b8ed791e0 6 //local para a declaração de variáveis
enricoan 20:81a44a25b21d 7 float t_motor = 0.002;
enricoan 10:4f49e9859535 8 float t_teclado = 0.01;
enricoan 19:ebe198368444 9 int hor[] = {12,6,3,9};
enricoan 19:ebe198368444 10 int antihor[] = {3,6,12,9};
enricoan 16:70baa0057a76 11 int parado[] = {0,0,0,0};
enricoan 16:70baa0057a76 12 char tecla;
enricoan 18:3c40a8a17963 13 float coord_x = 0;
enricoan 18:3c40a8a17963 14 float coord_y = 0;
enricoan 18:3c40a8a17963 15 float coord_z = 0;
enricoan 20:81a44a25b21d 16 int est_x = 0;
enricoan 20:81a44a25b21d 17 int est_y = 0;
enricoan 20:81a44a25b21d 18 int est_z = 0;
enricoan 17:4d0b8ed791e0 19
enricoan 17:4d0b8ed791e0 20 //pinos usados pelos botões de fim de curso
enricoan 17:4d0b8ed791e0 21 DigitalIn fdc_x(PC_10);
enricoan 17:4d0b8ed791e0 22 DigitalIn fdc_y(PC_11);
enricoan 17:4d0b8ed791e0 23 DigitalIn fdc_z(PC_12);
enricoan 20:81a44a25b21d 24
amandarm 25:b0db528c1985 25 //Iterrupção botão de emergência
amandarm 25:b0db528c1985 26 InterruptIn emergencia_botao(PC_13); //trocar esse botão para onde está o botão de fato
amandarm 25:b0db528c1985 27
amandarm 25:b0db528c1985 28 //pinos do relé
amandarm 25:b0db528c1985 29 DigitalOut rele1(); //colocar pino do relé
amandarm 25:b0db528c1985 30 DigitalOut rele2(); //colocar pino do relé
amandarm 25:b0db528c1985 31
enricoan 10:4f49e9859535 32 //botões para movimentação eixo a eixo
enricoan 10:4f49e9859535 33 DigitalIn x_mais(PA_0);
enricoan 10:4f49e9859535 34 DigitalIn x_menos(PA_1);
enricoan 10:4f49e9859535 35 DigitalIn y_mais(PC_0);
enricoan 10:4f49e9859535 36 DigitalIn y_menos(PC_1);
enricoan 10:4f49e9859535 37 DigitalIn z_mais(PC_2);
enricoan 10:4f49e9859535 38 DigitalIn z_menos(PC_3);
enricoan 10:4f49e9859535 39
enricoan 10:4f49e9859535 40 //pinos da placa usados na biblioteca do LCD
enricoan 10:4f49e9859535 41 TextLCD lcd(D4, D5, D6, D7, D8, D9);
enricoan 10:4f49e9859535 42
enricoan 16:70baa0057a76 43 //pinos do teclado
enricoan 16:70baa0057a76 44 Keypad teclado(PA_6, PA_7, PB_6, PC_7, PB_7, PC_13, PC_14, PC_15);
enricoan 16:70baa0057a76 45
enricoan 10:4f49e9859535 46 //pinos de saída para os motores
enricoan 10:4f49e9859535 47 //eixo x
Hiroball 11:dc557e461dfd 48 BusOut eixox(PA_15,PA_14,PA_13,PA_12);
enricoan 10:4f49e9859535 49 //eixo y
Hiroball 11:dc557e461dfd 50 BusOut eixoy(PA_11,PA_10,PB_2,PB_1);
enricoan 10:4f49e9859535 51 //eixo z
Hiroball 11:dc557e461dfd 52 BusOut eixoz(PC_9,PC_8,PB_8,PC_6);
enricoan 10:4f49e9859535 53
amandarm 22:dd336b95db5d 54 //funções para as telas da IHM
amandarm 22:dd336b95db5d 55
amandarm 22:dd336b95db5d 56 void funcao_inicio(){
amandarm 25:b0db528c1985 57 lcd.cls();
amandarm 22:dd336b95db5d 58 lcd.printf("1-Novo programa");
amandarm 22:dd336b95db5d 59 lcd.locate(0,1);
amandarm 22:dd336b95db5d 60 lcd.printf("2-Usar programa salvo");
amandarm 22:dd336b95db5d 61 lcd.locate(0,2);
amandarm 22:dd336b95db5d 62 }
amandarm 22:dd336b95db5d 63
amandarm 22:dd336b95db5d 64 void funcao_tela_zera(){
amandarm 25:b0db528c1985 65 lcd.cls();
amandarm 25:b0db528c1985 66 lcd.printf("Zeramento:");
amandarm 25:b0db528c1985 67 lcd.locate(0,1);
amandarm 25:b0db528c1985 68 lcd.printf("Confira se não há");
amandarm 25:b0db528c1985 69 lcd.locate(0,2);
amandarm 25:b0db528c1985 70 lcd.printf("objetos sobre a mesa");
amandarm 25:b0db528c1985 71 lcd.locate(0,3);
amandarm 25:b0db528c1985 72 lcd.printf("A-Próximo B-Voltar");
amandarm 22:dd336b95db5d 73 }
amandarm 22:dd336b95db5d 74
amandarm 22:dd336b95db5d 75 void funcao_pega1(){
amandarm 25:b0db528c1985 76 lcd.cls();
amandarm 25:b0db528c1985 77 lcd.printf("Configuração de pega");
amandarm 25:b0db528c1985 78 lcd.locate(0,1);
amandarm 25:b0db528c1985 79 lcd.printf("1-Forma do pega");
amandarm 25:b0db528c1985 80 lcd.locate(0,2);
amandarm 25:b0db528c1985 81 lcd.printf("2-Volume do pega");
amandarm 25:b0db528c1985 82 lcd.locate(0,3);
amandarm 25:b0db528c1985 83 lcd.printf(" B-Voltar");
amandarm 22:dd336b95db5d 84 }
amandarm 22:dd336b95db5d 85
amandarm 22:dd336b95db5d 86 void funcao_pega2(){
amandarm 25:b0db528c1985 87 lcd.cls();
amandarm 25:b0db528c1985 88 lcd.printf("Configuração de pega");
amandarm 25:b0db528c1985 89 lcd.locate(0,1);
amandarm 25:b0db528c1985 90 lcd.printf("3-Posição do pega");
amandarm 25:b0db528c1985 91 lcd.locate(0,2);
amandarm 25:b0db528c1985 92 lcd.printf("");
amandarm 25:b0db528c1985 93 lcd.locate(0,3);
amandarm 25:b0db528c1985 94 lcd.printf(" B-Voltar");
amandarm 22:dd336b95db5d 95 }
amandarm 22:dd336b95db5d 96
amandarm 22:dd336b95db5d 97 void funcao_pega_forma(){
amandarm 25:b0db528c1985 98 lcd.cls();
amandarm 22:dd336b95db5d 99 lcd.printf("Forma do pega");
amandarm 22:dd336b95db5d 100 lcd.locate(0,1);
amandarm 22:dd336b95db5d 101 lcd.printf("1 - Quadrado");
amandarm 22:dd336b95db5d 102 lcd.locate(0,2);
amandarm 22:dd336b95db5d 103 lcd.printf("2 - Circular");
amandarm 22:dd336b95db5d 104 lcd.locate(0,3);
amandarm 22:dd336b95db5d 105 lcd.printf(" B-Voltar");
amandarm 22:dd336b95db5d 106 }
amandarm 22:dd336b95db5d 107
amandarm 22:dd336b95db5d 108 void funcao_pega_volume(){
amandarm 25:b0db528c1985 109 lcd.cls();
amandarm 22:dd336b95db5d 110 lcd.printf("Insira o volume");
amandarm 22:dd336b95db5d 111 lcd.locate(0,1);
amandarm 22:dd336b95db5d 112 lcd.printf("Em ml:");
amandarm 22:dd336b95db5d 113 lcd.locate(0,2);
amandarm 22:dd336b95db5d 114 lcd.printf("");
amandarm 22:dd336b95db5d 115 lcd.locate(0,3);
amandarm 22:dd336b95db5d 116 lcd.printf("A-Próximo B-Voltar");
amandarm 22:dd336b95db5d 117 }
amandarm 22:dd336b95db5d 118
amandarm 22:dd336b95db5d 119 void funcao_pega_forma_quad(){
amandarm 25:b0db528c1985 120 lcd.cls();
amandarm 22:dd336b95db5d 121 lcd.printf("Dimensões do pega");
amandarm 22:dd336b95db5d 122 lcd.locate(0,1);
amandarm 22:dd336b95db5d 123 lcd.printf("Comprimento em mm");
amandarm 22:dd336b95db5d 124 lcd.locate(0,2);
amandarm 22:dd336b95db5d 125 lcd.printf("");
amandarm 22:dd336b95db5d 126 lcd.locate(0,3);
amandarm 22:dd336b95db5d 127 lcd.printf("A-Próximo B-Voltar");
amandarm 22:dd336b95db5d 128 }
amandarm 22:dd336b95db5d 129
amandarm 22:dd336b95db5d 130 void funcao_pega_forma_red(){
amandarm 25:b0db528c1985 131 lcd.cls();
amandarm 22:dd336b95db5d 132 lcd.printf("Dimensões do pega");
amandarm 22:dd336b95db5d 133 lcd.locate(0,1);
amandarm 22:dd336b95db5d 134 lcd.printf("Diamentro em mm");
amandarm 22:dd336b95db5d 135 lcd.locate(0,2);
amandarm 22:dd336b95db5d 136 lcd.printf("");
amandarm 22:dd336b95db5d 137 lcd.locate(0,3);
amandarm 22:dd336b95db5d 138 lcd.printf("A-Próximo B-Voltar");
amandarm 22:dd336b95db5d 139 }
amandarm 22:dd336b95db5d 140 void funcao_pega_pos_x(){ //desativar os botões de Y
amandarm 25:b0db528c1985 141 lcd.cls();
amandarm 22:dd336b95db5d 142 lcd.printf("Posicione pega em X");
amandarm 22:dd336b95db5d 143 lcd.locate(0,1);
amandarm 22:dd336b95db5d 144 lcd.printf("Use botões até chegar");
amandarm 22:dd336b95db5d 145 lcd.locate(0,2);
amandarm 22:dd336b95db5d 146 lcd.printf("na posição desejada");
amandarm 22:dd336b95db5d 147 lcd.locate(0,3);
amandarm 22:dd336b95db5d 148 lcd.printf("A-Confirma B-Voltar");
amandarm 22:dd336b95db5d 149 }
amandarm 22:dd336b95db5d 150
amandarm 22:dd336b95db5d 151 void funcao_pega_pos_y(){ //desativar os botões de X
amandarm 25:b0db528c1985 152 lcd.cls();
amandarm 22:dd336b95db5d 153 lcd.printf("Posicione pega em Y");
amandarm 22:dd336b95db5d 154 lcd.locate(0,1);
amandarm 22:dd336b95db5d 155 lcd.printf("Use botões até chegar");
amandarm 22:dd336b95db5d 156 lcd.locate(0,2);
amandarm 22:dd336b95db5d 157 lcd.printf("na posição desejada");
amandarm 22:dd336b95db5d 158 lcd.locate(0,3);
amandarm 22:dd336b95db5d 159 lcd.printf("A-Confirma B-Voltar");
amandarm 22:dd336b95db5d 160 }
amandarm 22:dd336b95db5d 161
amandarm 22:dd336b95db5d 162 void funcao_solta1(){
amandarm 25:b0db528c1985 163 lcd.cls();
amandarm 22:dd336b95db5d 164 lcd.printf("Configuração solta");
amandarm 22:dd336b95db5d 165 lcd.locate(0,1);
amandarm 22:dd336b95db5d 166 lcd.printf("1-Dimensão solta");
amandarm 22:dd336b95db5d 167 lcd.locate(0,2);
amandarm 22:dd336b95db5d 168 lcd.printf("2-Volume da solta");
amandarm 22:dd336b95db5d 169 lcd.locate(0,3);
amandarm 22:dd336b95db5d 170 lcd.printf(" B-Voltar");
amandarm 22:dd336b95db5d 171 }
amandarm 22:dd336b95db5d 172
amandarm 22:dd336b95db5d 173 void funcao_solta2(){
amandarm 25:b0db528c1985 174 lcd.cls();
amandarm 22:dd336b95db5d 175 lcd.printf("Configuração solta");
amandarm 22:dd336b95db5d 176 lcd.locate(0,1);
amandarm 22:dd336b95db5d 177 lcd.printf("3-Posição solta");
amandarm 22:dd336b95db5d 178 lcd.locate(0,2);
amandarm 22:dd336b95db5d 179 lcd.printf("");
amandarm 22:dd336b95db5d 180 lcd.locate(0,3);
amandarm 22:dd336b95db5d 181 lcd.printf(" B-Voltar");
amandarm 22:dd336b95db5d 182 }
amandarm 22:dd336b95db5d 183
amandarm 22:dd336b95db5d 184 void funcao_solta_dimensao(){
amandarm 25:b0db528c1985 185 lcd.cls();
amandarm 22:dd336b95db5d 186 lcd.printf("Insira o diametro");
amandarm 22:dd336b95db5d 187 lcd.locate(0,1);
amandarm 22:dd336b95db5d 188 lcd.printf("de solta, em mm:");
amandarm 22:dd336b95db5d 189 lcd.locate(0,2);
amandarm 22:dd336b95db5d 190 lcd.printf("");
amandarm 22:dd336b95db5d 191 lcd.printf(0,3);
amandarm 22:dd336b95db5d 192 lcd.printf("A-Próximo B-Voltar");
amandarm 22:dd336b95db5d 193 }
amandarm 22:dd336b95db5d 194
amandarm 22:dd336b95db5d 195 void funcao_solta_vol(){
amandarm 25:b0db528c1985 196 lcd.cls();
amandarm 22:dd336b95db5d 197 lcd.printf("Determinar volume");
amandarm 22:dd336b95db5d 198 lcd.locate(0,1);
amandarm 22:dd336b95db5d 199 lcd.printf("1-Todos mesmo volume");
amandarm 22:dd336b95db5d 200 lcd.locate(0,2);
amandarm 22:dd336b95db5d 201 lcd.printf("2-Pino a pino");
amandarm 22:dd336b95db5d 202 lcd.locate(0,3);
amandarm 22:dd336b95db5d 203 lcd.printf("A-Próximo B-Voltar");
amandarm 22:dd336b95db5d 204 }
amandarm 22:dd336b95db5d 205
amandarm 22:dd336b95db5d 206 void funcao_solta_vol_igual(){
amandarm 25:b0db528c1985 207 lcd.cls();
amandarm 22:dd336b95db5d 208 lcd.printf("Insira o volume");
amandarm 22:dd336b95db5d 209 lcd.locate(0,1);
amandarm 22:dd336b95db5d 210 lcd.printf("em ml:");
amandarm 22:dd336b95db5d 211 lcd.locate(0,2);
amandarm 22:dd336b95db5d 212 lcd.printf("");
amandarm 22:dd336b95db5d 213 lcd.locate(0,3);
amandarm 22:dd336b95db5d 214 lcd.printf("A-Próximo B-Voltar");
amandarm 22:dd336b95db5d 215 }
amandarm 22:dd336b95db5d 216
amandarm 22:dd336b95db5d 217 void funcao_solta_vol_cada(){
amandarm 25:b0db528c1985 218 lcd.cls();
amandarm 22:dd336b95db5d 219 lcd.printf("Seleção: * * * ");
amandarm 22:dd336b95db5d 220 lcd.locate(0,1);
amandarm 22:dd336b95db5d 221 lcd.printf("Volume: * * * ");
amandarm 22:dd336b95db5d 222 lcd.locate(0,2);
amandarm 22:dd336b95db5d 223 lcd.printf("A-Confirma * * * ");
amandarm 22:dd336b95db5d 224 lcd.locate(0,3);
amandarm 22:dd336b95db5d 225 lcd.printf("B-Corrigir C-Próximo");
amandarm 22:dd336b95db5d 226 }
amandarm 22:dd336b95db5d 227
amandarm 22:dd336b95db5d 228 void funcao_solta_pos_x(){ //desativar os botões de Y
amandarm 25:b0db528c1985 229 lcd.cls();
amandarm 22:dd336b95db5d 230 lcd.printf("Posicione pega em X");
amandarm 22:dd336b95db5d 231 lcd.locate(0,1);
amandarm 22:dd336b95db5d 232 lcd.printf("Use botões até chegar");
amandarm 22:dd336b95db5d 233 lcd.locate(0,2);
amandarm 22:dd336b95db5d 234 lcd.printf("na posição desejada");
amandarm 22:dd336b95db5d 235 lcd.locate(0,3);
amandarm 22:dd336b95db5d 236 lcd.printf("A-Confirma B-Voltar");
amandarm 22:dd336b95db5d 237 }
amandarm 22:dd336b95db5d 238
amandarm 22:dd336b95db5d 239 void funcao_solta_pos_y(){ //desativar os botões de X
amandarm 25:b0db528c1985 240 lcd.cls();
amandarm 22:dd336b95db5d 241 lcd.printf("Posicione pega em Y");
amandarm 22:dd336b95db5d 242 lcd.locate(0,1);
amandarm 22:dd336b95db5d 243 lcd.printf("Use botões até chegar");
amandarm 22:dd336b95db5d 244 lcd.locate(0,2);
amandarm 22:dd336b95db5d 245 lcd.printf("na posição desejada");
amandarm 22:dd336b95db5d 246 lcd.printf(0,3);
amandarm 22:dd336b95db5d 247 lcd.printf("A-Confirma B-Voltar");
amandarm 22:dd336b95db5d 248 }
amandarm 22:dd336b95db5d 249
amandarm 22:dd336b95db5d 250 void funcao_confirma(){
amandarm 25:b0db528c1985 251 lcd.cls();
amandarm 22:dd336b95db5d 252 lcd.printf("Revisão Parametros");
amandarm 22:dd336b95db5d 253 lcd.locate(0,1);
amandarm 22:dd336b95db5d 254 lcd.printf("1-Pega:");
amandarm 22:dd336b95db5d 255 lcd.locate(0,2);
amandarm 22:dd336b95db5d 256 lcd.printf("2-Pinos solta:");
amandarm 22:dd336b95db5d 257 lcd.locate(0,3);
amandarm 22:dd336b95db5d 258 lcd.printf("A-Confirma B-Voltar");
amandarm 22:dd336b95db5d 259 }
amandarm 22:dd336b95db5d 260
amandarm 22:dd336b95db5d 261 void funcao_nome_prog(){
amandarm 25:b0db528c1985 262 lcd.cls();
amandarm 22:dd336b95db5d 263 lcd.printf("Nome do programa");
amandarm 22:dd336b95db5d 264 lcd.locate(0,1);
amandarm 22:dd336b95db5d 265 lcd.printf("Insira um código");
amandarm 22:dd336b95db5d 266 lcd.locate(0,2);
amandarm 22:dd336b95db5d 267 lcd.printf("para seu programa:");
amandarm 22:dd336b95db5d 268 lcd.locate(0,3);
amandarm 22:dd336b95db5d 269 lcd.printf("A-Confirma B-Voltar");
amandarm 22:dd336b95db5d 270 }
amandarm 22:dd336b95db5d 271
amandarm 22:dd336b95db5d 272 void funcao_acomp(){ //colocar os valores adequados na tela
amandarm 25:b0db528c1985 273 lcd.cls();
amandarm 22:dd336b95db5d 274 lcd.printf("Prog em execução");
amandarm 22:dd336b95db5d 275 lcd.locate(0,1);
amandarm 22:dd336b95db5d 276 lcd.printf("Tempo: xx min yy s");
amandarm 22:dd336b95db5d 277 lcd.locate(0,2);
amandarm 22:dd336b95db5d 278 lcd.printf("Progresso: zz%");
amandarm 22:dd336b95db5d 279 lcd.locate(0,3);
amandarm 22:dd336b95db5d 280 lcd.printf("A-Pausar");
amandarm 22:dd336b95db5d 281 }
amandarm 22:dd336b95db5d 282
amandarm 22:dd336b95db5d 283 void funcao_pausa(){
amandarm 25:b0db528c1985 284 lcd.cls();
amandarm 22:dd336b95db5d 285 lcd.printf("Prog pausado");
amandarm 22:dd336b95db5d 286 lcd.locate(0,1);
amandarm 22:dd336b95db5d 287 lcd.printf("Progresso: zz%");
amandarm 22:dd336b95db5d 288 lcd.locate(0,2);
amandarm 22:dd336b95db5d 289 lcd.printf("");
amandarm 22:dd336b95db5d 290 lcd.locate(0,3);
amandarm 22:dd336b95db5d 291 lcd.printf("A-Continuar B-Parar");
amandarm 22:dd336b95db5d 292 }
amandarm 22:dd336b95db5d 293
amandarm 25:b0db528c1985 294 void funcao_salvo1(){
amandarm 25:b0db528c1985 295 lcd.cls();
amandarm 22:dd336b95db5d 296 lcd.printf("1-xx");
amandarm 22:dd336b95db5d 297 lcd.locate(0,1);
amandarm 22:dd336b95db5d 298 lcd.printf("2-yy");
amandarm 22:dd336b95db5d 299 lcd.locate(0,2);
amandarm 22:dd336b95db5d 300 lcd.printf("3-zz");
amandarm 22:dd336b95db5d 301 lcd.locate(0,3);
amandarm 22:dd336b95db5d 302 lcd.printf("A-Próxima B-Anterior");
amandarm 22:dd336b95db5d 303 }
amandarm 22:dd336b95db5d 304
amandarm 25:b0db528c1985 305 void funcao_salvo2(){
amandarm 25:b0db528c1985 306 lcd.cls();
amandarm 22:dd336b95db5d 307 lcd.printf("4-xx");
amandarm 22:dd336b95db5d 308 lcd.locate(0,1);
amandarm 22:dd336b95db5d 309 lcd.printf("5-yy");
amandarm 22:dd336b95db5d 310 lcd.locate(0,2);
amandarm 22:dd336b95db5d 311 lcd.printf("6-zz");
amandarm 22:dd336b95db5d 312 lcd.locate(0,3);
amandarm 22:dd336b95db5d 313 lcd.printf("A-Próxima B-Anterior");
amandarm 22:dd336b95db5d 314 }
amandarm 22:dd336b95db5d 315
amandarm 22:dd336b95db5d 316 void funcao_salvo_agree1(){
amandarm 25:b0db528c1985 317 lcd.cls();
amandarm 22:dd336b95db5d 318 lcd.printf("Confirmar programa");
amandarm 22:dd336b95db5d 319 lcd.locate(0,1);
amandarm 22:dd336b95db5d 320 lcd.printf("1-Posição pega");
amandarm 22:dd336b95db5d 321 lcd.locate(0,2);
amandarm 22:dd336b95db5d 322 lcd.printf("2-Posição solta");
amandarm 22:dd336b95db5d 323 lcd.locate(0,3);
amandarm 22:dd336b95db5d 324 lcd.printf(" B-Voltar");
amandarm 22:dd336b95db5d 325 }
amandarm 22:dd336b95db5d 326
amandarm 22:dd336b95db5d 327 void funcao_salvo_agree2(){
amandarm 25:b0db528c1985 328 lcd.cls();
amandarm 22:dd336b95db5d 329 lcd.printf("Confirmar programa");
amandarm 22:dd336b95db5d 330 lcd.locate(0,1);
amandarm 22:dd336b95db5d 331 lcd.printf("3-Volume pega");
amandarm 22:dd336b95db5d 332 lcd.locate(0,2);
amandarm 22:dd336b95db5d 333 lcd.printf("4-Volume solta");
amandarm 22:dd336b95db5d 334 lcd.locate(0,3);
amandarm 22:dd336b95db5d 335 lcd.printf(" B-Voltar");
amandarm 22:dd336b95db5d 336 }
amandarm 22:dd336b95db5d 337
amandarm 22:dd336b95db5d 338 void funcao_salvo_agree_pos_aviso(){
amandarm 25:b0db528c1985 339 lcd.cls();
amandarm 22:dd336b95db5d 340 lcd.printf("A pipeta irá na pega");
amandarm 22:dd336b95db5d 341 lcd.locate(0,1);
amandarm 22:dd336b95db5d 342 lcd.printf("Certifique-se que não");
amandarm 22:dd336b95db5d 343 lcd.locate(0,2);
amandarm 22:dd336b95db5d 344 lcd.printf("há objetos na mesa");
amandarm 22:dd336b95db5d 345 lcd.locate(0,3);
amandarm 22:dd336b95db5d 346 lcd.printf("A-Confirma B-Voltar");
amandarm 22:dd336b95db5d 347 }
amandarm 22:dd336b95db5d 348
amandarm 22:dd336b95db5d 349 void funcao_salvo_agree_pos_certo(){
amandarm 25:b0db528c1985 350 lcd.cls();
amandarm 22:dd336b95db5d 351 lcd.printf("Posicão correta?");
amandarm 22:dd336b95db5d 352 lcd.locate(0,1);
amandarm 22:dd336b95db5d 353 lcd.printf("1-Sim");
amandarm 22:dd336b95db5d 354 lcd.locate(0,2);
amandarm 22:dd336b95db5d 355 lcd.printf("2-Ajustar");
amandarm 22:dd336b95db5d 356 lcd.locate(0,3);
amandarm 22:dd336b95db5d 357 lcd.printf(" B-Voltar");
amandarm 22:dd336b95db5d 358 }
amandarm 22:dd336b95db5d 359
amandarm 22:dd336b95db5d 360 void funcao_salvo_agree_solta_aviso(){
amandarm 25:b0db528c1985 361 lcd.cls();
amandarm 22:dd336b95db5d 362 lcd.printf("A pipeta irá na solta");
amandarm 22:dd336b95db5d 363 lcd.locate(0,1);
amandarm 22:dd336b95db5d 364 lcd.printf("Certifique-se que não");
amandarm 22:dd336b95db5d 365 lcd.locate(0,2);
amandarm 22:dd336b95db5d 366 lcd.printf("há objetos na mesa");
amandarm 22:dd336b95db5d 367 lcd.locate(0,3);
amandarm 22:dd336b95db5d 368 lcd.printf("A-Confirma B-Voltar");
amandarm 22:dd336b95db5d 369 }
amandarm 22:dd336b95db5d 370
amandarm 22:dd336b95db5d 371 void funcao_salvo_agree_pega_vol(){
amandarm 25:b0db528c1985 372 lcd.cls();
amandarm 22:dd336b95db5d 373 lcd.printf("Insira o volume pega");
amandarm 22:dd336b95db5d 374 lcd.locate(0,1);
amandarm 22:dd336b95db5d 375 lcd.printf("Em ml:");
amandarm 22:dd336b95db5d 376 lcd.locate(0,2);
amandarm 22:dd336b95db5d 377 lcd.printf("");
amandarm 22:dd336b95db5d 378 lcd.locate(0,3);
amandarm 22:dd336b95db5d 379 lcd.printf("A-Confirma B-Voltar");
amandarm 22:dd336b95db5d 380 }
amandarm 22:dd336b95db5d 381
amandarm 22:dd336b95db5d 382 void funcao_salvo_agree_solta_vol(){
amandarm 25:b0db528c1985 383 lcd.cls();
amandarm 22:dd336b95db5d 384 lcd.printf("1-x 2-y 3-z");
amandarm 22:dd336b95db5d 385 lcd.locate(0,1);
amandarm 22:dd336b95db5d 386 lcd.printf("4-x 5-y 6-z");
amandarm 22:dd336b95db5d 387 lcd.locate(0,2);
amandarm 22:dd336b95db5d 388 lcd.printf("7-x 8-y 9-z");
amandarm 22:dd336b95db5d 389 lcd.locate(0,3);
amandarm 22:dd336b95db5d 390 lcd.printf("A-Confirma B-Voltar");
amandarm 22:dd336b95db5d 391 }
amandarm 22:dd336b95db5d 392
amandarm 25:b0db528c1985 393 //Função de iterrupção
amandarm 25:b0db528c1985 394 void emergencia()
amandarm 25:b0db528c1985 395 {
amandarm 25:b0db528c1985 396 while(emergencia_botao == 0){
amandarm 25:b0db528c1985 397 rele1 = 0;
amandarm 25:b0db528c1985 398 eixox = 0b0000;
amandarm 25:b0db528c1985 399 eixoy = 0b0000;
amandarm 25:b0db528c1985 400 eixoz = 0b0000;
amandarm 25:b0db528c1985 401 lcd.cls();
amandarm 25:b0db528c1985 402 lcd.printf("Botão Emergência");
amandarm 25:b0db528c1985 403 lcd.locate(0,1);
amandarm 25:b0db528c1985 404 lcd.printf(" acionado ");
amandarm 25:b0db528c1985 405 lcd.locate(0,2);
amandarm 25:b0db528c1985 406 lcd.printf("Operação pausada");
amandarm 25:b0db528c1985 407 lcd.locate(0,3);
amandarm 25:b0db528c1985 408 lcd.printf(");
amandarm 25:b0db528c1985 409 }
amandarm 25:b0db528c1985 410 }
amandarm 25:b0db528c1985 411
amandarm 25:b0db528c1985 412
enricoan 10:4f49e9859535 413 int main() {
enricoan 20:81a44a25b21d 414 printf("\n%i",est_x);
enricoan 20:81a44a25b21d 415 printf("\n%i",est_y);
enricoan 20:81a44a25b21d 416 printf("\n%i",est_z);
enricoan 16:70baa0057a76 417 lcd.printf("Bem-vindo ao Pipemax");
Hiroball 11:dc557e461dfd 418 lcd.locate(0,1);
enricoan 16:70baa0057a76 419 lcd.printf("o seu sistema");
Hiroball 11:dc557e461dfd 420 lcd.locate(0,2);
enricoan 16:70baa0057a76 421 lcd.printf("automatizado");
Hiroball 11:dc557e461dfd 422 lcd.locate(0,3);
enricoan 16:70baa0057a76 423 lcd.printf("de pipetagem");
enricoan 19:ebe198368444 424 while (fdc_x != 0){for(int i = 0; i < 4; i++){eixox = hor[i];wait(t_motor);est_x = 1;}}
enricoan 19:ebe198368444 425 while (fdc_y != 0){for(int i = 0; i < 4; i++){eixoy = hor[i];wait(t_motor);est_y = 1;}}
enricoan 19:ebe198368444 426 while (fdc_z != 0){for(int i = 0; i < 4; i++){eixoz = hor[i];wait(t_motor);est_z = 1;}}
enricoan 20:81a44a25b21d 427 printf("\n%i",est_x);
enricoan 20:81a44a25b21d 428 printf("\n%i",est_y);
enricoan 20:81a44a25b21d 429 printf("\n%i",est_z);
Hiroball 11:dc557e461dfd 430 while(1) {
enricoan 16:70baa0057a76 431 int solta = 1;
enricoan 16:70baa0057a76 432 tecla = teclado.ReadKey(); //read the current key pressed
enricoan 16:70baa0057a76 433 if(tecla == '\0') solta = 1; //set the flag when all keys are released
enricoan 16:70baa0057a76 434 if((tecla != '\0') && (solta == 1)) { //if a key is pressed AND previous key was released
enricoan 16:70baa0057a76 435 printf("%c\n", tecla);
enricoan 16:70baa0057a76 436 solta = 0; //clear the flag to indicate that key is still pressed
enricoan 16:70baa0057a76 437 wait(0.1);}
enricoan 19:ebe198368444 438 /* tentativa de fazer o motor parar ao apertar algum dos fins de curso
enricoan 18:3c40a8a17963 439 if(fdc_x == 0 || fdc_y == 0 || fdc_z == 0){
enricoan 18:3c40a8a17963 440 for(int i = 0; i < 4; i++){eixox = parado[i];wait(t_motor);est_x = 1;}
enricoan 18:3c40a8a17963 441 for(int i = 0; i < 4; i++){eixoy = parado[i];wait(t_motor);est_y = 1;}
enricoan 18:3c40a8a17963 442 for(int i = 0; i < 4; i++){eixoz = parado[i];wait(t_motor);est_z = 1;}
enricoan 19:ebe198368444 443 */
enricoan 19:ebe198368444 444 if (x_mais == 0 && est_x == 1){for(int i = 0; i < 4; i++){eixox = parado[i];wait(t_motor);coord_x += 0;lcd.cls();lcd.printf("Limite de x atingido");}}
enricoan 19:ebe198368444 445 if (y_mais == 0 && est_y == 1){for(int i = 0; i < 4; i++){eixoy = parado[i];wait(t_motor);coord_y += 0;lcd.cls();lcd.printf("Limite de y atingido");}}
enricoan 19:ebe198368444 446 if (z_mais == 0 && est_z == 1){for(int i = 0; i < 4; i++){eixoz = parado[i];wait(t_motor);coord_z += 0;lcd.cls();lcd.printf("Limite de z atingido");}}
enricoan 19:ebe198368444 447
enricoan 19:ebe198368444 448 if (x_menos == 0){for(int i = 0; i < 4; i++){eixox = antihor[i];wait(t_motor);coord_x -= (5.625*5/32)/360;est_x = 0;
enricoan 16:70baa0057a76 449 lcd.cls();
enricoan 18:3c40a8a17963 450 lcd.printf("X: %4.1f", coord_x);
enricoan 18:3c40a8a17963 451 lcd.locate(0,1);
enricoan 18:3c40a8a17963 452 lcd.printf("Y: %4.1f", coord_y);
enricoan 18:3c40a8a17963 453 lcd.locate(0,2);
enricoan 18:3c40a8a17963 454 lcd.printf("Z: %4.1f", coord_z);}}
enricoan 19:ebe198368444 455 if (y_menos == 0){for(int i = 0; i < 4; i++){eixoy = antihor[i];wait(t_motor);coord_y -= (5.625*5/32)/360;est_y = 0;
enricoan 19:ebe198368444 456 lcd.cls();
enricoan 19:ebe198368444 457 lcd.printf("X: %4.1f", coord_x);
enricoan 19:ebe198368444 458 lcd.locate(0,1);
enricoan 19:ebe198368444 459 lcd.printf("Y: %4.1f", coord_y);
enricoan 19:ebe198368444 460 lcd.locate(0,2);
enricoan 19:ebe198368444 461 lcd.printf("Z: %4.1f", coord_z);}}
enricoan 19:ebe198368444 462 if (z_menos == 0){for(int i = 0; i < 4; i++){eixoz = antihor[i];wait(t_motor);coord_z -= (5.625*5/32)/360;est_z = 0;
enricoan 18:3c40a8a17963 463 lcd.cls();
enricoan 18:3c40a8a17963 464 lcd.printf("X: %4.1f", coord_x);
enricoan 16:70baa0057a76 465 lcd.locate(0,1);
enricoan 18:3c40a8a17963 466 lcd.printf("Y: %4.1f", coord_y);
enricoan 18:3c40a8a17963 467 lcd.locate(0,2);
enricoan 18:3c40a8a17963 468 lcd.printf("Z: %4.1f", coord_z);}}
enricoan 19:ebe198368444 469
enricoan 19:ebe198368444 470 if (x_mais == 0){for(int i = 0; i < 4; i++){eixox = hor[i];wait(t_motor);coord_x += (5.625*5/32)/360;est_x = 0;
enricoan 19:ebe198368444 471 lcd.cls();
enricoan 19:ebe198368444 472 lcd.printf("X: %4.1f", coord_x);
enricoan 19:ebe198368444 473 lcd.locate(0,1);
enricoan 19:ebe198368444 474 lcd.printf("Y: %4.1f", coord_y);
enricoan 19:ebe198368444 475 lcd.locate(0,2);
enricoan 19:ebe198368444 476 lcd.printf("Z: %4.1f", coord_z);}}
enricoan 19:ebe198368444 477 if (y_mais == 0){for(int i = 0; i < 4; i++){eixoy = hor[i];wait(t_motor);coord_y += (5.625*5/32)/360;est_y = 0;
enricoan 18:3c40a8a17963 478 lcd.cls();
enricoan 18:3c40a8a17963 479 lcd.printf("X: %4.1f", coord_x);
enricoan 18:3c40a8a17963 480 lcd.locate(0,1);
enricoan 18:3c40a8a17963 481 lcd.printf("Y: %4.1f", coord_y);
enricoan 18:3c40a8a17963 482 lcd.locate(0,2);
enricoan 18:3c40a8a17963 483 lcd.printf("Z: %4.1f", coord_z);}}
enricoan 19:ebe198368444 484 if (z_mais == 0){for(int i = 0; i < 4; i++){eixoz = hor[i];wait(t_motor);coord_z += (5.625*5/32)/360;est_z = 0;
enricoan 19:ebe198368444 485 lcd.cls();
enricoan 19:ebe198368444 486 lcd.printf("X: %4.1f", coord_x);
enricoan 19:ebe198368444 487 lcd.locate(0,1);
enricoan 19:ebe198368444 488 lcd.printf("Y: %4.1f", coord_y);
enricoan 19:ebe198368444 489 lcd.locate(0,2);
enricoan 19:ebe198368444 490 lcd.printf("Z: %4.1f", coord_z);}}
enricoan 18:3c40a8a17963 491
enricoan 16:70baa0057a76 492 if (x_mais || x_menos || y_mais || y_menos || z_mais || z_menos != 0){
enricoan 16:70baa0057a76 493 for(int i = 0; i < 4; i++){eixox = parado[i];}
enricoan 16:70baa0057a76 494 for(int i = 0; i < 4; i++){eixoy = parado[i];}
enricoan 16:70baa0057a76 495 for(int i = 0; i < 4; i++){eixoz = parado[i];}
enricoan 16:70baa0057a76 496 }
enricoan 19:ebe198368444 497
enricoan 18:3c40a8a17963 498 /*
enricoan 18:3c40a8a17963 499 lcd.cls();
enricoan 18:3c40a8a17963 500 lcd.printf("X: %4.1f", coord_x);
enricoan 18:3c40a8a17963 501 lcd.locate(0,1);
enricoan 18:3c40a8a17963 502 lcd.printf("Y: %4.1f", coord_y);
enricoan 18:3c40a8a17963 503 lcd.locate(0,2);
enricoan 18:3c40a8a17963 504 lcd.printf("Z: %4.1f", coord_z);
enricoan 18:3c40a8a17963 505 */
enricoan 18:3c40a8a17963 506
Hiroball 11:dc557e461dfd 507 }
enricoan 10:4f49e9859535 508 }