VZTECH / Mbed 2 deprecated main_src

Modularizando o src

Dependencies:   EALib EthernetInterface_vz mbed-rtos mbed

Fork of header_main_colinas_V0-20-09-14 by VZTECH

eth.h@44:cc4996469404, 2014-10-06 (annotated)

Committer:
klauss
Date:
Mon Oct 06 19:26:36 2014 +0000
Revision:
44:cc4996469404
Parent:
42:480335bdde12
Child:
45:c80574f24dc3
tcp debug on

Who changed what in which revision?

UserRevisionLine numberNew contents of line
klauss 33:735fd60e96d8 1 #ifndef __ETH_H__
klauss 33:735fd60e96d8 2 #define __ETH_H__
klauss 33:735fd60e96d8 3
klauss 40:990683572031 4 #include "prompt.h"
klauss 33:735fd60e96d8 5 #include "debug.h"
klauss 34:f19d9735428e 6 #include "vz_protocol.h"
klauss 33:735fd60e96d8 7
klauss 34:f19d9735428e 8 #define udp_idle 0x00
klauss 34:f19d9735428e 9 #define udp_waiting_start_pkg 0x01
klauss 34:f19d9735428e 10 #define udp_listen 0x02
klauss 34:f19d9735428e 11
klauss 40:990683572031 12 int is_start_pkg( uint8_t * data ){
klauss 40:990683572031 13 //seq_num must to be 0s
klauss 40:990683572031 14 if( !data ) return -1;
klauss 40:990683572031 15
klauss 42:480335bdde12 16 for( register int i = __VZ_HEADER_OFFSET__; i < __PROMPT_ETH_BUFFER_SIZE__; i++ ) if( data[ i ] ) return( 0 );
klauss 40:990683572031 17
klauss 40:990683572031 18 return( 1 );
klauss 40:990683572031 19 }
klauss 40:990683572031 20
klauss 40:990683572031 21 int is_stop_pkg( uint8_t * data ){
klauss 40:990683572031 22 //seq_num must to be 0s
klauss 40:990683572031 23 if( !data ) return -1;
klauss 40:990683572031 24
klauss 42:480335bdde12 25 for( register int i = __VZ_HEADER_OFFSET__; i < __PROMPT_ETH_BUFFER_SIZE__; i++ ) if( data[ i ] ) return( 0 );
klauss 40:990683572031 26
klauss 40:990683572031 27 return( 1 );
klauss 40:990683572031 28 }
klauss 40:990683572031 29
klauss 40:990683572031 30 int is_time_to_stop( uint8_t * data ){
klauss 40:990683572031 31 static int count = 0;
klauss 40:990683572031 32 if( !data ) return( 0 );
klauss 40:990683572031 33
klauss 40:990683572031 34 if( is_stop_pkg( data ) == 1 ) count++;
klauss 40:990683572031 35
klauss 40:990683572031 36 else count = 0;
klauss 40:990683572031 37
klauss 40:990683572031 38 if( count == 10 ) return( 1 );
klauss 40:990683572031 39
klauss 40:990683572031 40 else return( 0 );
klauss 40:990683572031 41 }
klauss 40:990683572031 42
klauss 33:735fd60e96d8 43 char * listen_eth_udp( char * buffer, int *length ){
klauss 34:f19d9735428e 44 static UDPSocket server;
klauss 35:96885a7931f0 45 server.set_blocking( false, 2 );
klauss 33:735fd60e96d8 46 server.bind( UDP_PORT_LISTENER );
klauss 33:735fd60e96d8 47 Endpoint client;
klauss 40:990683572031 48 bool valid_reboot = false;
klauss 40:990683572031 49 uint8_t * data = NULL;
klauss 40:990683572031 50 static int ext;
klauss 40:990683572031 51 static int port;
klauss 40:990683572031 52 static uint8_t type;
klauss 40:990683572031 53 static Timer t;
klauss 40:990683572031 54 static uint8_t status = udp_idle;
klauss 40:990683572031 55 static uint8_t seq_num = 0;
klauss 35:96885a7931f0 56 // OBS sizeof( buffer ) == 4 ????
klauss 40:990683572031 57
klauss 40:990683572031 58 //*length = server.receiveFrom( client, buffer, sizeof( buffer ) );
klauss 42:480335bdde12 59 *length = server.receiveFrom( client, buffer, __PROMPT_ETH_BUFFER_SIZE__ );
klauss 35:96885a7931f0 60
klauss 40:990683572031 61 if( *length > 0){
klauss 33:735fd60e96d8 62 buffer[ *length ] = '\0';
klauss 35:96885a7931f0 63 buffer[ strlen( buffer ) - 1 ] = '\0';
klauss 40:990683572031 64 t.start();
klauss 34:f19d9735428e 65
klauss 40:990683572031 66 debug_msg("%s", buffer );
klauss 40:990683572031 67 buffer = prompt_process( buffer );
klauss 36:728498a78e1e 68
klauss 40:990683572031 69 if( buffer ){
klauss 40:990683572031 70 debug_msg("--%s--", buffer );
klauss 40:990683572031 71 int sent = server.sendTo( client, buffer, strlen( buffer ) );
klauss 40:990683572031 72 debug_msg("Sent %d", sent );
klauss 40:990683572031 73 }
klauss 35:96885a7931f0 74
klauss 40:990683572031 75 return( NULL );
klauss 40:990683572031 76
klauss 34:f19d9735428e 77 data = __parse_vz_pkg__( &ext, &port, &type, (uint8_t *)buffer );
klauss 34:f19d9735428e 78
klauss 34:f19d9735428e 79 if( !data ){
klauss 34:f19d9735428e 80 debug_msg("UDP pks parse failed");
klauss 34:f19d9735428e 81 server.sendTo( client, buffer, sizeof( buffer ) );
klauss 34:f19d9735428e 82 return( NULL );
klauss 34:f19d9735428e 83 }
klauss 34:f19d9735428e 84
klauss 34:f19d9735428e 85 if( status == udp_idle ){
klauss 34:f19d9735428e 86 data[ 0 ] |= BIT7;
klauss 34:f19d9735428e 87 strcpy( (char *)&data[ 1 ], "Received listen request" );
klauss 34:f19d9735428e 88 server.sendTo( client, buffer, sizeof( buffer ) );
klauss 34:f19d9735428e 89 status = udp_waiting_start_pkg;
klauss 34:f19d9735428e 90 }
klauss 34:f19d9735428e 91
klauss 34:f19d9735428e 92 if( status == udp_waiting_start_pkg ){
klauss 34:f19d9735428e 93 static int count = 0;
klauss 34:f19d9735428e 94 if( is_start_pkg( data ) == 1 )
klauss 34:f19d9735428e 95 if( count++ == __START_PKG_COUNT__ ) status = udp_listen;
klauss 33:735fd60e96d8 96
klauss 34:f19d9735428e 97 else{
klauss 34:f19d9735428e 98 count = 0;
klauss 34:f19d9735428e 99 status = udp_idle;
klauss 34:f19d9735428e 100 }
klauss 34:f19d9735428e 101 }
klauss 34:f19d9735428e 102
klauss 34:f19d9735428e 103 if( status == udp_listen ){
klauss 34:f19d9735428e 104 debug_msg( "Received start pkgs" ); // mandar msg pro server
klauss 34:f19d9735428e 105 if( t.read() < 60 ){
klauss 33:735fd60e96d8 106 server.set_blocking( true, 10 );
klauss 33:735fd60e96d8 107 t.reset();
klauss 34:f19d9735428e 108 do{
klauss 34:f19d9735428e 109 wdt.kick();
klauss 33:735fd60e96d8 110 *length = server.receiveFrom( client, buffer, sizeof( buffer ) );
klauss 34:f19d9735428e 111 data = __parse_vz_pkg__( &ext, &port, &type, (uint8_t *)buffer );
klauss 34:f19d9735428e 112 if( data ){
klauss 34:f19d9735428e 113 if( !( is_start_pkg( data ) ) ) break;
klauss 34:f19d9735428e 114 }else{
klauss 34:f19d9735428e 115 debug_msg("UDP pks parse failed");
klauss 34:f19d9735428e 116 // reenvia pkg dizendo que podemos comecar com a transacao de dados
klauss 34:f19d9735428e 117 }
klauss 34:f19d9735428e 118 }while( t.read() < 60 );
klauss 33:735fd60e96d8 119
klauss 34:f19d9735428e 120 if( t.read() < 60 ){
klauss 33:735fd60e96d8 121 //tratar o primeiro pkg depois dos zeros aqui
klauss 34:f19d9735428e 122 //a ideia é ir recebendo e colocando no arquivo "se for pra header" ou mandar
klauss 34:f19d9735428e 123 //pro cb depois,
klauss 34:f19d9735428e 124 if( !( ext || port ) ){ // pkg pra header
klauss 34:f19d9735428e 125 debug_msg("criando arquivo");
klauss 34:f19d9735428e 126 }else{
klauss 34:f19d9735428e 127 debug_msg("Mandando pkg pro cb");
klauss 34:f19d9735428e 128 }
klauss 34:f19d9735428e 129 //FIXME mudar essa condicao de parada
klauss 34:f19d9735428e 130 while( !( is_time_to_stop( data ) == 1 ) ){
klauss 33:735fd60e96d8 131 wdt.kick();
klauss 33:735fd60e96d8 132 *length = server.receiveFrom( client, buffer, sizeof( buffer ) );
klauss 34:f19d9735428e 133 if( ( data[ 0 ] - seq_num ) != 1 ){
klauss 34:f19d9735428e 134 //perdi algum pacote
klauss 34:f19d9735428e 135 //solicitar re-envio mandando o ultimo seq_num recebido talvez ...
klauss 34:f19d9735428e 136 continue;
klauss 34:f19d9735428e 137 }else{
klauss 34:f19d9735428e 138 debug_msg("+(%d,%d)-%s+", ext, port, data );
klauss 33:735fd60e96d8 139 }
klauss 33:735fd60e96d8 140 }
klauss 33:735fd60e96d8 141 //pensar em como validar os pacotes recebidos, cks ... e o que mais ?
klauss 33:735fd60e96d8 142 //se validado os pkgs, dar reset com os dados no arquivo bla, caso contrario, ignorar ...
klauss 33:735fd60e96d8 143 if( valid_reboot ) NVIC_SystemReset();
klauss 33:735fd60e96d8 144
klauss 33:735fd60e96d8 145 else{
klauss 33:735fd60e96d8 146 server.set_blocking( false, 1 );
klauss 33:735fd60e96d8 147 t.stop();
klauss 33:735fd60e96d8 148 t.reset();
klauss 33:735fd60e96d8 149 debug_msg("Nao Resetando ... ");
klauss 33:735fd60e96d8 150 }
klauss 33:735fd60e96d8 151 }
klauss 33:735fd60e96d8 152 }
klauss 33:735fd60e96d8 153 }else return( buffer );
klauss 33:735fd60e96d8 154 }else return( NULL );
klauss 33:735fd60e96d8 155 return( NULL );
klauss 33:735fd60e96d8 156 }
klauss 33:735fd60e96d8 157
klauss 33:735fd60e96d8 158 #endif