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

fw_handler.cpp@125:8ff4dc96ad58, 2015-05-13 (annotated)

Committer:
klauss
Date:
Wed May 13 21:18:12 2015 +0000
Revision:
125:8ff4dc96ad58
Parent:
124:c1b6c893e1c3
Child:
126:1f90756250fb
Implementado; - dtx [ on | off ]; - drx [ on | off ]; - drxshow [ on | off ]; - dtxshow [ on | off ]; - end_call <ext>; - request_clock

Who changed what in which revision?

UserRevisionLine numberNew contents of line
klauss 122:480c44b0e205 1 #include "fw.h"
klauss 99:e80850c51106 2
klauss 99:e80850c51106 3 UDPSocket fw_sock;
klauss 99:e80850c51106 4 Endpoint fw_server;
klauss 119:ee6a53069455 5 uint16_t miss_fw_send_pkg = 0;
klauss 99:e80850c51106 6
klauss 119:ee6a53069455 7 int init_fw_handler( void ){
klauss 99:e80850c51106 8 char buff_ip[ 16 ] = "";
klauss 99:e80850c51106 9 char buff_port[ 8 ] = "";
klauss 99:e80850c51106 10 int fw_port = 0;
klauss 99:e80850c51106 11
klauss 125:8ff4dc96ad58 12 FILE *fip = fopen( "/qspi/fw_ip.txt", "r");
klauss 125:8ff4dc96ad58 13 if( fip == NULL ){
klauss 119:ee6a53069455 14 if( debug_file || debug_reconnect ) send_msg ("Failed to open /qspi/fw_ip.txt" );
klauss 99:e80850c51106 15 strncpy( buff_ip, __FW_SERVER_IP__, 20 );
klauss 99:e80850c51106 16 }else{
klauss 125:8ff4dc96ad58 17 int read = fread( buff_ip, 1, 512, fip );
klauss 99:e80850c51106 18 if( read > 0 ){
klauss 99:e80850c51106 19 for( int i = 0; i < read; i++ )
klauss 99:e80850c51106 20 if( buff_ip[ i ] == '\n' || buff_ip[ i ] == '\r' ){
klauss 99:e80850c51106 21 buff_ip[ i ] = '\0';
klauss 99:e80850c51106 22 break;
klauss 99:e80850c51106 23 }
klauss 119:ee6a53069455 24 if( debug_file || debug_reconnect ) send_msg ("fw server ip %s", buff_ip );
klauss 99:e80850c51106 25 }else{
klauss 119:ee6a53069455 26 if( debug_file || debug_reconnect ) send_msg ("Failed to open /qspi/fw_ip.txt" );
klauss 99:e80850c51106 27 strncpy( buff_ip, __FW_SERVER_IP__, 20 );
klauss 99:e80850c51106 28 }
klauss 99:e80850c51106 29 }
klauss 125:8ff4dc96ad58 30 if( fip != NULL ) fclose( fip );
klauss 124:c1b6c893e1c3 31
klauss 125:8ff4dc96ad58 32 FILE * fport = fopen( "/qspi/fw_port.txt", "r");
klauss 125:8ff4dc96ad58 33
klauss 125:8ff4dc96ad58 34 if( fport == NULL ) {
klauss 119:ee6a53069455 35 if( debug_fw || debug_reconnect ) send_msg ("Failed to open /qspi/fw_port.txt" );
klauss 99:e80850c51106 36 fw_port = __FW_SERVER_PORT__;
klauss 99:e80850c51106 37 } else {
klauss 125:8ff4dc96ad58 38 if( fread ( (void *) buff_port, 1, 32, fport ) > 0 )
klauss 125:8ff4dc96ad58 39 {
klauss 125:8ff4dc96ad58 40 fw_port = atoi ( buff_port );
klauss 119:ee6a53069455 41 if( debug_fw || debug_reconnect ) send_msg ( "fw server port %d", fw_port );
klauss 99:e80850c51106 42 } else {
klauss 119:ee6a53069455 43 if( debug_fw || debug_reconnect ) send_msg ( "Failed to read /qspi/fw_port.txt" );
klauss 99:e80850c51106 44 fw_port = __FW_SERVER_PORT__;
klauss 99:e80850c51106 45 }
klauss 99:e80850c51106 46 }
klauss 125:8ff4dc96ad58 47 if( fport != NULL ) fclose( fport );
klauss 125:8ff4dc96ad58 48
klauss 99:e80850c51106 49 int addr = fw_server.set_address( buff_ip , fw_port );
klauss 114:472502b31a12 50 if( debug_fw ) send_msg(" Valor de retorno set_address -- %d ", addr );
klauss 99:e80850c51106 51 fw_sock.set_blocking( false, 0 );
klauss 99:e80850c51106 52 int bind = fw_sock.bind( __FW_HEADER_PORT__ );
klauss 114:472502b31a12 53 if( debug_fw ) send_msg(" Valor de retorno bind -- %d ", bind );
klauss 119:ee6a53069455 54
klauss 119:ee6a53069455 55 return ( 0 );
klauss 99:e80850c51106 56 }
klauss 99:e80850c51106 57
klauss 99:e80850c51106 58 void re_start_fw( void ){
klauss 99:e80850c51106 59 int close = fw_sock.close();
klauss 119:ee6a53069455 60 if( debug_fw || debug_reconnect ) send_msg (" Valor de retorno close-- %d ", close );
klauss 99:e80850c51106 61
klauss 99:e80850c51106 62 init_fw_handler();
klauss 99:e80850c51106 63 }
klauss 99:e80850c51106 64
klauss 99:e80850c51106 65 void fw_cbx_pkg( int ext, int port, char * data ){
klauss 99:e80850c51106 66 static uint8_t fw_cbx_pkg_id = 0x00;
klauss 119:ee6a53069455 67 data[ CB_BUFFER_SIZE - 1 ] = fw_cbx_pkg_id++;
klauss 99:e80850c51106 68
klauss 119:ee6a53069455 69 int send = fw_sock.sendTo( fw_server, data, CB_BUFFER_SIZE );
klauss 119:ee6a53069455 70
klauss 119:ee6a53069455 71 if( send != CB_BUFFER_SIZE )
klauss 119:ee6a53069455 72 {
klauss 119:ee6a53069455 73 if( debug_reconnect )
klauss 119:ee6a53069455 74 {
klauss 119:ee6a53069455 75 send_msg("[%d] Reconnect FW - %d", ext, send );
klauss 119:ee6a53069455 76 }
klauss 119:ee6a53069455 77
klauss 119:ee6a53069455 78 miss_fw_send_pkg++;
klauss 119:ee6a53069455 79 re_start_fw();
klauss 119:ee6a53069455 80 }
klauss 99:e80850c51106 81 }