Modularizando o src

Dependencies:   EALib EthernetInterface_vz mbed-rtos mbed

Fork of header_main_colinas_V0-20-09-14 by VZTECH

Revision:
116:39a41ebb675c
Parent:
115:a1e1e2e60a2c
Child:
117:e9facba9db27
--- a/prompt.cpp	Thu Apr 23 13:57:54 2015 +0000
+++ b/prompt.cpp	Thu Apr 23 20:24:09 2015 +0000
@@ -5,581 +5,37 @@
 
 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, *ftip, *ftport, *ffwip, *ffwport, *fmax, *fmin;
+FILE *fip, *fmask, *fgate, *fport, *fsip, *fsport, *fext, *fserext, *fudpport, *ftcpport, *ffwip, *ffwport, *fmax, *fmin, *fshift_port;
 
 uint8_t bufptr = 0;
 uint8_t last_bufptr = 0;
 
-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++;
-  }
-}
+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 );
 
-// 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 );
+    int tcp_bind = tcp_server.bind( TCP_PORT_LISTENER );
     tcp_server.set_blocking( false, 0 );
-    udp_server.set_blocking( false, 0 );
-    udp_server.bind( UDP_PORT_LISTENER );    
-    if( debug_uart3 ) pc.printf("******* Prompt eth Ready *******\n\r");
+    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 );
 }
 
 // main prompt process
-char * prompt_process( char * msg_from_cb ){
+char * prompt_process( char * msg_from_cb, int length )
+{
     //FIXME dar flush na serial
     volatile char b = 0;
     static uint8_t bufret = 0;
@@ -589,7 +45,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;
@@ -597,53 +53,67 @@
         flood_timeout.reset();
     }
     
-    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_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;
+        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( ( 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;
         }
-    }        
-    if( !tcp_server.accept( tcp_client ) ){
-        tcp_session = true;
-        tcp_timer.start();
-        last_bufptr = bufptr;
-        eth_buffer[ 0 ] = 0;
-        bufret = 0;
-    }
-    if( tcp_session ){
-        //if( !( (int)tcp_timer.read_ms() % 100 ) ){
-            //tcp_client.set_blocking( false, 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 ){
+            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" );
-
+    
                 bufptr = strlen( eth_buffer );
                 debug_buf = eth_buffer;
                 from_eth = true;
                 bufret = 1;
-                
-                if( !( strcmp( eth_buffer, "quit" ) ) ){
+    
+                if( !( strcmp( eth_buffer, "quit" ) ) )
+                {
+                    tcp_timer.stop();
                     tcp_timer.reset();
                     debug_buf = __debug_buf__;
                     bufptr = last_bufptr;
@@ -653,88 +123,74 @@
                     bufret = 0;
                     return( NULL );
                 }
-                /*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{
+            } else {
                 debug_buf = __debug_buf__;
                 bufptr = last_bufptr;
                 from_eth = false;
             }
-        //}
+        }
     }
-    
-    if( !from_eth ){
-        if( pc.readable() ){
-            // imput do teclado
+
+    if( ( !from_eth ) && ( !udp_query ) )
+    {
+        if( pc.readable() ) {
             b = pc.getc();
-            if( b == 0x0D ){ // enter
+            if( b == 0x0D ) {
+                // enter
                 bufret = 1;
-            }else{
+                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 ){
+                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;
+                } 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 ){
         if( flood_silence_timer.read_ms() > 250 ){
             char cmd[ 16 ] = "flood off";
             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 ) pc.printf("\r\nSilence sent to ext=%d port=%d", ext_count, port );
-            
-            if( tcp_session ){ 
+            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 ) {
                 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_request ){
+            } else if( udp_query ) {
                 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';
-            
-                udp_server.sendTo( udp_client, eth_buffer, strlen( eth_buffer ) );
+                udp_query_send_msg( eth_buffer );
             }
             flood_silence_timer.reset();
             
-            if( ++ext_count > end_ext ){
+            // importante para o uso da funçao silence
+            if( ++ext_count > end_ext ) {
                 flood_silence = false;
                 flood_silence_timer.stop();
                 flood_silence_timer.reset();
-                
-                if( debug_uart3 ) pc.printf("\r\n> " );
-                if( tcp_session ){ 
+
+                if( debug_uart3 && !( from_eth ) ) pc.printf("\r\n> " );
+                if( tcp_session && !udp_query ) {
                     snprintf( eth_buffer, __PROMPT_ETH_BUFFER_SIZE__, "\r\n> " );
                     tcp_client.send_all( eth_buffer, strlen( eth_buffer ) );
-                }else if( udp_request ){
+                } else if( udp_query ) {
                     snprintf( eth_buffer, __PROMPT_ETH_BUFFER_SIZE__, "\r\n> " );
-                    udp_server.sendTo( udp_client, eth_buffer, strlen( eth_buffer ) );
+                    udp_query_send_msg( eth_buffer );
                 }
             }
         }
@@ -907,18 +363,6 @@
             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;
@@ -941,17 +385,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 ) pc.printf("\n\rJob is done\n\r");
-            if( from_eth ){
+            if( debug_uart3 && !( from_eth ) ) 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 ){ 
+                if( tcp_session && !udp_query ) {
                     tcp_client.send_all( debug_buf, strlen( debug_buf ) );
                     tcp_client.close();
-                }else if( udp_request ){
-                    udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
+                } else if( udp_query ) {
+                    udp_query_send_msg( debug_buf );
                 }
             }
             __disable_irq();
@@ -967,6 +411,11 @@
             }
         }
         
+        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;
@@ -1256,10 +705,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';
             }
         }
@@ -1701,7 +1150,7 @@
             }
         }
         
-        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "dtelos ", 7 ) ){
+        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "telos ", 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" );
@@ -1743,47 +1192,46 @@
             }
         }
         
-        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "promptcb ", 9 ) ){
+                else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "pcb ", 4 )) {
             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 + 9, " " );
+
+            split = strtok( debug_buf + 4, " " );
             ext = atoi( split );
-            split = strtok( NULL, " " );
-            port = 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 );
-            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 ){
+
+            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 ) {
                 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 ){ 
+                if( tcp_session && !udp_query ) {
                     tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                }else if( udp_request ){
-                    udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
+                } else if( udp_query ) {
+                    udp_query_send_msg( eth_msg );
                 }
             }
-            
+
             debug_buf = ref;
             bufptr = 0;
-            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
         }
         
         else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "bye ", 4 ) ){
@@ -1801,115 +1249,109 @@
             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 ){ 
+                if( tcp_session && !udp_query ) {
                     tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                }else if( udp_request ){
-                    udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
+                } else if( udp_query ) {
+                    udp_query_send_msg( eth_msg );
                 }
             }
-            
+                        
             debug_buf = ref;
             bufptr = 0;
             for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
         }
         
-        //promptcb ramal porta comando
-        //FIXME colocar a parte eth de novo
-        else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "pcb ", 4 )) {
+                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 );
-            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 ){
+
+            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 ) {
                 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 ){ 
+                if( tcp_session && !udp_query ) {
                     tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                }else if( udp_request ){
-                    udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
+                } else if( udp_query ) {
+                    udp_query_send_msg( eth_msg );
                 }
             }
-            
+
             debug_buf = ref;
-            //bufptr = 0;
-            //debug_buf[ 0 ] = 0;
             bufptr = 0;
-            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+            for( register int 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 );
-            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 ){
+
+            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 ) {
                 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 ){ 
+                if( tcp_session && !udp_query ) {
                     tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                }else if( udp_request ){
-                    udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
+                } else if( udp_query ) {
+                    udp_query_send_msg( eth_msg );
                 }
             }
-            
+
             debug_buf = ref;
             bufptr = 0;
-            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
         }
         
         else if( xmemmatch( (uint8_t*)debug_buf, (uint8_t*) "print_cb ", 9 )) {
@@ -2117,60 +1559,59 @@
         }
         
         
-        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 ) 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 ){
+
+            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 ) {
                     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 ){ 
+                    if( tcp_session && !udp_query ) {
                         tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                    }else if( udp_request ){
-                        udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
+                    } else if( udp_query ) {
+                        udp_query_send_msg( eth_msg );
                     }
                 }
             }
-            
+
             debug_buf = ref;
             bufptr = 0;
-            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+            for( register int 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");
         }
 
@@ -2354,399 +1795,388 @@
         
         else if( xstrmatch( (uint8_t*)debug_buf, (uint8_t*) "help" )) {
             miss_match = false;
-            if( debug_uart3 ) pc.printf("\n\r****************************PROMPT HELP******************\n\r");
-            if( from_eth ){
+            if( debug_uart3 && !( from_eth ) ) 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 ) 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( 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( debug_uart3 ) pc.printf("ifconfig                        - mostra o arquivo de configuracao do sistema\n\r");
-            if( from_eth ){
+
+            if( debug_uart3 && !( from_eth ) ) 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 ) 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( 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("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("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("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("reset                           - resta o sistema\n\r");
-            if( from_eth ){
+            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 ) {
                 snprintf( debug_buf,__PROMPT_ETH_BUFFER_SIZE__, "reset                           - resta o sistema\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( 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("ipset [ip]                      - Configura o IP da cabeceira\n\r");
-            if( from_eth ){
+            if( debug_uart3 && !( from_eth ) ) 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 ) 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( 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("extset [ext]                    - Configura a ext da cabeceira\n\r");
-            if( from_eth ){
+            if( debug_uart3 && !( from_eth ) ) 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 ) 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( 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("msipport [port]                 - Configura a porta SIP da cabeceira\n\r");
-            if( from_eth ){
+            if( debug_uart3 && !( from_eth ) ) 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 ) 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( 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("serverip [ip]                   - Configura o ip do servidor asterisk\n\r");
-            if( from_eth ){
+            if( debug_uart3 && !( from_eth ) ) 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 ) 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( 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("serextset [ext]                 - Configura a server ext da cabeceira\n\r");
-            if( from_eth ){
+            if( debug_uart3 && !( from_eth ) ) 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 ) 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( 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("ssport [port]                   - Configura a porta SIP do servidor asterisk\n\r");
-            if( from_eth ){
+            if( debug_uart3 && !( from_eth ) ) 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 ) 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( 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("maskset [mask]                  - Configura a mascara da cabeceira\n\r");
-            if( from_eth ){
+            if( debug_uart3 && !( from_eth ) ) 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 ) 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( 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("gatewayset [gateway]            - Configura o gateway da cabeceira\n\r");
-            if( from_eth ){
+            if( debug_uart3 && !( from_eth ) ) 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 ) 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( 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_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_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("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("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("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_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("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("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("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("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("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("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("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("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(".                               - 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("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("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(".                               - 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("{ 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("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("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("{ 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 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("++ ext                          - Header flood on, ext flood on\n\r");
-            if( from_eth ){
+
+            if( debug_uart3 && !( from_eth ) ) 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( 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("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("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("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("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("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("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 ) );
+
+            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("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 ) );
+            //*------------ 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("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 ) 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 ){
+
+            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 ) {
                 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 ){ 
+                if( tcp_session && !udp_query ) {
                     tcp_client.send_all( eth_msg, strlen( eth_msg ) );
-                }else if( udp_request ){
-                    udp_server.sendTo( udp_client, eth_msg, strlen( eth_msg ) );
+                } else if( udp_query ) {
+                    udp_query_send_msg( eth_msg );
                 }
             }
-            
+
             bufptr = 0;
-            for( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+            for( register int 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 );
@@ -2761,35 +2191,528 @@
             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( from_eth ){
-            from_eth = false;
+
+        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( debug_buf[ strlen( debug_buf ) - 1 ] == '\r' || debug_buf[ strlen( debug_buf ) - 1 ] == '\n' ) strcat( debug_buf, "> " );
+            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;
+            
+            debug_buf = __debug_buf__;
+            
+            bufptr = last_bufptr;
             
-            else strcat( debug_buf, "\n\r> " );
-            
-            if( tcp_session ){
-                
-                tcp_client.send_all( debug_buf, strlen( debug_buf ) );
-            
-            }else if( udp_request ){
+        } 
+            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 );
+            }
+        }
+        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 ) {
             
-                int sent = udp_server.sendTo( udp_client, debug_buf, strlen( debug_buf ) );
-            
-                udp_request = false;  
+            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{
+        }
+    }
+
+    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( uint8_t i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
+            for( register int i = 0; i < DEBUGBUFSIZE; i++ ) debug_buf[ i ] = 0;
         }
-        pc.putc(0x0A);
-        pc.putc(0x0D);
-        if( debug_uart3 ) pc.printf("> ");
-    }    
-    return( NULL );
+         
+    }
+
+    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 *******");
 }
\ No newline at end of file