Projeto_Mecatronico_Team / Mbed 2 deprecated Projeto_Mecatronico

Dependencies:   mbed filesystem TextLCD

Fork of Projeto_Mecatronico by Fernando Sakabe

Committer:
ricardoparanhos
Date:
Wed May 04 17:00:42 2022 +0000
Revision:
16:be88f7617529
Parent:
12:a50758242f66
Child:
17:2b5d8163b000
04/05/22 - 14h

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 16:be88f7617529 5 DigitalIn FDC_x1(PC_10);
ricardoparanhos 16:be88f7617529 6 DigitalIn FDC_x2(PC_12);
ricardoparanhos 6:bb07d23b4a84 7 //Fim de cursos eixo y
ricardoparanhos 16:be88f7617529 8 DigitalIn FDC_y1(PA_13);
ricardoparanhos 16:be88f7617529 9 DigitalIn FDC_y2(PA_14);
ricardoparanhos 6:bb07d23b4a84 10 //Fim de cursos eixo z
ricardoparanhos 16:be88f7617529 11 DigitalIn FDC_z1(PB_7);
ricardoparanhos 16:be88f7617529 12 DigitalIn FDC_z2(PC_13);
ricardoparanhos 6:bb07d23b4a84 13
ricardoparanhos 6:bb07d23b4a84 14 void fim_de_curso()
ricardoparanhos 3:58de9a09d797 15 {
ricardoparanhos 16:be88f7617529 16 // FDC_x1.mode(PullUp);
ricardoparanhos 16:be88f7617529 17 // FDC_x2.mode(PullUp);
ricardoparanhos 16:be88f7617529 18 // FDC_y1.mode(PullUp);
ricardoparanhos 16:be88f7617529 19 // FDC_y2.mode(PullUp);
ricardoparanhos 16:be88f7617529 20 // FDC_z1.mode(PullUp);
ricardoparanhos 16:be88f7617529 21 // FDC_z2.mode(PullUp);
ricardoparanhos 6:bb07d23b4a84 22
ricardoparanhos 6:bb07d23b4a84 23 while (1)
ricardoparanhos 6:bb07d23b4a84 24 {
ricardoparanhos 6:bb07d23b4a84 25 if (FDC_x1 == 0)
ricardoparanhos 6:bb07d23b4a84 26 {
ricardoparanhos 12:a50758242f66 27 string estado = "x_menos" ;
ricardoparanhos 6:bb07d23b4a84 28 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 29 }
ricardoparanhos 6:bb07d23b4a84 30
ricardoparanhos 6:bb07d23b4a84 31 if (FDC_x2 == 0)
ricardoparanhos 6:bb07d23b4a84 32 {
ricardoparanhos 12:a50758242f66 33 string estado = "x_mais";
ricardoparanhos 6:bb07d23b4a84 34 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 35 }
ricardoparanhos 6:bb07d23b4a84 36
ricardoparanhos 6:bb07d23b4a84 37 if (FDC_y1 == 0)
ricardoparanhos 6:bb07d23b4a84 38 {
ricardoparanhos 12:a50758242f66 39 string estado = "y_menos";
ricardoparanhos 6:bb07d23b4a84 40 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 41 }
ricardoparanhos 6:bb07d23b4a84 42
ricardoparanhos 6:bb07d23b4a84 43 if (FDC_y2 == 0)
ricardoparanhos 6:bb07d23b4a84 44 {
ricardoparanhos 12:a50758242f66 45 string estado = "y_mais";
ricardoparanhos 6:bb07d23b4a84 46 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 47 }
ricardoparanhos 6:bb07d23b4a84 48
ricardoparanhos 6:bb07d23b4a84 49 if (FDC_z1 == 0)
ricardoparanhos 6:bb07d23b4a84 50 {
ricardoparanhos 12:a50758242f66 51 string estado = "z_menos";
ricardoparanhos 6:bb07d23b4a84 52 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 53 }
ricardoparanhos 6:bb07d23b4a84 54
ricardoparanhos 6:bb07d23b4a84 55 if (FDC_z2 == 0)
ricardoparanhos 6:bb07d23b4a84 56 {
ricardoparanhos 6:bb07d23b4a84 57 string estado = "z_mais"
ricardoparanhos 6:bb07d23b4a84 58 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 59 }
ricardoparanhos 6:bb07d23b4a84 60 }
ricardoparanhos 3:58de9a09d797 61 }