Projeto_Mecatronico_Team / Mbed 2 deprecated Projeto_Mecatronico

Dependencies:   mbed filesystem TextLCD

Fork of Projeto_Mecatronico by Fernando Sakabe

Committer:
ricardoparanhos
Date:
Tue May 03 02:23:27 2022 +0000
Revision:
6:bb07d23b4a84
Parent:
fim_de_curso.cpp@4:c849dfdaab59
Child:
12:a50758242f66
02/05/22 - 23h23

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ricardoparanhos 3:58de9a09d797 1 #include "mbed.h"
ricardoparanhos 6:bb07d23b4a84 2 #include "JOG.h"
ricardoparanhos 3:58de9a09d797 3
ricardoparanhos 6:bb07d23b4a84 4 //Fim de cursos eixo x
ricardoparanhos 6:bb07d23b4a84 5 DigitalIn FDC_x1(PA_2);
ricardoparanhos 6:bb07d23b4a84 6 DigitalIn FDC_x2(PA_10);
ricardoparanhos 6:bb07d23b4a84 7 //Fim de cursos eixo y
ricardoparanhos 6:bb07d23b4a84 8 DigitalIn FDC_y1(PA_8);
ricardoparanhos 6:bb07d23b4a84 9 DigitalIn FDC_y2(PA_9);
ricardoparanhos 6:bb07d23b4a84 10 //Fim de cursos eixo z
ricardoparanhos 6:bb07d23b4a84 11 DigitalIn FDC_z1(PC_7);
ricardoparanhos 6:bb07d23b4a84 12 DigitalIn FDC_z2(PB_6);
ricardoparanhos 6:bb07d23b4a84 13
ricardoparanhos 6:bb07d23b4a84 14 void fim_de_curso()
ricardoparanhos 3:58de9a09d797 15 {
ricardoparanhos 6:bb07d23b4a84 16 FDC_x1.mode(PullUp);
ricardoparanhos 6:bb07d23b4a84 17 FDC_x2.mode(PullUp);
ricardoparanhos 6:bb07d23b4a84 18 FDC_y1.mode(PullUp);
ricardoparanhos 6:bb07d23b4a84 19 FDC_y2.mode(PullUp);
ricardoparanhos 6:bb07d23b4a84 20 FDC_z1.mode(PullUp);
ricardoparanhos 6:bb07d23b4a84 21 FDC_z2.mode(PullUp);
ricardoparanhos 6:bb07d23b4a84 22 float tempo = 0.5; // "tempo"
ricardoparanhos 6:bb07d23b4a84 23
ricardoparanhos 6:bb07d23b4a84 24 while (1)
ricardoparanhos 6:bb07d23b4a84 25 {
ricardoparanhos 6:bb07d23b4a84 26 if (FDC_x1 == 0)
ricardoparanhos 6:bb07d23b4a84 27 {
ricardoparanhos 6:bb07d23b4a84 28 string estado = "x_menos"
ricardoparanhos 6:bb07d23b4a84 29 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 30 }
ricardoparanhos 6:bb07d23b4a84 31
ricardoparanhos 6:bb07d23b4a84 32 if (FDC_x2 == 0)
ricardoparanhos 6:bb07d23b4a84 33 {
ricardoparanhos 6:bb07d23b4a84 34 string estado = "x_mais"
ricardoparanhos 6:bb07d23b4a84 35 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 36 }
ricardoparanhos 6:bb07d23b4a84 37
ricardoparanhos 6:bb07d23b4a84 38 if (FDC_y1 == 0)
ricardoparanhos 6:bb07d23b4a84 39 {
ricardoparanhos 6:bb07d23b4a84 40 string estado = "y_menos"
ricardoparanhos 6:bb07d23b4a84 41 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 42 }
ricardoparanhos 6:bb07d23b4a84 43
ricardoparanhos 6:bb07d23b4a84 44 if (FDC_y2 == 0)
ricardoparanhos 6:bb07d23b4a84 45 {
ricardoparanhos 6:bb07d23b4a84 46 string estado = "y_mais"
ricardoparanhos 6:bb07d23b4a84 47 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 48 }
ricardoparanhos 6:bb07d23b4a84 49
ricardoparanhos 6:bb07d23b4a84 50 if (FDC_z1 == 0)
ricardoparanhos 6:bb07d23b4a84 51 {
ricardoparanhos 6:bb07d23b4a84 52 string estado = "z_menos"
ricardoparanhos 6:bb07d23b4a84 53 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 54 }
ricardoparanhos 6:bb07d23b4a84 55
ricardoparanhos 6:bb07d23b4a84 56 if (FDC_z2 == 0)
ricardoparanhos 6:bb07d23b4a84 57 {
ricardoparanhos 6:bb07d23b4a84 58 string estado = "z_mais"
ricardoparanhos 6:bb07d23b4a84 59 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 60 }
ricardoparanhos 6:bb07d23b4a84 61 }
ricardoparanhos 3:58de9a09d797 62 }