VZTECH / Mbed 2 deprecated main_src

Modularizando o src

Dependencies:   EALib EthernetInterface_vz mbed-rtos mbed

Fork of header_main_colinas_V0-20-09-14 by VZTECH

utils.cpp@46:a670f187a704, 2014-10-07 (annotated)

Committer:
klauss
Date:
Tue Oct 07 18:38:30 2014 +0000
Revision:
46:a670f187a704
Parent:
44:cc4996469404
Child:
48:195c97f12e8e
ajuste de bugs no uso do sistema de arquivos

Who changed what in which revision?

UserRevisionLine numberNew contents of line
klauss 0:4d17cd9c8f9d 1 #include "utils.h"
klauss 30:8dfb6d8de53d 2 #include "prompt.h"
klauss 0:4d17cd9c8f9d 3
klauss 0:4d17cd9c8f9d 4 void reverse( char str[], int length ){
klauss 0:4d17cd9c8f9d 5 int start = 0;
klauss 0:4d17cd9c8f9d 6 int end = length -1;
klauss 0:4d17cd9c8f9d 7 while (start < end){
klauss 0:4d17cd9c8f9d 8 swap(*(str+start), *(str+end));
klauss 0:4d17cd9c8f9d 9 start++;
klauss 0:4d17cd9c8f9d 10 end--;
klauss 0:4d17cd9c8f9d 11 }
klauss 0:4d17cd9c8f9d 12 }
klauss 0:4d17cd9c8f9d 13 char* itoa(int num, char* str, int base){
klauss 0:4d17cd9c8f9d 14 int i = 0;
klauss 0:4d17cd9c8f9d 15 bool isNegative = false;
klauss 0:4d17cd9c8f9d 16
klauss 0:4d17cd9c8f9d 17 if( num == 0 ){
klauss 0:4d17cd9c8f9d 18 str[i++] = '0';
klauss 0:4d17cd9c8f9d 19 str[i] = '\0';
klauss 0:4d17cd9c8f9d 20 return str;
klauss 0:4d17cd9c8f9d 21 }
klauss 0:4d17cd9c8f9d 22 if( num < 0 && base == 10 ){
klauss 0:4d17cd9c8f9d 23 isNegative = true;
klauss 0:4d17cd9c8f9d 24 num = -num;
klauss 0:4d17cd9c8f9d 25 }
klauss 0:4d17cd9c8f9d 26 while( num != 0 ){
klauss 0:4d17cd9c8f9d 27 int rem = num % base;
klauss 0:4d17cd9c8f9d 28 str[i++] = (rem > 9)? (rem-10) + 'a' : rem + '0';
klauss 0:4d17cd9c8f9d 29 num = num/base;
klauss 0:4d17cd9c8f9d 30 }
klauss 0:4d17cd9c8f9d 31 if( isNegative )
klauss 0:4d17cd9c8f9d 32 str[i++] = '-';
klauss 0:4d17cd9c8f9d 33
klauss 0:4d17cd9c8f9d 34 str[i] = '\0'; // Append string terminator
klauss 0:4d17cd9c8f9d 35
klauss 0:4d17cd9c8f9d 36 reverse( str, i );
klauss 0:4d17cd9c8f9d 37 return( str );
klauss 0:4d17cd9c8f9d 38 }
klauss 0:4d17cd9c8f9d 39
klauss 0:4d17cd9c8f9d 40 void reset_leds( void ){
klauss 0:4d17cd9c8f9d 41 led1 = led2 = 1;
klauss 0:4d17cd9c8f9d 42 led3 = led4 = 0;
klauss 0:4d17cd9c8f9d 43 }
klauss 0:4d17cd9c8f9d 44
klauss 8:e3bfe62a477e 45 int __init_eth__( EthernetInterface * eth ){
klauss 44:cc4996469404 46 static bool initialized = false;
klauss 27:98f824719d1c 47 char buff_ip[ 16 ];
klauss 27:98f824719d1c 48 char buff_msk[ 16 ];
klauss 27:98f824719d1c 49 char buff_gtw[ 16 ];
klauss 28:94aec56c6329 50 pc.printf("\n\r");
klauss 27:98f824719d1c 51 FILE *fp = fopen( "/qspi/myip.txt", "r");
klauss 27:98f824719d1c 52 if( fp == NULL ){
klauss 31:bb5fb28a77df 53 if( debug_file ) debug_msg("Failed to open /qspi/myip.txt" );
klauss 27:98f824719d1c 54 strncpy( buff_ip, __MY_IP__, 20 );
klauss 27:98f824719d1c 55 }else{
klauss 46:a670f187a704 56 int read = fread( buff_ip, 1, 512, fp );
klauss 46:a670f187a704 57 if( read > 0 ){
klauss 46:a670f187a704 58 for( int i = 0; i < read; i++ )
klauss 46:a670f187a704 59 if( buff_ip[ i ] == '\n' || buff_ip[ i ] == '\r' ){
klauss 46:a670f187a704 60 buff_ip[ i ] = '\0';
klauss 46:a670f187a704 61 break;
klauss 46:a670f187a704 62 }
klauss 31:bb5fb28a77df 63 if( debug_file ) debug_msg("Eth ip %s", buff_ip );
klauss 27:98f824719d1c 64 }else{
klauss 31:bb5fb28a77df 65 if( debug_file ) if( debug_file ) debug_msg("Failed to read /qspi/myip.txt" );
klauss 27:98f824719d1c 66 strncpy( buff_ip, __MY_IP__, 20 );
klauss 27:98f824719d1c 67 }
klauss 27:98f824719d1c 68 }
klauss 27:98f824719d1c 69 fclose( fp );
klauss 27:98f824719d1c 70 buff_ip[ 15 ] = 0;
klauss 44:cc4996469404 71
klauss 27:98f824719d1c 72 fp = fopen( "/qspi/mymask.txt", "r");
klauss 27:98f824719d1c 73 if( fp == NULL ){
klauss 31:bb5fb28a77df 74 if( debug_file ) debug_msg("Failed to open /qspi/mymask.txt" );
klauss 28:94aec56c6329 75 strncpy( buff_msk, __MY_MSK__, 20 );
klauss 27:98f824719d1c 76 }else{
klauss 46:a670f187a704 77 int read = fread( buff_msk, 1, 512, fp );
klauss 46:a670f187a704 78 if( read > 0 ){
klauss 46:a670f187a704 79 for( int i = 0; i < read; i++ )
klauss 46:a670f187a704 80 if( buff_msk[ i ] == '\n' || buff_msk[ i ] == '\r' ){
klauss 46:a670f187a704 81 buff_msk[ i ] = '\0';
klauss 46:a670f187a704 82 break;
klauss 46:a670f187a704 83 }
klauss 31:bb5fb28a77df 84 if( debug_file ) debug_msg("mascara de rede Eth %s", buff_msk );
klauss 27:98f824719d1c 85 }else{
klauss 31:bb5fb28a77df 86 if( debug_file ) debug_msg("Failed to read /qspi/mymask.txt" );
klauss 28:94aec56c6329 87 strncpy( buff_msk, __MY_MSK__, 20 );
klauss 27:98f824719d1c 88 }
klauss 27:98f824719d1c 89 }
klauss 27:98f824719d1c 90 fclose( fp );
klauss 27:98f824719d1c 91 buff_msk[ 15 ] = 0;
klauss 27:98f824719d1c 92
klauss 27:98f824719d1c 93 fp = fopen( "/qspi/mygate.txt", "r");
klauss 27:98f824719d1c 94 if( fp == NULL ){
klauss 31:bb5fb28a77df 95 if( debug_file ) debug_msg("Failed to open /qspi/mygate.txt" );
klauss 28:94aec56c6329 96 strncpy( buff_gtw, __MY_GTW__, 20 );
klauss 27:98f824719d1c 97 }else{
klauss 46:a670f187a704 98 int read = fread( buff_gtw, 1, 512, fp );
klauss 46:a670f187a704 99 if( read > 0 ){
klauss 46:a670f187a704 100 for( int i = 0; i < read; i++ )
klauss 46:a670f187a704 101 if( buff_gtw[ i ] == '\n' || buff_gtw[ i ] == '\r' ){
klauss 46:a670f187a704 102 buff_gtw[ i ] = '\0';
klauss 46:a670f187a704 103 break;
klauss 46:a670f187a704 104 }
klauss 31:bb5fb28a77df 105 if( debug_file ) debug_msg("Ip Gateway Eth %s", buff_gtw );
klauss 27:98f824719d1c 106 }else{
klauss 31:bb5fb28a77df 107 if( debug_file ) debug_msg("Failed to read /qspi/mygate.txt" );
klauss 28:94aec56c6329 108 strncpy( buff_gtw, __MY_GTW__, 20 );
klauss 27:98f824719d1c 109 }
klauss 27:98f824719d1c 110 }
klauss 27:98f824719d1c 111 fclose( fp );
klauss 27:98f824719d1c 112 buff_gtw[ 15 ] = 0;
klauss 46:a670f187a704 113
klauss 44:cc4996469404 114 if( !initialized ){
klauss 44:cc4996469404 115 eth->init( buff_ip, buff_msk, buff_gtw );
klauss 46:a670f187a704 116 //eth->init( __MY_IP__, __MY_MSK__, __MY_GTW__ );
klauss 44:cc4996469404 117 initialized = true;
klauss 44:cc4996469404 118 }
klauss 8:e3bfe62a477e 119 return eth->connect();
klauss 0:4d17cd9c8f9d 120 }
klauss 0:4d17cd9c8f9d 121
klauss 0:4d17cd9c8f9d 122 Call_Box * __find_CB__( Vector * v_cb, int ext ){
klauss 0:4d17cd9c8f9d 123 Call_Box * cb = NULL;
klauss 0:4d17cd9c8f9d 124 for( register int i = 0; i < v_cb->size(); i++ ){
klauss 0:4d17cd9c8f9d 125 cb = ( Call_Box * )v_cb->get_element( i );
klauss 0:4d17cd9c8f9d 126 if( cb->get_ext() == ext ) return( cb );
klauss 0:4d17cd9c8f9d 127 }
klauss 0:4d17cd9c8f9d 128 return( NULL );
klauss 0:4d17cd9c8f9d 129 }
klauss 0:4d17cd9c8f9d 130
klauss 0:4d17cd9c8f9d 131 VZ_call * __find_Call__( Vector * v_call, int ext ){
klauss 0:4d17cd9c8f9d 132 VZ_call * call = NULL;
klauss 0:4d17cd9c8f9d 133 for( register int i = 0; i < v_call->size(); i++ ){
klauss 0:4d17cd9c8f9d 134 call = ( VZ_call * )v_call->get_element( i );
klauss 0:4d17cd9c8f9d 135 if( call->get_cb_ext() == ext ) return( call );
klauss 0:4d17cd9c8f9d 136 }
klauss 0:4d17cd9c8f9d 137 return( NULL );
klauss 0:4d17cd9c8f9d 138 }
klauss 0:4d17cd9c8f9d 139
klauss 0:4d17cd9c8f9d 140 void registry_aging( Vector * v_cb, uint8_t * data, uint8_t * write_buffer ){
klauss 7:019b08223b87 141 Call_Box * cb = NULL;
klauss 7:019b08223b87 142 if( v_cb && data && write_buffer ){
klauss 7:019b08223b87 143 for( register int i = 0; i < v_cb->size(); i++ ){
klauss 7:019b08223b87 144 cb = (Call_Box * )v_cb->get_element( i );
klauss 7:019b08223b87 145 if( cb->is_timeout() ){
klauss 7:019b08223b87 146 if( cb->reconfigure_timeout() == 0x00 ){
klauss 30:8dfb6d8de53d 147 if( debug_alive ) debug_msg("( ext %d removed )", cb->get_ext() );
klauss 32:43041f5e27c4 148 //cb->unregistry();
klauss 30:8dfb6d8de53d 149 v_cb->remove_element( i );
klauss 30:8dfb6d8de53d 150 delete( cb );
klauss 7:019b08223b87 151 break;
klauss 7:019b08223b87 152 }else{
klauss 31:bb5fb28a77df 153 if( debug_alive ) debug_msg("Ping Cbx %d", cb->get_ext() );
klauss 28:94aec56c6329 154 cb->set_msg_id( ( ( cb->get_msg_id() ) + 1 ) & ( BIT7 ^ 0xff ) );
klauss 7:019b08223b87 155 __send_to_cb__( __build_cb_package__( cb->get_ext(), cb->get_port(), __REGISTRY__,
klauss 7:019b08223b87 156 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 7:019b08223b87 157 cb->registry();
klauss 7:019b08223b87 158 }
klauss 7:019b08223b87 159 }
klauss 7:019b08223b87 160 }
klauss 7:019b08223b87 161 }
klauss 0:4d17cd9c8f9d 162 }
klauss 0:4d17cd9c8f9d 163
klauss 0:4d17cd9c8f9d 164 int sip_manager( Vector * v_cb, Vector * v_call, uint8_t * write_buffer ){
klauss 0:4d17cd9c8f9d 165 static int index = 0;
klauss 0:4d17cd9c8f9d 166 if( v_cb && write_buffer ){
klauss 0:4d17cd9c8f9d 167 if( v_cb->size() > 0 ){
klauss 0:4d17cd9c8f9d 168 if( index >= v_cb->size() ) index = 0;
klauss 0:4d17cd9c8f9d 169 }else return 0;
klauss 0:4d17cd9c8f9d 170 Call_Box * cb = (Call_Box * )v_cb->get_element( index );
klauss 0:4d17cd9c8f9d 171 /* Retorna
klauss 0:4d17cd9c8f9d 172 = 0 :: ok
klauss 0:4d17cd9c8f9d 173 < 0 :: tive problemas
klauss 0:4d17cd9c8f9d 174 > 0 :: devo remover essa call do vetor de calls
klauss 0:4d17cd9c8f9d 175 */
klauss 0:4d17cd9c8f9d 176 int returned_value = 0;
klauss 13:ae278302dffe 177
klauss 14:22a35f575502 178 if( cb->status == cb_on_call || cb->status == cb_idle ){
klauss 15:9c7456c1b6f4 179 //debug_msg("");
klauss 14:22a35f575502 180 returned_value = cb->listen_SIP_server();
klauss 14:22a35f575502 181 }
klauss 0:4d17cd9c8f9d 182 index++;
klauss 0:4d17cd9c8f9d 183 return( returned_value );
klauss 0:4d17cd9c8f9d 184 }
klauss 0:4d17cd9c8f9d 185 led1 = !led1;
klauss 0:4d17cd9c8f9d 186 return( -1 );
klauss 0:4d17cd9c8f9d 187 }
klauss 0:4d17cd9c8f9d 188
klauss 0:4d17cd9c8f9d 189 /* remove calls por timeout */
klauss 0:4d17cd9c8f9d 190 void call_manager( Vector * v_call, Vector * v_cb, uint8_t * data, uint8_t * write_buffer, Timeslice * ts ){
klauss 0:4d17cd9c8f9d 191 for( register int i = 0; i < v_call->size(); i++ ){
klauss 0:4d17cd9c8f9d 192 VZ_call * call = ( VZ_call * )v_call->get_element( i );
klauss 29:7246460b73f8 193 if( call->is_timetofinish() ){
klauss 0:4d17cd9c8f9d 194 v_call->remove_element( i );
klauss 0:4d17cd9c8f9d 195 Call_Box * cb = __find_CB__( v_cb, call->get_cb_ext() );
klauss 0:4d17cd9c8f9d 196 if( cb ){
klauss 0:4d17cd9c8f9d 197 cb->status = cb_idle;
klauss 0:4d17cd9c8f9d 198 ts->return_timeslice( cb->get_timeslice() );
klauss 0:4d17cd9c8f9d 199 cb->set_timeslice( 0x00 );
klauss 0:4d17cd9c8f9d 200 data[ __TIMESLICE_PLACE__ ] = 0x00;
klauss 0:4d17cd9c8f9d 201 cb->set_msg_id( ( ( cb->get_msg_id() ) + 1 ) & ( BIT7 ^ 0xff ) );
klauss 0:4d17cd9c8f9d 202 __send_to_cb__( __build_cb_package__( cb->get_ext(), cb->get_port(), __CB_BYE__,
klauss 0:4d17cd9c8f9d 203 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 0:4d17cd9c8f9d 204 cb->send_bye();
klauss 13:ae278302dffe 205 set_status( cb->sip->status, sip_idle );
klauss 29:7246460b73f8 206 cb->re_start_timer();
klauss 0:4d17cd9c8f9d 207 }
klauss 9:ffa64f38ef9c 208 delete( call );
klauss 0:4d17cd9c8f9d 209 }
klauss 0:4d17cd9c8f9d 210 }
klauss 0:4d17cd9c8f9d 211 }
klauss 0:4d17cd9c8f9d 212
klauss 0:4d17cd9c8f9d 213 void build_telemetry_report( int ext, int port, char * data ){
klauss 36:728498a78e1e 214 pc.printf("Telemetry pkg from ( %i, %i ) ::\n\r", ext, port );
klauss 31:bb5fb28a77df 215 for( register int i = 0; i < __TELEMETRY_SIZE__; i++ )
klauss 31:bb5fb28a77df 216 pc.printf("%3i ", data[ i ] );
klauss 31:bb5fb28a77df 217 pc.printf("\n\r");
klauss 0:4d17cd9c8f9d 218 }
klauss 0:4d17cd9c8f9d 219
klauss 0:4d17cd9c8f9d 220 void __send_to_cb__( uint8_t * buffer ){
klauss 0:4d17cd9c8f9d 221 xmemcpy( TXBuffer, buffer, DATA_SIZE );
klauss 0:4d17cd9c8f9d 222 send2callboxes();
klauss 0:4d17cd9c8f9d 223 }