Modularizando o src

Dependencies:   EALib EthernetInterface_vz mbed-rtos mbed

Fork of header_main_colinas_V0-20-09-14 by VZTECH

Revision:
117:e9facba9db27
Parent:
116:39a41ebb675c
Child:
119:ee6a53069455
--- a/prompt.cpp	Thu Apr 23 20:24:09 2015 +0000
+++ b/prompt.cpp	Thu Apr 23 21:53:28 2015 +0000
@@ -5,37 +5,581 @@
 
 Timer tcp_timer;
 bool tcp_alive = false;
-bool serial_pc_pending = false; 
 
 char __debug_buf__[ DEBUGBUFSIZE ];
 char * debug_buf = __debug_buf__;
 char last_cmd[ DEBUGBUFSIZE ];
 char tmp_cmd[ DEBUGBUFSIZE ] = "help";
 char last_debug_buf[ DEBUGBUFSIZE ] = "help";
-char eth_buffer[ __PROMPT_ETH_BUFFER_SIZE__ ];
-char eth_udp_buffer[ __PROMPT_ETH_BUFFER_SIZE__ ]; 
-char gp_buff[ DEBUGBUFSIZE ];
 
-FILE *fip, *fmask, *fgate, *fport, *fsip, *fsport, *fext, *fserext, *fudpport, *ftcpport, *ffwip, *ffwport, *fmax, *fmin, *fshift_port;
+FILE *fip, *fmask, *fgate, *fport, *fsip, *fsport, *fext, *fserext, *fudpport, *ftcpport, *ftip, *ftport, *ffwip, *ffwport, *fmax, *fmin;
 
 uint8_t bufptr = 0;
 uint8_t last_bufptr = 0;
 
-void init_prompt_eth ()
-{   
-    int udp_bind = udp_client.bind( UDP_PORT_LISTENER );
-    udp_client.set_blocking( false, 0 );
-    if( debug_uart3 && !( from_eth ) ) pc.printf("\r\n******* Prompt eth UDP Ready [ %d ] *******\r\n", udp_bind );
+int str2uint ( char * s, unsigned int * val ){
+  int i = 0;
+  unsigned int ret = 0;
+  for (;;) {
+    if (s[i] < '0') {
+      *val = ret;
+      return i;
+    }
+    ret *= 10;
+    ret += s[i] - '0';
+    i++;
+  }
+}
 
-    int tcp_bind = tcp_server.bind( TCP_PORT_LISTENER );
+// operantion with the system config files
+void files( const char type ){
+    // show files       
+    if (type == 's' ){
+        if( debug_uart3 ) pc.printf("Header IP " );
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Header IP " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        
+        cat("/qspi/myip.txt");
+        
+        if( debug_uart3 ) pc.printf("Header ext ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Header ext " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        
+        cat("/qspi/myext.txt");
+        
+        if( debug_uart3 ) pc.printf("Header port ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Header port " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        
+        cat("/qspi/mysipport.txt");
+        
+        if( debug_uart3 ) pc.printf("Server IP ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Server IP " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        
+        cat("/qspi/serverip.txt");
+        
+        if( debug_uart3 ) pc.printf("Server ext ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Server ext " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        
+        cat("/qspi/peerext.txt");
+        
+        if( debug_uart3 ) pc.printf("Server port ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Server port " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        cat("/qspi/serverport.txt");
+        
+        if( debug_uart3 ) pc.printf("Mascara de rede ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Mascara de rede " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        cat("/qspi/mymask.txt");
+        
+        if( debug_uart3 ) pc.printf("Gateway IP ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Gateway IP " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        cat("/qspi/mygateway.txt");
+        
+        if( debug_uart3 ) pc.printf("UDP Port ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "UDP Port " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        
+        cat("/qspi/udpport.txt");
+        
+        if( debug_uart3 ) pc.printf("TCP Port ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "TCP Port " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        
+        cat("/qspi/tcpport.txt");
+        
+        if( debug_uart3 ) pc.printf("Telemetry Server IP ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Telemetry Server IP " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        
+        cat("/qspi/telemetry_ip.txt");
+        
+        if( debug_uart3 ) pc.printf("Telemetry Server Port ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Telemetry Server Port " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+    
+        cat("/qspi/telemetry_port.txt");
+        
+        /*
+        if( debug_uart3 ) pc.printf("FW Server IP ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "FW Server IP " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        
+        cat("/qspi/fw_ip.txt");
+        
+        if( debug_uart3 ) pc.printf("FW Server Port ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Fw Server Port " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+    
+        cat("/qspi/fw_port.txt");
+        */
+        
+        if( debug_uart3 ) pc.printf("FW Server IP ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "FW Server IP " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+        
+        cat("/qspi/fw_ip.txt");
+        
+        if( debug_uart3 ) pc.printf("FW Server Port ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "FW Server Port " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+    
+        cat("/qspi/fw_port.txt");
+        
+        if( debug_uart3 ) pc.printf("Max Ext ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Max Ext " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+    
+        cat("/qspi/maxext.txt");
+        
+        if( debug_uart3 ) pc.printf("Min Ext ");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Min Ext " );
+            if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+            
+            else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+        }
+    
+        cat("/qspi/minext.txt");
+        
+        
+        //*------------ formatando a saida ----------------*//
+        strcpy( last_cmd, tmp_cmd );
+        bufptr = 0;
+        for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+        
+        if( tcp_session ) tcp_client.send_all( "\n\r> " , strlen( "\n\r> " ) );
+        
+        else if( udp_request ){
+            udp_server.sendTo( udp_client, "\n\r> ", strlen( "\n\r> " ) );
+        }
+    }
+    
+    if (type == 'c' ){                
+        // close all files
+        //debug_msg("");
+        if( fip ) fclose( fip );
+        if( fmask ) fclose( fmask );
+        if( fgate ) fclose( fgate );
+        if( fport )fclose( fport );
+        if( fsip ) fclose( fsip );
+        if( fsport ) fclose( fsport );
+        if( fext ) fclose( fext );
+        if( fserext ) fclose( fserext );
+        if( fudpport ) fclose( fudpport );
+        if( ftcpport ) fclose( ftcpport );
+        if( fmax ) fclose( fmax );
+        if( fmin ) fclose( fmin );
+        if( ftip ) fclose( ftip );
+        if( ftport ) fclose( ftport );
+        if( ffwip ) fclose( ffwip );
+        if( ffwport) fclose( ffwport );
+        //debug_msg("");
+    }    
+    
+    if (type == 'i' ){
+        //debug_msg("");
+        // Check if files exist, if not create the files
+        //fixme criar um bool pra cada file
+        bool exists = true;
+        
+        fip = fopen("/qspi/myip.txt", "r");
+        if( fip == NULL){
+            set_ip( __MY_IP__ );
+            exists = false;
+        }
+        //fclose( fip );
+        
+        fserext = fopen("/qspi/myext.txt", "r");
+        if( fserext == NULL ){
+            set_header_ext( __MY_EXT__ );
+            exists = false;
+        }
+        //fclose( fserext );
+        
+        fport = fopen("/qspi/mysipport.txt", "r");
+        if (fport == NULL){
+            set_header_sip_port( __MY_PORT__ );
+            exists = false;
+        }
+        //fclose( fport );
+        
+        fsip = fopen("/qspi/serverip.txt", "r");
+        if (fsip == NULL){
+             set_server_ip( __SERVER_IP__ );
+             exists = false;
+        }
+        //fclose( fsip );
+        
+        fext = fopen("/qspi/peerext.txt", "r");
+        if ( fext == NULL ){
+             set_server_ext( __PEER_EXT__ );
+             exists = false;
+        }
+        //fclose( fext );
+        
+        fsport = fopen("/qspi/serverport.txt", "r");
+        if (fsport == NULL){
+            set_server_port( __SERVER_PORT__ );
+            exists = false;
+        }
+        //fclose( fsport );
+        
+        fmask = fopen("/qspi/mymask.txt", "r");
+        if (fmask == NULL){
+            set_mask( __MY_MSK__ );
+            exists = false;
+        }
+        //fclose( fmask );
+        
+        fgate = fopen("/qspi/mygateway.txt", "r");
+        if (fgate == NULL){
+            set_gateway( __MY_GTW__ );
+            exists = false;
+        }
+        //fclose( fgate );
+        
+        fudpport = fopen("/qspi/udpport.txt", "r" );
+        if( fudpport == NULL ){
+            set_udp_port_listener( UDP_PORT_LISTENER );
+            exists = false;
+        }
+        //fclose( fudpport );
+        
+        ftcpport = fopen("/qspi/tcpport.txt", "r" );
+        if( ftcpport == NULL ){
+            set_tcp_port_listener( TCP_PORT_LISTENER );
+            exists = false;
+        }
+        //fclose( ftcpport );
+        
+        ftip = fopen("/qspi/telemetry_ip.txt", "r" );
+        if( ftip == NULL ){
+            set_telemetry_ip( __TELEMETRY_SERVER_IP__ );
+            exists = false;
+        }
+        //fclose( ftip );
+        
+        ftport = fopen("/qspi/telemetry_port.txt", "r" );
+        if( ftport == NULL ){
+            set_telemetry_port( __TELEMETRY_SERVER_PORT__ );
+            exists = false;
+        }
+        //fclose( ftport );
+        
+        //debug_msg("");
+        ffwip = fopen("/qspi/fw_ip.txt", "r" );
+        if( ffwip == NULL ){
+            set_fw_ip( __FW_SERVER_IP__ );
+            exists = false;
+        }
+        //debug_msg("");
+        //fclose( ffwip );
+        //debug_msg("");
+        ffwport = fopen("/qspi/fw_port.txt", "r" );
+        if( ffwport == NULL ){
+            set_fw_port( __FW_SERVER_PORT__ );
+            exists = false;
+        }
+        //fclose( ffwport );
+        //debug_msg("");
+        fmax = fopen("/qspi/maxext.txt", "r" );
+        //debug_msg("");
+        if( fmax == NULL ){
+            //debug_msg("");
+            set_max_ext( MAX_EXT );
+            //debug_msg("");
+            exists = false;
+            //debug_msg("");
+        }
+        //fclose( fmax );
+        //debug_msg("");
+        fmin = fopen("/qspi/minext.txt", "r" );
+        if( fmin == NULL ){
+            set_min_ext( MIN_EXT );
+            exists = false;
+        }
+        //fclose( fmin );
+        //debug_msg("");
+        if( !exists ){ 
+            if( debug_uart3 ) pc.printf("\n\rDefault configurations set!\n\r");
+            if( from_eth ){
+                snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Default configurations set!\n\r");
+                debug_buf[ strlen( debug_buf ) - 1 ] = '\0';
+                if( tcp_session ){
+                    tcp_client.send_all( debug_buf, strlen( debug_buf ) );
+                    bufptr = 0;
+                    for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+                }
+            }
+        }
+        //debug_msg("");
+        reset_leds();
+    }
+    
+    if (type == 'r' ){
+        // Just open for read
+        fip = fopen("/qspi/myip.txt", "r");
+        fmask = fopen("/qspi/mymask.txt", "r");
+        fgate = fopen("/qspi/mygateway.txt", "r");
+        fport = fopen("/qspi/mysipport.txt", "r");
+        fsip = fopen("/qspi/serverip.txt", "r");
+        fsport = fopen("/qspi/serverport.txt", "r");
+        fext = fopen( "/qspi/myext.txt", "r" );
+        fserext = fopen( "/qspi/peerext.txt", "r" );
+        fudpport = fopen( "/qspi/udpport.txt", "r" );
+        ftcpport = fopen( "/qspi/tcpport.txt", "r" );
+        ftip = fopen("/qspi/telemetry_ip.txt", "r" );
+        ftport = fopen("/qspi/telemetry_port.txt", "r" );
+        ffwip = fopen("/qspi/fw_ip.txt", "r" );
+        ffwport = fopen("/qspi/fw_port.txt", "r" );
+        fmax = fopen("/qspi/maxext.txt", "r" );
+        fmin = fopen("/qspi/minext.txt", "r" );
+    }
+        
+    if( type == 'w'){
+        // Create and write the default configs
+        
+        set_ip( __MY_IP__ );
+        
+        set_header_sip_port( __MY_PORT__ );
+        
+        set_header_ext( __MY_EXT__ );
+        
+        set_server_ip( __SERVER_IP__ );
+        
+        set_server_ext( __PEER_EXT__ );
+        
+        set_server_port( __SERVER_PORT__ );
+    
+        set_mask( __MY_MSK__ );
+        
+        set_gateway( __MY_GTW__ );
+        
+        set_udp_port_listener( UDP_PORT_LISTENER );
+        
+        set_tcp_port_listener( TCP_PORT_LISTENER );
+        
+        set_telemetry_ip( __TELEMETRY_SERVER_IP__ );
+            
+        set_telemetry_port( __TELEMETRY_SERVER_PORT__ );
+        
+        set_fw_ip( __FW_SERVER_IP__ );
+            
+        set_fw_port( __FW_SERVER_PORT__ );
+        
+        set_max_ext( MAX_EXT );
+            
+        set_min_ext( MIN_EXT );
+        
+        strcpy( last_cmd, tmp_cmd );
+        
+        if( debug_uart3 ) pc.printf("\n\rDefault configurations set!\n\r");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "\n\rDefault configurations set!\n\r");
+            debug_buf[ strlen( debug_buf ) - 1 ] = '\0';
+            if( tcp_session ){
+                tcp_client.send_all( debug_buf, strlen( debug_buf ) );
+            }else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+            bufptr = 0;
+            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+        } 
+    }
+    
+    if (type == 'e'){
+        //Erase configs
+        fip = fopen("/qspi/myip.txt", "w");
+        fmask = fopen("/qspi/mymask.txt", "w");
+        fgate = fopen("/qspi/mygateway.txt", "w");
+        fport = fopen("/qspi/mysipport.txt", "w");
+        fsip = fopen("/qspi/serverip.txt", "w");
+        fsport = fopen("/qspi/serverport.txt", "w");   
+        fext = fopen( "/qspi/myext.txt", "w" );
+        fserext = fopen( "/qspi/peerext.txt", "w" );
+        fudpport = fopen( "/qspi/udpport.txt", "w" );
+        ftcpport = fopen( "/qspi/tcpport.txt", "w" );
+        ftip = fopen("/qspi/telemetry_ip.txt", "w" );
+        ftport = fopen("/qspi/telemetry_port.txt", "w" );
+        ffwip = fopen("/qspi/fw_ip.txt", "w" );
+        ffwport = fopen("/qspi/fw_port.txt", "w" );
+        fmax = fopen("/qspi/maxext.txt", "w" );
+        fmin = fopen("/qspi/minext.txt", "w" );
+        
+        //FIXME verificar se deveria colocar tudo para %s
+        fprintf( fip, "%s\n\r", ""  ); 
+        fprintf( fport, "%i\n\r", 0 );
+        fprintf( fext, "%i\n\r", 0 ); 
+        
+        fprintf( fsip, "%s\n\r", ""  );
+        fprintf( fserext, "%i\n\r", 0 );
+        fprintf( fsport, "%i\n\r", 0 ); 
+        
+        fprintf( fmask, "%s\n\r","" );  
+        fprintf( fgate, "%s\n\r", "" );
+        
+        fprintf( fudpport, "%i\n\r", 0 );
+        fprintf( ftcpport, "%i\n\r", 0 );
+        
+        fprintf( ftip, "%s\n\r","" );
+        fprintf( ftport, "%i\n\r",0 );
+        
+        fprintf( ffwip, "%s\n\r","" );
+        fprintf( ffwport, "%i\n\r",0 );
+        
+        fprintf( fmax, "%i\n\r", 0 );
+        fprintf( fmin, "%i\n\r", 0 );
+        
+        files('c');
+        
+        if( debug_uart3 ) pc.printf("\n\rErased configurations set!\n\r");
+        if( from_eth ){
+            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "\n\rErased configurations set!\n\r");
+            debug_buf[ strlen( debug_buf ) - 1 ] = '\0';
+            if( tcp_session ){
+                tcp_client.send_all( debug_buf, strlen( debug_buf ) );
+            }else if( udp_request ){
+                udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            }
+            bufptr = 0;
+            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+        } 
+    }
+}
+
+void init_fsystem(){                 
+   //  init file system and check if files exist
+    if (!qspifs.isformatted()) {
+        qspifs.format();
+        if( debug_uart3 ) pc.printf("\n\rFile system configured!!\n\r");
+    }
+    files('i');   // check if the files are created
+    files('c');
+    send_msg("******* File System Ready *******");
+}
+
+void init_prompt_eth(){
+    tcp_server.bind( TCP_PORT_LISTENER );
+    tcp_server.listen();
+    //tcp_server.set_blocking( false, 1 );
+    //udp_server.set_blocking( false, 2 );
     tcp_server.set_blocking( false, 0 );
-    int tcp_listen = tcp_server.listen();
-    if( debug_uart3 && !( from_eth ) ) pc.printf("\r\n******* Prompt eth TCP Ready [ %d, %d ] *******\r\n", tcp_bind, tcp_listen );
+    udp_server.set_blocking( false, 0 );
+    udp_server.bind( UDP_PORT_LISTENER );    
+    if( debug_uart3 ) pc.printf("******* Prompt eth Ready *******\n\r");
 }
 
 // main prompt process
-char * prompt_process( char * msg_from_cb, int length )
-{
+char * prompt_process( char * msg_from_cb ){
     //FIXME dar flush na serial
     volatile char b = 0;
     static uint8_t bufret = 0;
@@ -45,7 +589,7 @@
     static int start_ext, end_ext, ext_count;
     bool miss_match = true;
     char eth_buffer[ __PROMPT_ETH_BUFFER_SIZE__ ];
-    uint8_t write_buffer[ CB_BUFFER_SIZE ];
+    uint8_t write_buffer[ __CB_BUFFER_SIZE__ ];
     
     if( flood_timeout.read() > 60 ){
         pflood = 0;
@@ -53,67 +597,53 @@
         flood_timeout.reset();
     }
     
-    if( tcp_timer.read() >= TCP_IDLE_MAX_TIME ) {
-        tcp_alive = false;
-        tcp_timer.stop();
-        tcp_timer.reset();
-        tcp_session = false;
-        debug_buf = __debug_buf__;
-        bufptr = last_bufptr;
+    if( tcp_timer.read() >= TCP_IDLE_MAX_TIME ){
+        bool close_tcp = true;
+        //if( tcp_alive && ( tcp_timer.read() < TCP_ALIVE_IDLE_MAX_TIME ) ){
+        //    close_tcp = false;    
+        //}
+        if( close_tcp ){
+            tcp_alive = false;
+            tcp_timer.stop();
+            tcp_timer.reset();
+            tcp_session = false;
+            debug_buf = __debug_buf__;
+            bufptr = last_bufptr;
+            bufret = 0;
+            from_eth = false;
+            tcp_client.close();
+            return( NULL );
+        }
+    }        
+    if( !tcp_server.accept( tcp_client ) ){
+        tcp_session = true;
+        tcp_timer.start();
+        last_bufptr = bufptr;
+        eth_buffer[ 0 ] = 0;
         bufret = 0;
-        from_eth = false;
-        tcp_client.close();
-        return( NULL );
-    } 
-    
-    if( udp_query )
-    {   
-        if( msg_from_cb != NULL )
-        {
-            last_bufptr = bufptr;
-            if( ( length > 2 ) && ( msg_from_cb[ length - 2 ]  == '\r' ) ) msg_from_cb[ length - 2 ] = 0;
-    
-            if( ( length > 1 ) && ( msg_from_cb[ length - 1 ]  == '\n' ) ) msg_from_cb[ length - 1 ] = 0;
+    }
+    if( tcp_session ){
+        //if( !( (int)tcp_timer.read_ms() % 100 ) ){
+            //tcp_client.set_blocking( false, 1 );
+            tcp_client.set_blocking( false, 0 );
+            int n = tcp_client.receive( eth_buffer, sizeof( eth_buffer ) - 1 );
+            if( n > 0 ){
+                tcp_timer.reset();
+                
+                if( ( n > 2 ) && ( eth_buffer[ n - 2 ]  == '\r' ) ) eth_buffer[ n - 2 ] = 0;
+                
+                if( ( n > 1 ) && ( eth_buffer[ n - 1 ]  == '\n' ) ) eth_buffer[ n - 1 ] = 0;
+                
+                if( ( n == 1 ) && eth_buffer[ 0 ] == 0x0A ) strcpy( eth_buffer, "\r" );
+                
+                //if( eth_buffer[ 0 ] == '\r' || eth_buffer[ 1 ] == '\n' || eth_buffer[ 2 ] == 'r' || eth_buffer[ 2 ] == '\n'   ) strcpy( eth_buffer, "\r" );
 
-            if( ( length == 1 ) && msg_from_cb[ 0 ] == 0x0A ) strcpy( msg_from_cb, "\r" );
-            
-            bufptr = strlen( msg_from_cb );
-            debug_buf = msg_from_cb;
-            from_eth = true;
-            bufret = 1;
-        }
-    } 
-        else 
-    {
-        if( !tcp_server.accept( tcp_client ) )
-        {
-            tcp_session = true;
-            tcp_timer.start();
-            last_bufptr = bufptr;
-            for( register int i = 0; i < __PROMPT_ETH_BUFFER_SIZE__; i++ ) eth_buffer[ i ] = 0;
-        }
-            if( tcp_session && !udp_query )
-        {
-            tcp_client.set_blocking( false, 0 );
-            //for( register int i = 0; i < __PROMPT_ETH_BUFFER_SIZE__; i++ ) eth_buffer[ i ] = 0;
-            int n = tcp_client.receive( eth_buffer, sizeof( eth_buffer ) - 1 );
-            if( n > 0 ) {
-                tcp_timer.reset();
-    
-                if( ( n > 2 ) && ( eth_buffer[ n - 2 ]  == '\r' ) ) eth_buffer[ n - 2 ] = 0;
-    
-                if( ( n > 1 ) && ( eth_buffer[ n - 1 ]  == '\n' ) ) eth_buffer[ n - 1 ] = 0;
-    
-                if( ( n == 1 ) && eth_buffer[ 0 ] == 0x0A ) strcpy( eth_buffer, "\r" );
-    
                 bufptr = strlen( eth_buffer );
                 debug_buf = eth_buffer;
                 from_eth = true;
                 bufret = 1;
-    
-                if( !( strcmp( eth_buffer, "quit" ) ) )
-                {
-                    tcp_timer.stop();
+                
+                if( !( strcmp( eth_buffer, "quit" ) ) ){
                     tcp_timer.reset();
                     debug_buf = __debug_buf__;
                     bufptr = last_bufptr;
@@ -123,39 +653,50 @@
                     bufret = 0;
                     return( NULL );
                 }
-            } else {
+                /*else if( !( strcmp( eth_buffer, "alive" ) ) ){
+                    char wake_msg[ 8 ];
+                    external_wdt = EXTERN_WDT_IDLE;
+                    strcpy( wake_msg, "wakeup\n" );
+                    while( !( tcp_client.send_all( wake_msg, strlen( wake_msg ) ) ) );
+                    strcpy( eth_buffer, "0" );
+                    bufret = 0;
+                }
+                */
+            }else{
                 debug_buf = __debug_buf__;
                 bufptr = last_bufptr;
                 from_eth = false;
             }
+        //}
+    }
+    
+    if( !from_eth ){
+        if( pc.readable() ){
+            // imput do teclado
+            b = pc.getc();
+            if( b == 0x0D ){ // enter
+                bufret = 1;
+            }else{
+                pc.putc( b );
+                if( b == 0x08 || b == 0x7F ){ // BS | DEL
+                    if( bufptr > 0 ) debug_buf[ --bufptr ] = 0;
+                }else if( b == 0x09 ){
+                    // ignore tab
+                }else{  
+                    debug_buf[bufptr] = b;
+                    bufptr++;
+                }
+            }
         }
     }
-
-    if( ( !from_eth ) && ( !udp_query ) )
-    {
-        if( pc.readable() ) {
-            b = pc.getc();
-            if( b == 0x0D ) {
-                // enter
-                bufret = 1;
-                if( from_eth ) serial_pc_pending = true;
-            } else {
-                pc.putc( b );
-                if( b == 0x08 || b == 0x7F ) {
-                    // BS | DEL
-                    if( bufptr > 0 ) {
-                        __debug_buf__[ --bufptr ] = 0;
-                    }
-                } else if( b == 0x09 ) {
-                    // ignore tab
-                } else {
-                    //debug_msg("--%c,%d--%d--", b, bufptr, last_bufptr );
-                    __debug_buf__[ bufptr ] = b;
-                    bufptr++;
-                }
-                last_bufptr = bufptr;
-            }
-        }
+    
+    if( msg_from_cb ){
+        if( tcp_session ){
+            tcp_client.send_all( msg_from_cb, strlen( msg_from_cb ) );
+        }else if( udp_request ){
+            udp_server.sendTo( udp_client, msg_from_cb, strlen( msg_from_cb ) );
+        }    
+        if( debug_uart3 ) pc.printf( "\n\r%s\n\r", msg_from_cb );
     }
     
     if( flood_silence ){
@@ -164,33 +705,36 @@
             int str_end = strlen( cmd );
             cmd[ str_end ] = 0x0D;
             cmd[ str_end + 1 ] = 0x00;
-
+            
             int port = convert_ext_to_port( ext_count );
-            send2callboxes( build_cb_package( ext_count, port, __PROMPT__, cmd, id_msg++, CB_BUFFER_SIZE - __VZ_HEADER_OFFSET__, write_buffer ) );
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\r\nSilence sent to ext=%d port=%d", ext_count, port );
-
-            if( tcp_session && !udp_query ) {
+            send2callboxes( __build_cb_package__( ext_count, port, __PROMPT__, cmd, id_msg++, __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+            if( debug_uart3 ) pc.printf("\r\nSilence sent to ext=%d port=%d", ext_count, port );
+            
+            if( tcp_session ){ 
                 snprintf( eth_buffer, __PROMPT_ETH_BUFFER_SIZE__, "\r\nSilence sent to ext=%d port=%d", ext_count, port );
+                //eth_buffer[ strlen( eth_buffer ) - 1 ] = '\0';
+                
                 tcp_client.send_all( eth_buffer, strlen( eth_buffer ) );
-            } else if( udp_query ) {
+            }else if( udp_request ){
                 snprintf( eth_buffer, __PROMPT_ETH_BUFFER_SIZE__, "\r\nSilence sent to ext=%d port=%d", ext_count, port );
-                udp_query_send_msg( eth_buffer );
+                //eth_buffer[ strlen( eth_buffer ) - 1 ] = '\0';
+            
+                udp_server.sendTo( udp_client, eth_buffer, strlen( eth_buffer ) );
             }
             flood_silence_timer.reset();
             
-            // importante para o uso da funçao silence
-            if( ++ext_count > end_ext ) {
+            if( ++ext_count > end_ext ){
                 flood_silence = false;
                 flood_silence_timer.stop();
                 flood_silence_timer.reset();
-
-                if( debug_uart3 && !( from_eth ) ) pc.printf("\r\n> " );
-                if( tcp_session && !udp_query ) {
+                
+                if( debug_uart3 ) pc.printf("\r\n> " );
+                if( tcp_session ){ 
                     snprintf( eth_buffer, __PROMPT_ETH_BUFFER_SIZE__, "\r\n> " );
                     tcp_client.send_all( eth_buffer, strlen( eth_buffer ) );
-                } else if( udp_query ) {
+                }else if( udp_request ){
                     snprintf( eth_buffer, __PROMPT_ETH_BUFFER_SIZE__, "\r\n> " );
-                    udp_query_send_msg( eth_buffer );
+                    udp_server.sendTo( udp_client, eth_buffer, strlen( eth_buffer ) );
                 }
             }
         }
@@ -363,6 +907,18 @@
             set_server_port( atoi( debug_buf + 7 ) );
             files('s');
         }
+
+        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "telemetry_ip ", 13 ) ){
+            miss_match = false;
+            set_telemetry_ip( debug_buf + 13 );
+            files('s');
+        }
+        
+        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "telemetry_port ", 15 ) ){
+            miss_match = false;
+            set_telemetry_port( atoi( debug_buf + 15 ) );
+            files('s');
+        }
         
         else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "fw_ip ", 6 ) ){
             miss_match = false;
@@ -385,17 +941,17 @@
             */
         }
 
-        else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "reset" ) ) {
+        else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "reset" ) ){
             miss_match = false;
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\n\rJob is done\n\r");
-            if( from_eth ) {
+            if( debug_uart3 ) pc.printf("\n\rJob is done\n\r");
+            if( from_eth ){
                 snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Job is done\n\r");
                 debug_buf[ strlen( debug_buf ) - 1 ] = '\0';
-                if( tcp_session && !udp_query ) {
+                if( tcp_session ){ 
                     tcp_client.send_all( debug_buf, strlen( debug_buf ) );
                     tcp_client.close();
-                } else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                }else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
             __disable_irq();
@@ -411,11 +967,6 @@
             }
         }
         
-        else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "date" ) ) {
-            miss_match = false;
-            send_msg(" %s %s", __DATE__, __TIME__ );
-        }
-        
         else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "dep" ) ){
             miss_match = false;
             drop_entendi_pkg = !drop_entendi_pkg;
@@ -469,34 +1020,6 @@
             
         }
         
-        else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "drp" ) ){
-            miss_match = false;
-            drop_registry_pkg = !drop_registry_pkg;
-            if ( drop_registry_pkg )
-            {
-                debug_msg ("registrys pkgs from cbx will be droped");
-            }
-                else
-            {
-                debug_msg ("registrys pkgs from cbx don't will be droped");    
-            }
-            
-        }
-        
-        else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "rafc" ) ){
-            miss_match = false;
-            received_audio_from_cb = !received_audio_from_cb;
-            if ( received_audio_from_cb )
-            {
-                debug_msg ("audio pkgs from cbx will printed");
-            }
-                else
-            {
-                debug_msg ("audio pkgs from cbx don't will printed");
-            }
-            
-        }
-        
         else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "dap" ) ){
             miss_match = false;
             drop_ack_pkg = !drop_ack_pkg;
@@ -522,8 +1045,10 @@
             {
                 debug_msg ("rtp pkgs from ast don't will be droped");    
             }
+            
         }
         
+        
         else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "drfc" ) ){
             miss_match = false;
             drop_rtp_from_cbx_pkg = !drop_rtp_from_cbx_pkg;
@@ -534,12 +1059,8 @@
                 else
             {
                 debug_msg ("rtp pkgs from cbx don't will be droped");    
-            }   
-        }
-        
-        else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "uptime" ) ) {
-            miss_match = false;
-            send_msg(" %d", uptime );
+            }
+            
         }
         
         else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "ftq" ) ){
@@ -705,10 +1226,10 @@
         else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "protocol" ) ){
             miss_match = false;
             
-            if( debug_uart3 ) pc.printf( "\n\r| E | E | P | P | C | C | T | [ Seq_num | Audio ] | 14[ Clock | Audio ] | [ TS | Audio ] | ... |\n\r \n\rE = Ext = Ramal\n\r \n\rP = Port = Porta\n\r \n\rC = Checksum\n\r \n\rT = Type = Tipo\n\r \n\rSeq_num = Sequence Number = Numero de sequencia\n\r \n\rClock = 14 bytes to sync\n\r \n\r... = demais CB_BUFFER_SIZE - __VZ_HEADER_OFFSET__  bytes\n\r" );
+            if( debug_uart3 ) pc.printf( "\n\r| E | E | P | P | C | C | T | [ Seq_num | Audio ] | 14[ Clock | Audio ] | [ TS | Audio ] | ... |\n\r \n\rE = Ext = Ramal\n\r \n\rP = Port = Porta\n\r \n\rC = Checksum\n\r \n\rT = Type = Tipo\n\r \n\rSeq_num = Sequence Number = Numero de sequencia\n\r \n\rClock = 14 bytes to sync\n\r \n\r... = demais __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__  bytes\n\r" );
             
             if( from_eth ){
-                snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "\n\r| E | E | P | P | C | C | T | [ Seq_num | Audio ] | 14[ Clock | Audio ] | [ TS | Audio ] | ... |\n\r \n\rE = Ext = Ramal\n\r \n\rP = Port = Porta\n\r \n\rC = Checksum\n\r \n\rT = Type = Tipo\n\r \n\rSeq_num = Sequence Number = Numero de sequencia\n\r \n\rClock = 14 bytes to sync\n\r \n\r... = demais CB_BUFFER_SIZE - __VZ_HEADER_OFFSET__  bytes\n\r" );
+                snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "\n\r| E | E | P | P | C | C | T | [ Seq_num | Audio ] | 14[ Clock | Audio ] | [ TS | Audio ] | ... |\n\r \n\rE = Ext = Ramal\n\r \n\rP = Port = Porta\n\r \n\rC = Checksum\n\r \n\rT = Type = Tipo\n\r \n\rSeq_num = Sequence Number = Numero de sequencia\n\r \n\rClock = 14 bytes to sync\n\r \n\r... = demais __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__  bytes\n\r" );
                 //debug_buf[ strlen( debug_buf ) - 1 ] = '\0';
             }
         }
@@ -1150,7 +1671,7 @@
             }
         }
         
-        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "telos ", 7 ) ){
+        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "dtelos ", 7 ) ){
             if (xmemmatch( (uint8_t*)( debug_buf + 7 ), (uint8_t*) "on", 2 ) ){
                 miss_match = false;
                 if( debug_uart3 ) pc.printf( "\n\rTelemetry Debug ON\n\r" );
@@ -1192,46 +1713,47 @@
             }
         }
         
-                else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "pcb ", 4 )) {
+        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "promptcb ", 9 ) ){
             miss_match = false;
+            //static uint8_t id_msg = 0x10;
+            uint8_t write_buffer[ 300 ];
             int ext,port;
             char *split, *ref, *cmd;
-
+            
             ref = debug_buf;
-
+            
             strcat( debug_buf, "\r" );
-
-            split = strtok( debug_buf + 4, " " );
+            
+            split = strtok( debug_buf + 9, " " );
             ext = atoi( split );
-
-            port = convert_ext_to_port( ext );
+            split = strtok( NULL, " " );
+            port = atoi( split );
             split += strlen( split ) + 1;
             cmd = split;
-
+            
             promptcb_last_ext = ext;
             promptcb_last_port = port;
-
+            
             strcpy( promptcb_last_cmd, cmd );
-
-            for( register int i = strlen( cmd ); i < DEBUGBUFSIZE; i++ ) cmd[ i ] = 0;
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\r\next=%d port=%d cmd=%s", ext, port, cmd );
-            send2callboxes( build_cb_package( ext, port, __PROMPT__, cmd, id_msg++, CB_BUFFER_SIZE - __VZ_HEADER_OFFSET__, write_buffer ) );
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\n\rComando enviado");
-
-            if( from_eth ) {
+            strcat( cmd, "\r\r\r\n" );
+            
+            if( debug_uart3 ) pc.printf("\r\next=%d port=%d cmd=%s", ext, port, cmd );
+            send2callboxes( __build_cb_package__( ext, port, __PROMPT__, cmd, id_msg++, __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+            if( debug_uart3 ) pc.printf("\n\rComando enviado");
+            
+            if( from_eth ){
                 char eth_msg[ 512 ];
                 snprintf( eth_msg, 512 - 1, "\r\next=%d port=%d cmd=%s\r\nComando enviado\n\r", ext, port, cmd );
-                if( tcp_session && !udp_query ) {
+                if( tcp_session ){ 
                     tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                } else if( udp_query ) {
-                    udp_query_send_msg( eth_msg );
+                }else if( udp_request ){
+                    udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
                 }
             }
-
+            
             debug_buf = ref;
             bufptr = 0;
-            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
         }
         
         else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "bye ", 4 ) ){
@@ -1249,109 +1771,115 @@
             port = convert_ext_to_port( ext );
             
             if( debug_uart3 ) pc.printf("\r\next=%d port=%d request bye", ext, port );
-            send2callboxes( build_cb_package( ext, port, __CB_BYE__, (char * )data, 0x20, CB_BUFFER_SIZE - __VZ_HEADER_OFFSET__, write_buffer ) );
+            send2callboxes( __build_cb_package__( ext, port, __CB_BYE__, (char * )data, 0x20, __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
             if( debug_uart3 ) pc.printf("\n\rBye enviado");
             
             if( from_eth ){
                 char eth_msg[ 512 ];
                 snprintf( eth_msg, 512 - 1, "\r\next=%d port=%d request bye\n\r", ext, port );
-                if( tcp_session && !udp_query ) {
+                if( tcp_session ){ 
                     tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                } else if( udp_query ) {
-                    udp_query_send_msg( eth_msg );
+                }else if( udp_request ){
+                    udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
                 }
             }
-                        
+            
             debug_buf = ref;
             bufptr = 0;
             for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
         }
         
-                else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "pcb ", 4 )) {
+        //promptcb ramal porta comando
+        //FIXME colocar a parte eth de novo
+        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "pcb ", 4 )) {
             miss_match = false;
             int ext,port;
             char *split, *ref, *cmd;
-
+            
             ref = debug_buf;
-
+            
             strcat( debug_buf, "\r" );
-
+            
             split = strtok( debug_buf + 4, " " );
             ext = atoi( split );
-
+            
             port = convert_ext_to_port( ext );
             split += strlen( split ) + 1;
             cmd = split;
-
+            
             promptcb_last_ext = ext;
             promptcb_last_port = port;
-
+            
             strcpy( promptcb_last_cmd, cmd );
-
-            for( register int i = strlen( cmd ); i < DEBUGBUFSIZE; i++ ) cmd[ i ] = 0;
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\r\next=%d port=%d cmd=%s", ext, port, cmd );
-            send2callboxes( build_cb_package( ext, port, __PROMPT__, cmd, id_msg++, CB_BUFFER_SIZE - __VZ_HEADER_OFFSET__, write_buffer ) );
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\n\rComando enviado");
-
-            if( from_eth ) {
+            strcat( cmd, "\r\r\r\n" );
+            
+            //send_msg( "Tamanho do cmd == %d", strlen( cmd ) );
+            
+            //for( register uint16_t i = strlen( cmd ); i < __CB_BUFFER_SIZE__; i++ ) cmd[ i ] = 0;
+            
+            if( debug_uart3 ) pc.printf("\r\next=%d port=%d cmd=%s", ext, port, cmd );
+            send2callboxes( __build_cb_package__( ext, port, __PROMPT__, cmd, id_msg++, __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+            if( debug_uart3 ) pc.printf("\n\rComando enviado");
+            
+            if( from_eth ){
                 char eth_msg[ 512 ];
                 snprintf( eth_msg, 512 - 1, "\r\next=%d port=%d cmd=%s\r\nComando enviado\n\r", ext, port, cmd );
-                if( tcp_session && !udp_query ) {
+                if( tcp_session ){ 
                     tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                } else if( udp_query ) {
-                    udp_query_send_msg( eth_msg );
+                }else if( udp_request ){
+                    udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
                 }
             }
-
+            
             debug_buf = ref;
+            //bufptr = 0;
+            //debug_buf[ 0 ] = 0;
             bufptr = 0;
-            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
         }
         
         else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "pcc ", 4 )) {
             miss_match = false;
             int ext,port;
             char *split, *ref, *cmd;
-
+            
             ref = debug_buf;
-
+            
             strcat( debug_buf, "\r" );
-
+            
             split = strtok( debug_buf + 4, " " );
             ext = atoi( split );
-
+            
             split += strlen( split ) + 1;
             split = strtok( NULL, " " );
             port = atoi( split );
-
+            
             split += strlen( split ) + 1;
             cmd = split;
-
+            
             promptcb_last_ext = ext;
             promptcb_last_port = port;
-
+            
             strcpy( promptcb_last_cmd, cmd );
-
-            for( register int i = strlen( cmd ); i < DEBUGBUFSIZE; i++ ) cmd[ i ] = 0;
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\r\next=%d port=%d cmd=%s", ext, port, cmd );
-            send2callboxes( build_cb_package( ext, port, __PROMPT__, cmd, id_msg++, CB_BUFFER_SIZE - __VZ_HEADER_OFFSET__, write_buffer ) );
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\n\rComando enviado");
-
-            if( from_eth ) {
+            strcat( cmd, "\r\r\r\n" );
+            
+            if( debug_uart3 ) pc.printf("\r\next=%d port=%d cmd=%s", ext, port, cmd );
+            send2callboxes( __build_cb_package__( ext, port, __PROMPT__, cmd, id_msg++, __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+            if( debug_uart3 ) pc.printf("\n\rComando enviado");
+            
+            if( from_eth ){
                 char eth_msg[ 512 ];
                 snprintf( eth_msg, 512 - 1, "\r\next=%d port=%d cmd=%s\r\nComando enviado\n\r", ext, port, cmd );
-                if( tcp_session && !udp_query ) {
+                if( tcp_session ){ 
                     tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                } else if( udp_query ) {
-                    udp_query_send_msg( eth_msg );
+                }else if( udp_request ){
+                    udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
                 }
             }
-
+            
             debug_buf = ref;
             bufptr = 0;
-            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
         }
         
         else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "print_cb ", 9 )) {
@@ -1559,59 +2087,60 @@
         }
         
         
-                else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "rush ", 5 )) {
+        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "rush ", 5 )) {
             miss_match = false;
             int ext,port;
             char *split, *ref, cmd[ 32 ];
-
+            
             ref = debug_buf;
-
+            
             strcat( debug_buf, "\r" );
-
+            
             split = strtok( debug_buf + 5, " " );
             ext = atoi( split );
-
+            
             split += strlen( split ) + 1;
             split = strtok( NULL, " " );
             port = atoi( split );
-
+            
             strcpy( cmd, "ping\r\n" );
-
+            
             promptcb_last_ext = ext;
             promptcb_last_port = port;
-
+            
             strcpy( promptcb_last_cmd, cmd );
             strcat( cmd, "\r\r\r\n" );
-
-            for( register uint8_t i = 0; i < 3; i++ ) {
-                if( debug_uart3 && !( from_eth ) ) pc.printf("\r\next=%d port=%d cmd=%s", ext, port, cmd );
-                send2callboxes( build_cb_package( ext, port, __PROMPT__, cmd, id_msg++, CB_BUFFER_SIZE - __VZ_HEADER_OFFSET__, write_buffer ) );
-                if( debug_uart3 && !( from_eth ) ) pc.printf("\n\rComando enviado");
-
-                if( from_eth ) {
+            
+            for( register uint8_t i = 0; i < 3; i++ ){
+                if( debug_uart3 ) pc.printf("\r\next=%d port=%d cmd=%s", ext, port, cmd );
+                send2callboxes( __build_cb_package__( ext, port, __PROMPT__, cmd, id_msg++, __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+                if( debug_uart3 ) pc.printf("\n\rComando enviado");
+            
+                if( from_eth ){
                     char eth_msg[ 512 ];
                     snprintf( eth_msg, 512 - 1, "\r\next=%d port=%d cmd=%s\r\nComando enviado\n\r", ext, port, cmd );
-                    if( tcp_session && !udp_query ) {
+                    if( tcp_session ){ 
                         tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                    } else if( udp_query ) {
-                        udp_query_send_msg( eth_msg );
+                    }else if( udp_request ){
+                        udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
                     }
                 }
             }
-
+            
             debug_buf = ref;
             bufptr = 0;
-            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
         }
         
         
+        
         else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "_pcb",4 )) {
             miss_match = false;
             debug_buf[ bufptr++ ] = 0x0D;
             debug_buf[ bufptr++ ] = 0x00;
 
             if( debug_uart3 ) pc.printf("\r\next=%d port=%d\r\ncmd=%s\r\n",promptcb_last_ext, promptcb_last_port, debug_buf + 4 );
-            send2callboxes( build_cb_package( promptcb_last_ext, promptcb_last_port, __PROMPT__, debug_buf + 4, id_msg++, CB_BUFFER_SIZE - __VZ_HEADER_OFFSET__, write_buffer ) );
+            send2callboxes( __build_cb_package__( promptcb_last_ext, promptcb_last_port, __PROMPT__, debug_buf + 4, id_msg++, __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
             if( debug_uart3 ) pc.printf("\n\rComando enviado\n\r");
         }
 
@@ -1795,388 +2324,399 @@
         
         else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "help" )) {
             miss_match = false;
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\n\r****************************PROMPT HELP******************\n\r");
-            if( from_eth ) {
+            if( debug_uart3 ) pc.printf("\n\r****************************PROMPT HELP******************\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "\n\r****************************PROMPT HELP******************\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
-                    /*
-                    int send = udp_client.sendTo( udp_server, debug_buf, strlen( debug_buf ) );
-
-                    if( send != strlen( debug_buf ) ) {
-                        if( debug_reconnect ) send_msg("Reconnect udp_query client");
-                        reconnect_prompt_udp_socket();
-                        miss_prompt_udp_send_pkg++;
-                    }
-                    */
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    while( !( udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) ) ) );
                 }
             }
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("ifconfig                        - mostra o arquivo de configuracao do sistema\n\r");
-            if( from_eth ) {
+            
+            if( debug_uart3 ) pc.printf("ifconfig                        - mostra o arquivo de configuracao do sistema\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "ifconfig                        - mostra o arquivo de configuracao do sistema\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+                }
+            }
+            if( debug_uart3 ) pc.printf("dconfig                         - volta as configuracoes do sistema para o padrao de fabrica\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "dconfig                         - volta as configuracoes do sistema para o padrao de fabrica\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+                }
+            }
+            if( debug_uart3 ) pc.printf("callme [ramal porta]            - envia o pedido de ligacao para o callbox com o ramal e porta indicada\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "callme [ramal porta]            - envia o pedido de ligacao para o callbox com o ramal e porta indicada\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("dconfig                         - volta as configuracoes do sistema para o padrao de fabrica\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "dconfig                         - volta as configuracoes do sistema para o padrao de fabrica\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
-                }
-            }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("callme [ramal porta]            - envia o pedido de ligacao para o callbox com o ramal e porta indicada\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "callme [ramal porta]            - envia o pedido de ligacao para o callbox com o ramal e porta indicada\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            if( debug_uart3 ) pc.printf("pcb porta comando               - envia o <comando> para o cbx <ramal> e <porta> executar\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "promptcb ramal porta comando    - envia o <comando> para o cbx <ramal> e <porta> executar\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("pcb porta comando               - envia o <comando> para o cbx <ramal> e <porta> executar\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "promptcb ramal porta comando    - envia o <comando> para o cbx <ramal> e <porta> executar\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            if( debug_uart3 ) pc.printf("format                          - formata o sistema de arquivos\n\r");
+            //desabilitado via eth
+            /*
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "format                          - formata o sistema de arquivos\n\r" );
+                if( tcp_session ) tcp_client.send_all( debug_buf, strlen( debug_buf ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("format                          - formata o sistema de arquivos\n\r");
-            if( debug_uart3 && !( from_eth ) ) pc.printf("reset                           - resta o sistema\n\r");
-            if( from_eth ) {
+            */
+            if( debug_uart3 ) pc.printf("reset                           - resta o sistema\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "reset                           - resta o sistema\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("ipset [ip]                      - Configura o IP da cabeceira\n\r");
-            if( from_eth ) {
+            if( debug_uart3 ) pc.printf("ipset [ip]                      - Configura o IP da cabeceira\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "ipset [ip]                      - Configura o IP da cabeceira\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("extset [ext]                    - Configura a ext da cabeceira\n\r");
-            if( from_eth ) {
+            if( debug_uart3 ) pc.printf("extset [ext]                    - Configura a ext da cabeceira\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "extset [ext]                    - Configura a ext da cabeceira\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("msipport [port]                 - Configura a porta SIP da cabeceira\n\r");
-            if( from_eth ) {
+            if( debug_uart3 ) pc.printf("msipport [port]                 - Configura a porta SIP da cabeceira\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "msipport [port]                 - Configura a porta SIP da cabeceira\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("serverip [ip]                   - Configura o ip do servidor asterisk\n\r");
-            if( from_eth ) {
+            if( debug_uart3 ) pc.printf("serverip [ip]                   - Configura o ip do servidor asterisk\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "serverip [ip]                   - Configura o ip do servidor asterisk\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("serextset [ext]                 - Configura a server ext da cabeceira\n\r");
-            if( from_eth ) {
+            if( debug_uart3 ) pc.printf("serextset [ext]                 - Configura a server ext da cabeceira\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "serextset [ext]                 - Configura a server ext da cabeceira\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("ssport [port]                   - Configura a porta SIP do servidor asterisk\n\r");
-            if( from_eth ) {
+            if( debug_uart3 ) pc.printf("ssport [port]                   - Configura a porta SIP do servidor asterisk\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "ssport [port]                   - Configura a porta SIP do servidor asterisk\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("maskset [mask]                  - Configura a mascara da cabeceira\n\r");
-            if( from_eth ) {
+            if( debug_uart3 ) pc.printf("maskset [mask]                  - Configura a mascara da cabeceira\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "maskset [mask]                  - Configura a mascara da cabeceira\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("gatewayset [gateway]            - Configura o gateway da cabeceira\n\r");
-            if( from_eth ) {
+            if( debug_uart3 ) pc.printf("gatewayset [gateway]            - Configura o gateway da cabeceira\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "gatewayset [gateway]            - Configura o gateway da cabeceira\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("fw_ip                           - Configura o IP do servidor de fw\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "fw_ip                           - Configura o IP do servidor de fw\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            if( debug_uart3 ) pc.printf("telemetry_ip                    - Configura o IP do servidor de telemetria\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "telemetry_ip                    - Configura o IP do servidor de telemetria\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("fw_port                         - Configura a porta do servidor de fw\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "fw_port                         - Configura a porta do servidor de fw\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            if( debug_uart3 ) pc.printf("telemetry_port                  - Configura a port do servidor de telemetria\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "telemetry_port                  - Configura a port do servidor de telemetria\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("maxext                          - Configura o maior ramal possivel de ser registrado nesse ramo\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "maxext                          - Configura o maior ramal possivel de ser registrado nesse ramo\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            
+            if( debug_uart3 ) pc.printf("fw_ip                           - Configura o IP do servidor de fw\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "fw_ip                           - Configura o IP do servidor de fw\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("minext                          - Configura o menor ramal possivel de ser registrado nesse ramo\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "minext                          - Configura o menor ramal possivel de ser registrado nesse ramo\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            if( debug_uart3 ) pc.printf("fw_port                         - Configura a porta do servidor de fw\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "fw_port                         - Configura a porta do servidor de fw\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+                }
+            }
+            
+            if( debug_uart3 ) pc.printf("maxext                          - Configura o maior ramal possivel de ser registrado nesse ramo\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "maxext                          - Configura o maior ramal possivel de ser registrado nesse ramo\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("showcb                          - lista os Cbx registrados na header\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "showcb                          - lista os Cbx registrados na header\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            
+            if( debug_uart3 ) pc.printf("minext                          - Configura o menor ramal possivel de ser registrado nesse ramo\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "minext                          - Configura o menor ramal possivel de ser registrado nesse ramo\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("cks                             - exibe estatisticas de check sum\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "cks                             - exibe estatisticas de check sum\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            
+            if( debug_uart3 ) pc.printf("showcb                          - lista os Cbx registrados na header\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "showcb                          - lista os Cbx registrados na header\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("reset_cks                       - reseta estatisticas de check sum\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "reset_cks                       - reseta estatisticas de check sum\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            /*
+            if( debug_uart3 ) pc.printf("status                          - lista resumida de cbx registrados na header\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "showcb                          - lista resumida de cbx registrados na header\n\r" );
+                if( tcp_session ) tcp_client.send_all( debug_buf, strlen( debug_buf ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf(".                               - executa o comando anterior novamente\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, ".                               - executa o comando anterior novamente\n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            */
+            if( debug_uart3 ) pc.printf("cks                             - exibe estatisticas de check sum\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "cks                             - exibe estatisticas de check sum\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("debug [on|off|show]             - seleciona debugs gerais | lista de debugs \n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "debug [on|off|show]             - seleciona debugs gerais | lista de debugs \n\r" );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            if( debug_uart3 ) pc.printf("reset_cks                       - reseta estatisticas de check sum\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "reset_cks                       - reseta estatisticas de check sum\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("{ flood [ on | off ] | [+|-] }  - simula envio de pacotes de audio\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "{ flood [ on | off ] | [+|-] }  - simula envio de pacotes de audio\n\r");
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            
+            if( debug_uart3 ) pc.printf(".                               - executa o comando anterior novamente\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, ".                               - executa o comando anterior novamente\n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("silence <start_ext end_ext>     - envia comando de flood off para os ramais no intervalo end_ext - start_ext\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "silence <start_ext end_ext>     - envia comando de flood off para os ramais no intervalo end_ext - start_ext\n\r");
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            if( debug_uart3 ) pc.printf("debug [on|off|show]             - seleciona debugs gerais | lista de debugs \n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "debug [on|off|show]             - seleciona debugs gerais | lista de debugs \n\r" );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("++ ext                          - Header flood on, ext flood on\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "++ ext                          - Header flood on, ext flood on\n\r");
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            if( debug_uart3 ) pc.printf("{ flood [ on | off ] | [+|-] }  - simula envio de pacotes de audio\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "{ flood [ on | off ] | [+|-] }  - simula envio de pacotes de audio\n\r");
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+                }
+            }
+            
+            if( debug_uart3 ) pc.printf("silence <start_ext end_ext>     - envia comando de flood off para os ramais no intervalo end_ext - start_ext\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "silence <start_ext end_ext>     - envia comando de flood off para os ramais no intervalo end_ext - start_ext\n\r");
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("-- ext                          - Header flood off, ext flood off\n\r");
-            if( from_eth ) {
+            
+            if( debug_uart3 ) pc.printf("++ ext                          - Header flood on, ext flood on\n\r");
+            if( from_eth ){
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "++ ext                          - Header flood on, ext flood on\n\r");
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("rx                              - Exibe ultimo pacote recebido dos CBx\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "rx                              - Exibe ultimo pacote recebido dos CBx\n\r");
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
-                }
-            }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("tx                              - Exibe ultimo pacote enviado para os CBx\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "tx                              - Exibe ultimo pacote enviado para os CBx\n\r");
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            
+            if( debug_uart3 ) pc.printf("-- ext                          - Header flood off, ext flood off\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "++ ext                          - Header flood on, ext flood on\n\r");
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("ls | status                     - Exibe uma lista ordenada por ext do CBx registrados na Header\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "ls | status                     - Exibe uma lista ordenada por ext do CBx registrados na Header\n\r");
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            
+            if( debug_uart3 ) pc.printf("rx                              - Exibe ultimo pacote recebido dos CBx\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "rx                              - Exibe ultimo pacote recebido dos CBx\n\r");
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("types                           - Lista os types usados no protocolo de comunicacao Header -- CBx\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "types                           - Lista os types usados no protocolo de comunicacao Header -- CBx\n\r");
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
-                }
-            }
-            if( debug_uart3 && !( from_eth ) ) pc.printf("protocol                        - Exibe formato do pacote seguindo o protocolo de comunicacao Header -- CBx\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "protocol                        - Exibe formato do pacote seguindo o protocolo de comunicacao Header -- CBx\n\r");
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-                else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            if( debug_uart3 ) pc.printf("tx                              - Exibe ultimo pacote enviado para os CBx\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "tx                              - Exibe ultimo pacote enviado para os CBx\n\r");
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("PROMPT VERSION: V%d\n\r", PVERSION);
-            if( from_eth ) {
-                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "PROMPT VERSION: V%d\n\r", PVERSION);
-                if( tcp_session && !udp_query ) {
-                    while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-                } else if( udp_query ) {
-                    udp_query_send_msg( debug_buf );
+            if( debug_uart3 ) pc.printf("ls | status                     - Exibe uma lista ordenada por ext do CBx registrados na Header\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "ls | status                     - Exibe uma lista ordenada por ext do CBx registrados na Header\n\r");
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
-            //*------------ formatando a saida ----------------*//
-            strcpy( last_cmd, tmp_cmd );
-            bufptr = 0;
-            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
-    
-            if( from_eth ) {
-                if( tcp_session && !udp_query ) {
-                    snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "> " );
-                    if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-                } else if( udp_query ) {
-                    udp_query_send_msg( "> " );
+            if( debug_uart3 ) pc.printf("types                           - Lista os types usados no protocolo de comunicacao Header -- CBx\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "types                           - Lista os types usados no protocolo de comunicacao Header -- CBx\n\r");
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
                 }
             }
+            if( debug_uart3 ) pc.printf("protocol                        - Exibe formato do pacote seguindo o protocolo de comunicacao Header -- CBx\n\r");
+            if( from_eth ){
+                snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "protocol                        - Exibe formato do pacote seguindo o protocolo de comunicacao Header -- CBx\n\r");
+                if( tcp_session ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
+                
+                else if( udp_request ){
+                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+                }
+            }
+            
+            if( debug_uart3 ) pc.printf("PROMPT VERSION: V%d\n\r",PVERSION);
+            //Obs :: a ultima linha nao mandamos direto pro tcp porque ela eh enviada fora desse escopo
+            if( from_eth ) snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "PROMPT VERSION: V%d\n\r",PVERSION);
         }
         
-                else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "callme ", 7 )) {
+        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "callme ", 7 )){
             miss_match = false;
             int ext,port;
             char cmd[ 16 ];
-
+            
             ext = atoi( debug_buf + 7 );
             port = convert_ext_to_port( ext );
-
+            
             strcpy( cmd, ( ext % 2 ) ? "call init B" : "call init A" );
-
+            
             if( ext % 2 ) ext--;
-
+            
             promptcb_last_ext = ext;
             promptcb_last_port = port;
-
+            
             int tmp = strlen( cmd );
             cmd[ tmp ] = 0x0D;
             cmd[ tmp + 1 ] = 0x00;
             strcpy( promptcb_last_cmd, cmd );
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\r\next=%d port=%d\r\ncmd=%s\r\n", ext, port, cmd );
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\n\r--------------------------------------------------------\n\r");
-            for( uint16_t i = 0; i < strlen( cmd ) ; i++ ) if( debug_uart3 && !( from_eth ) ) pc.printf( "%02x ", cmd[ i ] );
-
-            send2callboxes( build_cb_package( ext, port, __PROMPT__, cmd, id_msg++, CB_BUFFER_SIZE - __VZ_HEADER_OFFSET__, write_buffer ) );
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\n\r--------------------------------------------------------\n\r");
-            for( uint16_t i = 0; i < 300 ; i++ ) {
-                if( debug_uart3 && !( from_eth ) ) pc.printf( "%02x ", write_buffer[ i ] );
-                if( i != 0 && !( ( i + 1 ) % 30 ) ) if( debug_uart3 && !( from_eth ) ) pc.printf("\n\r");
-            }
-
-
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\n\rComando enviado\n\r");
-
-            if( from_eth ) {
+            
+            if( debug_uart3 ) pc.printf("\r\next=%d port=%d\r\ncmd=%s\r\n", ext, port, cmd );
+            
+            if( debug_uart3 ) pc.printf("\n\r--------------------------------------------------------\n\r");
+            for( uint16_t i = 0; i < strlen( cmd ) ; i++ ) if( debug_uart3 ) pc.printf( "%02x ", cmd[ i ] );
+            
+            send2callboxes( __build_cb_package__( ext, port, __PROMPT__, cmd, id_msg++, __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+            if( debug_uart3 ) pc.printf("\n\r--------------------------------------------------------\n\r");
+            for( uint16_t i = 0; i < 300 ; i++ ){
+                if( debug_uart3 ) pc.printf( "%02x ", write_buffer[ i ] );
+                if( i != 0 && !( ( i + 1 ) % 30 ) ) if( debug_uart3 ) pc.printf("\n\r");
+            }            
+                
+            
+            if( debug_uart3 ) pc.printf("\n\rComando enviado\n\r");
+            
+            if( from_eth ){
                 char eth_msg[ 512 ];
                 snprintf( eth_msg, 512 - 1, "\r\next=%d port=%d\r\ncmd=%s\r\n\n\rComando enviado\n\r", ext, port, cmd );
-                if( tcp_session && !udp_query ) {
+                if( tcp_session ){ 
                     tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                } else if( udp_query ) {
-                    udp_query_send_msg( eth_msg );
+                }else if( udp_request ){
+                    udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
                 }
             }
-
+            
             bufptr = 0;
-            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
         }
-
         
         if( miss_match ){ 
             if( debug_uart3 ) pc.printf("\n\r> %s: command not found\n\r", debug_buf );
@@ -2191,528 +2731,35 @@
             else if( strlen( debug_buf ) > 2 ) strcpy( last_cmd, tmp_cmd );
         }
     }      
-        if( b == 0x0D || bufret == 1 || bufptr > DEBUGBUFSIZE ) {
+    if( b == 0x0D || bufret == 1 || bufptr > DEBUGBUFSIZE ){
         bufret = 0;
-
-        if( debug_uart3 && !( from_eth ) ) pc.putc(0x0A);
-        if( debug_uart3 && !( from_eth ) ) pc.putc(0x0D);
-        if( debug_uart3 && !( from_eth ) ) pc.printf("> ");
-        
-        if( from_eth )
-        {   
-            if( strlen( debug_buf ) > 0 )
-            {
-                
-                if( debug_buf[ strlen( debug_buf ) - 1 ] == '\r' || debug_buf[ strlen( debug_buf ) - 1 ] == '\n' ) 
-                {
-                    //strcat( debug_buf, "> " );
-                    strcpy( debug_buf, "> " );
-                } else {
-                    //strcat( debug_buf, "\n\r> " );
-                    strcpy( debug_buf, "\n\r> " );
-                }
-            }else{
-                    
-            }
+        if( from_eth ){
+            from_eth = false;
             
-            if( tcp_session && !udp_query ) 
-            {    
-                tcp_client.send_all( debug_buf, strlen( debug_buf ) );
-            } else if( udp_query ) {
-                
-                    udp_query_send_msg( debug_buf );
-                
-            }       
-            for( register uint16_t i = 0; i < __PROMPT_ETH_BUFFER_SIZE__; i++ ) eth_buffer[ i ] = 0;
+            if( debug_buf[ strlen( debug_buf ) - 1 ] == '\r' || debug_buf[ strlen( debug_buf ) - 1 ] == '\n' ) strcat( debug_buf, "> " );
             
-            debug_buf = __debug_buf__;
-            
-            bufptr = last_bufptr;
+            else strcat( debug_buf, "\n\r> " );
             
-        } 
-            else 
-        {
-            bufptr = 0;
-            last_bufptr = 0;
-            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
-        }
-    }
-    return( NULL );
-}
-
-
-// operantion with the system config files
-void files( const char type )
-{
-    // show files
-    if (type == 's' ) {
-         
-        if( debug_uart3 && !( from_eth ) ) pc.printf("Header IP " );
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Header IP " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/myip.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("Header ext ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Header ext " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/myext.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("Header port ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Header port " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/mysipport.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("Server IP ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Server IP " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/serverip.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("Server ext ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Server ext " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/peerext.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("Server port ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Server port " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
+            if( tcp_session ){
+                
+                tcp_client.send_all( debug_buf, strlen( debug_buf ) );
+            
+            }else if( udp_request ){
+            
+                int sent = udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+            
+                udp_request = false;  
             }
-        }
-        cat("/qspi/serverport.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("Mascara de rede ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Mascara de rede " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-        cat("/qspi/mymask.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("Gateway IP ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Gateway IP " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-        cat("/qspi/mygateway.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("UDP Port ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "UDP Port " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/udpport.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("TCP Port ");
-        if( from_eth  ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "TCP Port " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/tcpport.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("FW Server IP ");
-        if( from_eth  ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "FW Server IP " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/fw_ip.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("FW Server Port ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "FW Server Port " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/fw_port.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("Max Ext ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Max Ext " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/maxext.txt");
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("Min Ext ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Min Ext " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/minext.txt");
-        
-        if( debug_uart3 && !( from_eth ) ) pc.printf("Shift Port ");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Shift Port " );
-            if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-
-            else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-        }
-
-        cat("/qspi/shift_port.txt");
-
-        
-        //*------------ formatando a saida ----------------*//
-        strcpy( last_cmd, tmp_cmd );
-        bufptr = 0;
-        for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
-
-        if( from_eth ) {
-            
-            if( tcp_session && !udp_query ) {
-                snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "> " );
-                if( tcp_session && !udp_query ) while( !( tcp_client.send_all( debug_buf, strlen( debug_buf ) ) ) );
-            } else if( udp_query ) {
-                udp_query_send_msg( "> " );
-                
-            }
+            for( register uint16_t i = 0; i < __PROMPT_ETH_BUFFER_SIZE__; i++ ) eth_buffer[ i ] = 0;
+            debug_buf = __debug_buf__;
+            bufptr = last_bufptr;
+        }else{
+            bufptr = 0;
+            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
         }
-    }
-
-    if (type == 'c' ) {
-        // close all files
-        if( fip ) fclose( fip );
-        if( fmask ) fclose( fmask );
-        if( fgate ) fclose( fgate );
-        if( fport )fclose( fport );
-        if( fsip ) fclose( fsip );
-        if( fsport ) fclose( fsport );
-        if( fext ) fclose( fext );
-        if( fserext ) fclose( fserext );
-        if( fudpport ) fclose( fudpport );
-        if( ftcpport ) fclose( ftcpport );
-        if( fmax ) fclose( fmax );
-        if( fmin ) fclose( fmin );
-        if( ffwip ) fclose( ffwip );
-        if( ffwport) fclose( ffwport );
-        if( fshift_port ) fclose ( fshift_port );
-    }
-
-    if (type == 'i' ) {
-         
-        // Check if files exist, if not create the files
-        //fixme criar um bool pra cada file
-        bool exists = true;
-
-        fip = fopen("/qspi/myip.txt", "r");
-        if( fip == NULL) {
-            set_ip( __MY_IP__ );
-            exists = false;
-        }
-
-        fserext = fopen("/qspi/myext.txt", "r");
-        if( fserext == NULL ) {
-            set_header_ext( __MY_EXT__ );
-            exists = false;
-        }
-
-        fport = fopen("/qspi/mysipport.txt", "r");
-        if (fport == NULL) {
-            set_header_sip_port( __MY_PORT__ );
-            exists = false;
-        }
-
-        fsip = fopen("/qspi/serverip.txt", "r");
-        if (fsip == NULL) {
-            set_server_ip( __SERVER_IP__ );
-            exists = false;
-        }
-
-        fext = fopen("/qspi/peerext.txt", "r");
-        if ( fext == NULL ) {
-            set_server_ext( __PEER_EXT__ );
-            exists = false;
-        }
-
-        fsport = fopen("/qspi/serverport.txt", "r");
-        if (fsport == NULL) {
-            set_server_port( __SERVER_PORT__ );
-            exists = false;
-        }
-
-        fmask = fopen("/qspi/mymask.txt", "r");
-        if (fmask == NULL) {
-            set_mask( __MY_MSK__ );
-            exists = false;
-        }
-
-        fgate = fopen("/qspi/mygateway.txt", "r");
-        if (fgate == NULL) {
-            set_gateway( __MY_GTW__ );
-            exists = false;
-        }
-
-        fudpport = fopen("/qspi/udpport.txt", "r" );
-        if( fudpport == NULL ) {
-            set_udp_port_listener( UDP_PORT_LISTENER );
-            exists = false;
-        }
-
-        ftcpport = fopen("/qspi/tcpport.txt", "r" );
-        if( ftcpport == NULL ) {
-            set_tcp_port_listener( TCP_PORT_LISTENER );
-            exists = false;
-        }
-
-        ffwip = fopen("/qspi/fw_ip.txt", "r" );
-        if( ffwip == NULL ) {
-            set_fw_ip( __FW_SERVER_IP__ );
-            exists = false;
-        }
-
-        ffwport = fopen("/qspi/fw_port.txt", "r" );
-        if( ffwport == NULL ) {
-            set_fw_port( __FW_SERVER_PORT__ );
-            exists = false;
-        }
-
-        fmax = fopen("/qspi/maxext.txt", "r" );
-        if( fmax == NULL ) {
-            set_max_ext( MAX_EXT );
-            exists = false;
-        }
-
-        fmin = fopen("/qspi/minext.txt", "r" );
-        if( fmin == NULL ) {
-            if( debug_file ) debug_msg("Don't exist /qspi/minext.txt");
-            set_min_ext( MIN_EXT );
-            exists = false;
-        }
-        
-        fshift_port = fopen("/qspi/shift_port.txt", "r" );
-        if( fshift_port == NULL )
-        {
-            if( debug_file ) debug_msg("Don't exist /qspi/shift_port.txt");
-            set_shift_port( SHIFT_PORT );
-            exists = false;
-        }
-         
-        if( !exists ) {
-            if( debug_uart3 && !( from_eth ) ) pc.printf("\n\rDefault configurations set!\n\r");
-            if( from_eth ) {
-                snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "Default configurations set!\n\r");
-                debug_buf[ strlen( debug_buf ) - 1 ] = '\0';
-                if( tcp_session && !udp_query ) {
-                    tcp_client.send_all( debug_buf, strlen( debug_buf ) );
-                    bufptr = 0;
-                    for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
-                }
-            }
-        }
-        reset_leds();
-    }
-
-    if (type == 'r' ) {
-        // Just open for read
-         
-        fip = fopen("/qspi/myip.txt", "r");
-        fmask = fopen("/qspi/mymask.txt", "r");
-        fgate = fopen("/qspi/mygateway.txt", "r");
-        fport = fopen("/qspi/mysipport.txt", "r");
-        fsip = fopen("/qspi/serverip.txt", "r");
-        fsport = fopen("/qspi/serverport.txt", "r");
-        fext = fopen( "/qspi/myext.txt", "r" );
-        fserext = fopen( "/qspi/peerext.txt", "r" );
-        fudpport = fopen( "/qspi/udpport.txt", "r" );
-        ftcpport = fopen( "/qspi/tcpport.txt", "r" );
-        ffwip = fopen("/qspi/fw_ip.txt", "r" );
-        ffwport = fopen("/qspi/fw_port.txt", "r" );
-        fmax = fopen("/qspi/maxext.txt", "r" );
-        fmin = fopen("/qspi/minext.txt", "r" );
-        fshift_port = fopen("/qspi/shift_port.txt", "r" );
-         
-    }
-
-    if( type == 'w') {
-         
-        // Create and write the default configs
-        set_ip( __MY_IP__ );
-
-        set_header_sip_port( __MY_PORT__ );
-
-        set_header_ext( __MY_EXT__ );
-
-        set_server_ip( __SERVER_IP__ );
-
-        set_server_ext( __PEER_EXT__ );
-
-        set_server_port( __SERVER_PORT__ );
-
-        set_mask( __MY_MSK__ );
-
-        set_gateway( __MY_GTW__ );
-
-        set_udp_port_listener( UDP_PORT_LISTENER );
-
-        set_tcp_port_listener( TCP_PORT_LISTENER );
-
-        set_fw_ip( __FW_SERVER_IP__ );
-
-        set_fw_port( __FW_SERVER_PORT__ );
-
-        set_max_ext( MAX_EXT );
-
-        set_min_ext( MIN_EXT );
-        
-        set_shift_port( SHIFT_PORT );
-
-        strcpy( last_cmd, tmp_cmd );
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("\n\rDefault configurations set!\n\r");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "\n\rDefault configurations set!\n\r");
-            debug_buf[ strlen( debug_buf ) - 1 ] = '\0';
-            if( tcp_session && !udp_query ) {
-                tcp_client.send_all( debug_buf, strlen( debug_buf ) );
-            } else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-            bufptr = 0;
-            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
-        }
-         
-    }
-
-    if (type == 'e')
-    {
-        //Erase configs    
-        fip = fopen("/qspi/myip.txt", "w");
-        fmask = fopen("/qspi/mymask.txt", "w");
-        fgate = fopen("/qspi/mygateway.txt", "w");
-        fport = fopen("/qspi/mysipport.txt", "w");
-        fsip = fopen("/qspi/serverip.txt", "w");
-        fsport = fopen("/qspi/serverport.txt", "w");
-        fext = fopen( "/qspi/myext.txt", "w" );
-        fserext = fopen( "/qspi/peerext.txt", "w" );
-        fudpport = fopen( "/qspi/udpport.txt", "w" );
-        ftcpport = fopen( "/qspi/tcpport.txt", "w" );
-        ffwip = fopen("/qspi/fw_ip.txt", "w" );
-        ffwport = fopen("/qspi/fw_port.txt", "w" );
-        fmax = fopen("/qspi/maxext.txt", "w" );
-        fmin = fopen("/qspi/minext.txt", "w" );
-        fshift_port = fopen("/qspi/shift_port.txt", "w" );
-
-        if( fip ) fprintf( fip, "%s\n\r", ""  );
-        if( fport ) fprintf( fport, "%i\n\r", 0 );
-        if( fext ) fprintf( fext, "%i\n\r", 0 );
-
-        if( fsip ) fprintf( fsip, "%s\n\r", ""  );
-        if( fserext ) fprintf( fserext, "%i\n\r", 0 );
-        if( fsport ) fprintf( fsport, "%i\n\r", 0 );
-
-        if( fmask ) fprintf( fmask, "%s\n\r","" );
-        if( fgate ) fprintf( fgate, "%s\n\r", "" );
-
-        if( fudpport ) fprintf( fudpport, "%i\n\r", 0 );
-        if( ftcpport ) fprintf( ftcpport, "%i\n\r", 0 );
-
-        if( ffwip ) fprintf( ffwip, "%s\n\r","" );
-        if( ffwport ) fprintf( ffwport, "%i\n\r",0 );
-
-        if( fmax ) fprintf( fmax, "%i\n\r", 0 );
-        if( fmin ) fprintf( fmin, "%i\n\r", 0 );
-        
-        if( fshift_port ) fprintf( fshift_port, "%i\n\r", 0 );
-
-        files('c');
-
-        if( debug_uart3 && !( from_eth ) ) pc.printf("\n\rErased configurations set!\n\r");
-        if( from_eth ) {
-            snprintf( debug_buf, __PROMPT_ETH_BUFFER_SIZE__, "\n\rErased configurations set!\n\r");
-            debug_buf[ strlen( debug_buf ) - 1 ] = '\0';
-            if( tcp_session && !udp_query ) {
-                tcp_client.send_all( debug_buf, strlen( debug_buf ) );
-            } else if( udp_query ) {
-                udp_query_send_msg( debug_buf );
-            }
-            bufptr = 0;
-            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
-        }
-         
-    }
-}
-
-void init_fsystem(){                 
-    //  init file system and check if files exist
-    if (!qspifs.isformatted()) {
-        qspifs.format();
-        if( debug_uart3 ) pc.printf("\n\rFile system configured!!\n\r");
-    }
-    // check if the files are created
-    files('i');
-    files('c');
-    send_msg("******* File System Ready *******");
+        pc.putc(0x0A);
+        pc.putc(0x0D);
+        if( debug_uart3 ) pc.printf("> ");
+    }    
+    return( NULL );
 }
\ No newline at end of file