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 00:31:37 2022 +0000
Revision:
12:a50758242f66
Parent:
6:bb07d23b4a84
Child:
16:be88f7617529
03/05/22 21h31

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 12:a50758242f66 28 string estado = "x_menos" ;
ricardoparanhos 6:bb07d23b4a84 29 jog_FDC(estado);
ricardoparanhos 12:a50758242f66 30 int movimentar_x = 0;
ricardoparanhos 6:bb07d23b4a84 31 }
ricardoparanhos 6:bb07d23b4a84 32
ricardoparanhos 6:bb07d23b4a84 33 if (FDC_x2 == 0)
ricardoparanhos 6:bb07d23b4a84 34 {
ricardoparanhos 12:a50758242f66 35 string estado = "x_mais";
ricardoparanhos 6:bb07d23b4a84 36 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 37 }
ricardoparanhos 6:bb07d23b4a84 38
ricardoparanhos 6:bb07d23b4a84 39 if (FDC_y1 == 0)
ricardoparanhos 6:bb07d23b4a84 40 {
ricardoparanhos 12:a50758242f66 41 string estado = "y_menos";
ricardoparanhos 6:bb07d23b4a84 42 jog_FDC(estado);
ricardoparanhos 12:a50758242f66 43 int movimentar_y = 0;
ricardoparanhos 6:bb07d23b4a84 44 }
ricardoparanhos 6:bb07d23b4a84 45
ricardoparanhos 6:bb07d23b4a84 46 if (FDC_y2 == 0)
ricardoparanhos 6:bb07d23b4a84 47 {
ricardoparanhos 12:a50758242f66 48 string estado = "y_mais";
ricardoparanhos 6:bb07d23b4a84 49 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 50 }
ricardoparanhos 6:bb07d23b4a84 51
ricardoparanhos 6:bb07d23b4a84 52 if (FDC_z1 == 0)
ricardoparanhos 6:bb07d23b4a84 53 {
ricardoparanhos 12:a50758242f66 54 string estado = "z_menos";
ricardoparanhos 6:bb07d23b4a84 55 jog_FDC(estado);
ricardoparanhos 12:a50758242f66 56 int movimentar_z = 0;
ricardoparanhos 6:bb07d23b4a84 57 }
ricardoparanhos 6:bb07d23b4a84 58
ricardoparanhos 6:bb07d23b4a84 59 if (FDC_z2 == 0)
ricardoparanhos 6:bb07d23b4a84 60 {
ricardoparanhos 6:bb07d23b4a84 61 string estado = "z_mais"
ricardoparanhos 6:bb07d23b4a84 62 jog_FDC(estado);
ricardoparanhos 6:bb07d23b4a84 63 }
ricardoparanhos 6:bb07d23b4a84 64 }
ricardoparanhos 3:58de9a09d797 65 }