Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Fork of 02_LAB_serial_protocol by
main.cpp@10:d2bf51fdc68a, 2017-10-11 (annotated)
- Committer:
- fabeltranm
- Date:
- Wed Oct 11 23:09:44 2017 +0000
- Revision:
- 10:d2bf51fdc68a
- Parent:
- 9:3a8624147a4c
- Child:
- 12:b780833f517e
add draw library
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
fabeltranm | 10:d2bf51fdc68a | 1 | |
fabeltranm | 10:d2bf51fdc68a | 2 | |
fabeltranm | 10:d2bf51fdc68a | 3 | #include "draw.h" |
fabeltranm | 10:d2bf51fdc68a | 4 | #include "main.h" |
fabeltranm | 0:55d11eeb0faf | 5 | #include "mbed.h" |
fabeltranm | 0:55d11eeb0faf | 6 | |
fabeltranm | 10:d2bf51fdc68a | 7 | |
fabeltranm | 0:55d11eeb0faf | 8 | Serial command(USBTX, USBRX); |
fabeltranm | 10:d2bf51fdc68a | 9 | |
fabeltranm | 0:55d11eeb0faf | 10 | #define DEBUG 1 |
fabeltranm | 0:55d11eeb0faf | 11 | |
fabeltranm | 10:d2bf51fdc68a | 12 | uint8_t buffer_cmd[BUFF_SIZE]={0,0,0,0}; |
fabeltranm | 7:fab201aa45b7 | 13 | |
fabeltranm | 7:fab201aa45b7 | 14 | |
fabeltranm | 7:fab201aa45b7 | 15 | |
fabeltranm | 0:55d11eeb0faf | 16 | |
fabeltranm | 10:d2bf51fdc68a | 17 | void print_num(uint8_t val) { |
fabeltranm | 10:d2bf51fdc68a | 18 | if (val <10) |
fabeltranm | 1:0bcd96e56022 | 19 | command.putc(val+0x30); |
fabeltranm | 1:0bcd96e56022 | 20 | else |
fabeltranm | 2:200a9507b696 | 21 | command.putc(val-9+0x40); |
fabeltranm | 10:d2bf51fdc68a | 22 | |
fabeltranm | 1:0bcd96e56022 | 23 | } |
fabeltranm | 10:d2bf51fdc68a | 24 | |
fabeltranm | 1:0bcd96e56022 | 25 | void print_bin2hex (uint8_t val) |
fabeltranm | 1:0bcd96e56022 | 26 | { |
fabeltranm | 1:0bcd96e56022 | 27 | command.printf(" 0x"); |
fabeltranm | 1:0bcd96e56022 | 28 | print_num(val>>4); |
fabeltranm | 10:d2bf51fdc68a | 29 | print_num(val&0x0f); |
fabeltranm | 1:0bcd96e56022 | 30 | } |
fabeltranm | 1:0bcd96e56022 | 31 | |
fabeltranm | 10:d2bf51fdc68a | 32 | |
fabeltranm | 0:55d11eeb0faf | 33 | void Read_command() |
fabeltranm | 0:55d11eeb0faf | 34 | { |
fabeltranm | 10:d2bf51fdc68a | 35 | // TODO : TIMEOUT UART SERIAL |
fabeltranm | 0:55d11eeb0faf | 36 | for (uint8_t i=0; i<BUFF_SIZE;i++) |
fabeltranm | 10:d2bf51fdc68a | 37 | buffer_cmd[i]=command.getc(); |
fabeltranm | 0:55d11eeb0faf | 38 | } |
fabeltranm | 0:55d11eeb0faf | 39 | |
fabeltranm | 0:55d11eeb0faf | 40 | void echo_command() |
fabeltranm | 0:55d11eeb0faf | 41 | { |
fabeltranm | 0:55d11eeb0faf | 42 | for (uint8_t i=0; i<BUFF_SIZE;i++) |
fabeltranm | 10:d2bf51fdc68a | 43 | print_bin2hex(buffer_cmd[i]); |
fabeltranm | 0:55d11eeb0faf | 44 | |
fabeltranm | 0:55d11eeb0faf | 45 | } |
fabeltranm | 0:55d11eeb0faf | 46 | |
fabeltranm | 0:55d11eeb0faf | 47 | |
fabeltranm | 10:d2bf51fdc68a | 48 | bool check_command() |
fabeltranm | 5:bf9591a365a4 | 49 | { |
fabeltranm | 10:d2bf51fdc68a | 50 | if (buffer_cmd[BUFF_SIZE-1]== '>') |
fabeltranm | 10:d2bf51fdc68a | 51 | return 1; |
fabeltranm | 10:d2bf51fdc68a | 52 | return 0; |
fabeltranm | 10:d2bf51fdc68a | 53 | } |
fabeltranm | 10:d2bf51fdc68a | 54 | |
fabeltranm | 10:d2bf51fdc68a | 55 | |
fabeltranm | 10:d2bf51fdc68a | 56 | void command_led(){ |
fabeltranm | 10:d2bf51fdc68a | 57 | uint16_t sec = buffer_cmd[TIME_LED_S1]; |
fabeltranm | 10:d2bf51fdc68a | 58 | sec = (sec <<8) + buffer_cmd[TIME_LED_S0]; |
fabeltranm | 10:d2bf51fdc68a | 59 | uint16_t msec = buffer_cmd[TIME_LED_mS1]; |
fabeltranm | 10:d2bf51fdc68a | 60 | msec = (msec <<8) + buffer_cmd[TIME_LED_mS0]; |
fabeltranm | 10:d2bf51fdc68a | 61 | #if DEBUG |
fabeltranm | 10:d2bf51fdc68a | 62 | command.printf("LED ON: %i segundos y %i milisegundos\n", sec, msec); |
fabeltranm | 10:d2bf51fdc68a | 63 | #endif |
fabeltranm | 10:d2bf51fdc68a | 64 | led_on(sec,msec); |
fabeltranm | 10:d2bf51fdc68a | 65 | |
fabeltranm | 10:d2bf51fdc68a | 66 | |
fabeltranm | 10:d2bf51fdc68a | 67 | } |
fabeltranm | 10:d2bf51fdc68a | 68 | void command_dot(){ |
fabeltranm | 10:d2bf51fdc68a | 69 | uint8_t x=buffer_cmd[DOT_POS_X]; |
fabeltranm | 10:d2bf51fdc68a | 70 | uint8_t y=buffer_cmd[DOT_POS_Y]; |
fabeltranm | 10:d2bf51fdc68a | 71 | |
fabeltranm | 10:d2bf51fdc68a | 72 | #if DEBUG |
fabeltranm | 10:d2bf51fdc68a | 73 | command.printf("draw dot: Coord X= %i y Coord Y = %i\n", x,y); |
fabeltranm | 9:3a8624147a4c | 74 | #endif |
fabeltranm | 10:d2bf51fdc68a | 75 | vertex2d(x,y); |
fabeltranm | 10:d2bf51fdc68a | 76 | draw(); |
fabeltranm | 10:d2bf51fdc68a | 77 | nodraw(); |
fabeltranm | 10:d2bf51fdc68a | 78 | |
fabeltranm | 10:d2bf51fdc68a | 79 | } |
fabeltranm | 10:d2bf51fdc68a | 80 | void command_line(){ |
fabeltranm | 10:d2bf51fdc68a | 81 | uint8_t xi=buffer_cmd[LINE_POS_Xi]; |
fabeltranm | 10:d2bf51fdc68a | 82 | uint8_t xf=buffer_cmd[LINE_POS_Xf]; |
fabeltranm | 10:d2bf51fdc68a | 83 | uint8_t yi=buffer_cmd[LINE_POS_Yi]; |
fabeltranm | 10:d2bf51fdc68a | 84 | uint8_t yf=buffer_cmd[LINE_POS_Yf]; |
fabeltranm | 10:d2bf51fdc68a | 85 | |
fabeltranm | 10:d2bf51fdc68a | 86 | #if DEBUG |
fabeltranm | 10:d2bf51fdc68a | 87 | command.printf("draw line: Coord Xi= %i Coord Yi = %i Coord Xf= %i Coord Yf = %i\n", xi,yi,xf,yf); |
fabeltranm | 10:d2bf51fdc68a | 88 | #endif |
fabeltranm | 10:d2bf51fdc68a | 89 | line( xi, yi, xf, yf); |
fabeltranm | 10:d2bf51fdc68a | 90 | } |
fabeltranm | 10:d2bf51fdc68a | 91 | |
fabeltranm | 10:d2bf51fdc68a | 92 | void command_rectangle(){ |
fabeltranm | 10:d2bf51fdc68a | 93 | uint8_t x=buffer_cmd[REC_POS_X]; |
fabeltranm | 10:d2bf51fdc68a | 94 | uint8_t y=buffer_cmd[REC_POS_Y]; |
fabeltranm | 10:d2bf51fdc68a | 95 | uint8_t width=buffer_cmd[REC_WIDTH]; |
fabeltranm | 10:d2bf51fdc68a | 96 | uint8_t height=buffer_cmd[REC_HEIGHT ]; |
fabeltranm | 10:d2bf51fdc68a | 97 | |
fabeltranm | 10:d2bf51fdc68a | 98 | #if DEBUG |
fabeltranm | 10:d2bf51fdc68a | 99 | command.printf("draw rectangle: "); |
fabeltranm | 10:d2bf51fdc68a | 100 | command.printf("Coord X= %i Coord Y = %i width = %i height= %i\n", x,y,width,height); |
fabeltranm | 10:d2bf51fdc68a | 101 | #endif |
fabeltranm | 10:d2bf51fdc68a | 102 | rectangle( x, y, width, height); |
fabeltranm | 10:d2bf51fdc68a | 103 | } |
fabeltranm | 10:d2bf51fdc68a | 104 | |
fabeltranm | 10:d2bf51fdc68a | 105 | |
fabeltranm | 10:d2bf51fdc68a | 106 | |
fabeltranm | 7:fab201aa45b7 | 107 | void command_exe() |
fabeltranm | 7:fab201aa45b7 | 108 | { |
fabeltranm | 9:3a8624147a4c | 109 | #if DEBUG |
fabeltranm | 10:d2bf51fdc68a | 110 | command.printf("Ejecutando comando: \n"); |
fabeltranm | 7:fab201aa45b7 | 111 | #endif |
fabeltranm | 10:d2bf51fdc68a | 112 | |
fabeltranm | 10:d2bf51fdc68a | 113 | switch (buffer_cmd[COMM_N]){ |
fabeltranm | 10:d2bf51fdc68a | 114 | case COMMAND_LED : command_led(); break; |
fabeltranm | 10:d2bf51fdc68a | 115 | case COMMAND_DOT : command_dot(); break; |
fabeltranm | 10:d2bf51fdc68a | 116 | case COMMAND_LINE: command_line(); break; |
fabeltranm | 10:d2bf51fdc68a | 117 | case COMMAND_RECTANGLE: command_rectangle(); break; |
fabeltranm | 10:d2bf51fdc68a | 118 | |
fabeltranm | 10:d2bf51fdc68a | 119 | default: |
fabeltranm | 10:d2bf51fdc68a | 120 | #if DEBUG |
fabeltranm | 10:d2bf51fdc68a | 121 | command.printf("comando no encontrado\n"); |
fabeltranm | 10:d2bf51fdc68a | 122 | #endif |
fabeltranm | 10:d2bf51fdc68a | 123 | } |
fabeltranm | 7:fab201aa45b7 | 124 | } |
fabeltranm | 7:fab201aa45b7 | 125 | |
fabeltranm | 7:fab201aa45b7 | 126 | |
fabeltranm | 7:fab201aa45b7 | 127 | |
fabeltranm | 0:55d11eeb0faf | 128 | int main() { |
fabeltranm | 0:55d11eeb0faf | 129 | #if DEBUG |
fabeltranm | 0:55d11eeb0faf | 130 | command.printf("inicio con debug\n"); |
fabeltranm | 0:55d11eeb0faf | 131 | #else |
fabeltranm | 0:55d11eeb0faf | 132 | command.printf("inicio sin debug\n"); |
fabeltranm | 0:55d11eeb0faf | 133 | #endif |
fabeltranm | 0:55d11eeb0faf | 134 | uint8_t val; |
fabeltranm | 0:55d11eeb0faf | 135 | while(1){ |
fabeltranm | 0:55d11eeb0faf | 136 | val=command.getc(); |
fabeltranm | 0:55d11eeb0faf | 137 | if (val== '<'){ |
fabeltranm | 0:55d11eeb0faf | 138 | Read_command(); |
fabeltranm | 4:bcc2d1bebb95 | 139 | if (check_command()){ |
fabeltranm | 7:fab201aa45b7 | 140 | command_exe(); |
fabeltranm | 8:cd9b52716920 | 141 | }else{ |
fabeltranm | 6:cb6b868465c3 | 142 | #if DEBUG |
fabeltranm | 8:cd9b52716920 | 143 | command.printf("\n ERROR COMANDO -> "); |
fabeltranm | 8:cd9b52716920 | 144 | echo_command(); |
fabeltranm | 10:d2bf51fdc68a | 145 | command.printf("\n"); |
fabeltranm | 6:cb6b868465c3 | 146 | #endif |
fabeltranm | 8:cd9b52716920 | 147 | } |
fabeltranm | 8:cd9b52716920 | 148 | }else{ |
fabeltranm | 8:cd9b52716920 | 149 | #if DEBUG |
fabeltranm | 8:cd9b52716920 | 150 | command.printf("error de inicio de trama: "); |
fabeltranm | 8:cd9b52716920 | 151 | command.putc(val); |
fabeltranm | 8:cd9b52716920 | 152 | #endif |
fabeltranm | 3:7c26d338e372 | 153 | } |
fabeltranm | 3:7c26d338e372 | 154 | |
fabeltranm | 0:55d11eeb0faf | 155 | } |
fabeltranm | 0:55d11eeb0faf | 156 | } |
fabeltranm | 0:55d11eeb0faf | 157 |