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@27:98f824719d1c, 2014-09-22 (annotated)

Committer:
klauss
Date:
Mon Sep 22 21:15:07 2014 +0000
Revision:
27:98f824719d1c
Parent:
20:2d6ab23956e5
Child:
28:94aec56c6329
- header ip | port setable by prompt

Who changed what in which revision?

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