diff --git a/project/Core/Src/cmd.c b/project/Core/Src/cmd.c index 83dc8b0..2e2757b 100644 --- a/project/Core/Src/cmd.c +++ b/project/Core/Src/cmd.c @@ -9,213 +9,187 @@ uint32_t result_txt = 0xff000000; uint32_t result_bg = 0xff000000; - -static void echo_close (struct tcp_pcb *pcb ) -{ +static void echo_close(struct tcp_pcb* pcb) { tcp_arg(pcb, NULL); tcp_sent(pcb, NULL); tcp_recv(pcb, NULL); tcp_close(pcb); } -static err_t echo_recv( void *arg, struct tcp_pcb *pcb, struct pbuf *p, err_t err ) -{ +static err_t echo_recv(void* arg, struct tcp_pcb* pcb, struct pbuf* p, err_t err) { int i; int len; int file_in_fs; - - u16_t len_text; - char *pc; int check = 0; + char *pc; char tcp_buffer[1024]; char text[256]; - char colorR[3]; - char colorG[3]; - char colorB[3]; + char color_r[3]; + char color_g[3]; + char color_b[3]; - - char textColorR[3]; - char textColorG[3]; - char textColorB[3]; + char text_color_r[3]; + char text_color_g[3]; + char text_color_b[3]; char extension[4]; char *endptr; - if ( err == ERR_OK && p != NULL ) - { - tcp_recved( pcb, p->tot_len ); - pc = (char *)p->payload; - len =p->tot_len; - len_text = len - 3; + if (err == ERR_OK && p != NULL) { + tcp_recved(pcb, p->tot_len); + pc = (char*)p->payload; + len = p->tot_len; - for( i=0; i tcp_sndbuf( pcb ) ) { - len= tcp_sndbuf( pcb ); + if (len > tcp_sndbuf(pcb)) { + len = tcp_sndbuf(pcb); } //tcp_write( pcb, tcp_buffer, len, 0 ); - tcp_sent( pcb, NULL ); - } - else - { - pbuf_free( p ); + tcp_sent(pcb, NULL); + } else { + pbuf_free(p); } - if( err == ERR_OK && p == NULL ) - { - echo_close( pcb ); + if (err == ERR_OK && p == NULL) { + echo_close(pcb); } - if(strncmp(tcp_buffer, "\r\n", 2) != 0 ) { - tcp_write( pcb, "User: ", 6, 0 ); + if (strncmp(tcp_buffer, "\r\n", 2) != 0) { + tcp_write(pcb, "User: ", 6, 0); } return ERR_OK; } -static err_t echo_accept(void *arg, struct tcp_pcb *pcb, err_t err ) -{ - LWIP_UNUSED_ARG( arg ); - LWIP_UNUSED_ARG( err ); - tcp_setprio( pcb, TCP_PRIO_MIN ); - tcp_recv( pcb, echo_recv ); - tcp_err( pcb, NULL ); - tcp_poll( pcb, NULL, 4 ); - tcp_write( pcb, " Welcom bij de TCP CMD Interface\r\n" -"(Typ help voor een lijst van de commando's! X om te sluiten)\r\n" -"============================================================\r\n" -"User: ", 168, 0 ); - tcp_sent( pcb, NULL ); +static err_t echo_accept(void* arg, struct tcp_pcb* pcb, err_t err) { + LWIP_UNUSED_ARG(arg); + LWIP_UNUSED_ARG(err); + tcp_setprio(pcb, TCP_PRIO_MIN); + tcp_recv(pcb, echo_recv); + tcp_err(pcb, NULL); + tcp_poll(pcb, NULL, 4); + tcp_write(pcb, " Welcom bij de TCP CMD Interface\r\n" + "(Typ help voor een lijst van de commando's! X om te sluiten)\r\n" + "============================================================\r\n" + "User: ", 168, 0); + tcp_sent(pcb, NULL); return ERR_OK; } -void echo_init( void ) -{ +void echo_init(void) { struct tcp_pcb *tcp_pcb; tcp_pcb = tcp_new(); tcp_bind(tcp_pcb, IP_ADDR_ANY, 23); - tcp_pcb = tcp_listen( tcp_pcb ); - tcp_accept( tcp_pcb, echo_accept ); + tcp_pcb = tcp_listen(tcp_pcb); + tcp_accept(tcp_pcb, echo_accept); }