abrayan

Dependencies:   mbed

Committer:
fabeltranm
Date:
Tue Sep 04 02:15:49 2018 +0000
Revision:
1:526bdd5faa37
Parent:
0:89b318e49395
Child:
2:3007b3c06d2c
Child:
3:3936d249a67c
entrega 1  sin comprobar

Who changed what in which revision?

UserRevisionLine numberNew contents of line
fabeltranm 0:89b318e49395 1 #include "mbed.h"
fabeltranm 0:89b318e49395 2
fabeltranm 0:89b318e49395 3 #include "main.h"
fabeltranm 0:89b318e49395 4
fabeltranm 0:89b318e49395 5
fabeltranm 0:89b318e49395 6
fabeltranm 0:89b318e49395 7
fabeltranm 0:89b318e49395 8 Serial command(USBTX, USBRX);
fabeltranm 0:89b318e49395 9
fabeltranm 0:89b318e49395 10
fabeltranm 0:89b318e49395 11
fabeltranm 0:89b318e49395 12 int main() {
fabeltranm 0:89b318e49395 13 init_servo();
fabeltranm 0:89b318e49395 14 init_serial();
fabeltranm 1:526bdd5faa37 15
fabeltranm 0:89b318e49395 16 debug_m("inicio \n");
fabeltranm 0:89b318e49395 17 uint32_t read_cc;
fabeltranm 0:89b318e49395 18 while(1)
fabeltranm 0:89b318e49395 19 {
fabeltranm 0:89b318e49395 20 read_cc=read_command();
fabeltranm 0:89b318e49395 21 switch (read_cc) {
fabeltranm 1:526bdd5faa37 22 case 0x01: moving(); break;
fabeltranm 0:89b318e49395 23 default: debug_m("error de comando. \nSe espera 0xFEF0 o 0xFFF0 \n");break ;
fabeltranm 0:89b318e49395 24 }
fabeltranm 0:89b318e49395 25 }
fabeltranm 0:89b318e49395 26 }
fabeltranm 0:89b318e49395 27
fabeltranm 0:89b318e49395 28
fabeltranm 0:89b318e49395 29
fabeltranm 0:89b318e49395 30 uint32_t read_command()
fabeltranm 0:89b318e49395 31 {
fabeltranm 1:526bdd5faa37 32 // retorna los byte recibidos concatenados en un entero,
fabeltranm 0:89b318e49395 33
fabeltranm 1:526bdd5faa37 34
fabeltranm 1:526bdd5faa37 35
fabeltranm 1:526bdd5faa37 36 char intc=command.getc();
fabeltranm 0:89b318e49395 37
fabeltranm 1:526bdd5faa37 38 while(intc != '<')
fabeltranm 1:526bdd5faa37 39 intc=command.getc();
fabeltranm 1:526bdd5faa37 40 return intc;
fabeltranm 0:89b318e49395 41 }
fabeltranm 1:526bdd5faa37 42
fabeltranm 1:526bdd5faa37 43
fabeltranm 0:89b318e49395 44 void init_serial()
fabeltranm 0:89b318e49395 45 {
fabeltranm 0:89b318e49395 46 command.baud(9600);
fabeltranm 0:89b318e49395 47 }
fabeltranm 0:89b318e49395 48
fabeltranm 0:89b318e49395 49
fabeltranm 1:526bdd5faa37 50 void moving(){
fabeltranm 1:526bdd5faa37 51 debug_m("se inicia el comado mover..\n");
fabeltranm 0:89b318e49395 52
fabeltranm 1:526bdd5faa37 53 char nmotor=command.getc();
fabeltranm 1:526bdd5faa37 54 char grados=command.getc();
fabeltranm 1:526bdd5faa37 55 char endc=command.getc();
fabeltranm 1:526bdd5faa37 56 mover_ser(nmotor,grados);
fabeltranm 0:89b318e49395 57 debug_m("fin del comado guardar..\n");
fabeltranm 0:89b318e49395 58
fabeltranm 0:89b318e49395 59 }
fabeltranm 0:89b318e49395 60
fabeltranm 0:89b318e49395 61 void debug_m(char *s , ... ){
fabeltranm 0:89b318e49395 62 #if DEBUG
fabeltranm 0:89b318e49395 63 command.printf(s);
fabeltranm 0:89b318e49395 64 #endif
fabeltranm 0:89b318e49395 65 }