Grupo T / Mbed OS GRUPOT
Committer:
lucasfontenla
Date:
Tue May 15 18:38:50 2018 +0000
Revision:
24:92f612ca218b
Child:
26:f891ff6beb33
Atualiza??o funcionando. Alterar o par?metro de velocidade para 600.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
lucasfontenla 24:92f612ca218b 1 #define tx PC_10
lucasfontenla 24:92f612ca218b 2 #define rx PC_11
lucasfontenla 24:92f612ca218b 3
lucasfontenla 24:92f612ca218b 4 #define sendTime 0.1
lucasfontenla 24:92f612ca218b 5
lucasfontenla 24:92f612ca218b 6 Serial ihm(tx, rx); //tx e rx (D1 e D0)
lucasfontenla 24:92f612ca218b 7
lucasfontenla 24:92f612ca218b 8 class IHM {
lucasfontenla 24:92f612ca218b 9 int n;
lucasfontenla 24:92f612ca218b 10 string buffer;
lucasfontenla 24:92f612ca218b 11 char buffer_char[8];
lucasfontenla 24:92f612ca218b 12
lucasfontenla 24:92f612ca218b 13 public:
lucasfontenla 24:92f612ca218b 14 int debug;
lucasfontenla 24:92f612ca218b 15
lucasfontenla 24:92f612ca218b 16 // PUBLIC FUNCTIONS ----------------------------------------------------------------------------------------------------------------------------------------
lucasfontenla 24:92f612ca218b 17 void send_position(float X, float Y, float Z){
lucasfontenla 24:92f612ca218b 18 //printf("Position sent\n\r");
lucasfontenla 24:92f612ca218b 19 buffer = "";
lucasfontenla 24:92f612ca218b 20
lucasfontenla 24:92f612ca218b 21 buffer.append("p");
lucasfontenla 24:92f612ca218b 22
lucasfontenla 24:92f612ca218b 23 n = sprintf(buffer_char, "X%.3f", X);
lucasfontenla 24:92f612ca218b 24 buffer.append(buffer_char);
lucasfontenla 24:92f612ca218b 25 n = sprintf(buffer_char, "Y%.3f", Y);
lucasfontenla 24:92f612ca218b 26 buffer.append(buffer_char);
lucasfontenla 24:92f612ca218b 27 n = sprintf(buffer_char, "Z%.3f", Z);
lucasfontenla 24:92f612ca218b 28 buffer.append(buffer_char);
lucasfontenla 24:92f612ca218b 29
lucasfontenla 24:92f612ca218b 30 send(buffer);
lucasfontenla 24:92f612ca218b 31 }
lucasfontenla 24:92f612ca218b 32
lucasfontenla 24:92f612ca218b 33 private:
lucasfontenla 24:92f612ca218b 34
lucasfontenla 24:92f612ca218b 35 // PRIVATE FUNCTIONS ----------------------------------------------------------------------------------------------------------------------------------------
lucasfontenla 24:92f612ca218b 36 void send(string msg){
lucasfontenla 24:92f612ca218b 37 msg.append("x");
lucasfontenla 24:92f612ca218b 38
lucasfontenla 24:92f612ca218b 39 for(int i = 0; i < msg.length(); i++){
lucasfontenla 24:92f612ca218b 40 ihm.putc(msg[i]);
lucasfontenla 24:92f612ca218b 41 wait_us(1);
lucasfontenla 24:92f612ca218b 42 }
lucasfontenla 24:92f612ca218b 43 }
lucasfontenla 24:92f612ca218b 44 };