
Codigo donde falta la comunicacion serial
main.cpp@1:526bdd5faa37, 2018-09-04 (annotated)
- Committer:
- fabeltranm
- Date:
- Tue Sep 04 02:15:49 2018 +0000
- Revision:
- 1:526bdd5faa37
- Parent:
- 0:89b318e49395
- Child:
- 2:3936d249a67c
entrega 1 sin comprobar
Who changed what in which revision?
User | Revision | Line number | New 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 | } |