VZTECH / Mbed 2 deprecated header_main_colinas_V0

voltando a versao de n aberturas e fechamentos de sockets data 19/09

Dependencies:   EthernetInterface NTPClient mbed-rtos mbed EALib

Fork of header_main_publish by VZTECH

utils.cpp@17:67a6b557eda5, 2014-09-19 (annotated)

Committer:
klauss
Date:
Fri Sep 19 16:40:17 2014 +0000
Revision:
17:67a6b557eda5
Parent:
16:b45b5b7363d7
Child:
18:01a93677e40c
versao em teste de wdt, filesystem, callme

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 15:9c7456c1b6f4 45 //eth->init( __MY_IP__, "255.255.255.0", "192.168.120.1" );
klauss 17:67a6b557eda5 46 //eth->init( "192.168.2.200", "255.255.255.0", "192.168.2.254" );
klauss 17:67a6b557eda5 47 eth->init( __MY_IP__, __MY_MK__, __MY_GW__ );
klauss 15:9c7456c1b6f4 48
klauss 15:9c7456c1b6f4 49 /*
klauss 15:9c7456c1b6f4 50 #ifdef debug_colinas
klauss 15:9c7456c1b6f4 51 #define __MY_IP__ "192.168.2.200"
klauss 15:9c7456c1b6f4 52 #define __MY_GT__ "192.168.2.254"
klauss 15:9c7456c1b6f4 53 #endif
klauss 15:9c7456c1b6f4 54 #ifndef debug_colinas
klauss 15:9c7456c1b6f4 55 #define __MY_IP__ "192.168.120.169"
klauss 15:9c7456c1b6f4 56 #define __MY_GT__ "192.168.120.1"
klauss 15:9c7456c1b6f4 57 #endif
klauss 15:9c7456c1b6f4 58
klauss 15:9c7456c1b6f4 59 #define __MY_MK__ "255.255.255.0"
klauss 15:9c7456c1b6f4 60 */
klauss 8:e3bfe62a477e 61 return eth->connect();
klauss 0:4d17cd9c8f9d 62 // pensar em o que acontece e como sinalizar que nao consegui conectar na web
klauss 0:4d17cd9c8f9d 63 // aparente so da time out, so que algo vai travar quando eu tentar usar a conexao
klauss 0:4d17cd9c8f9d 64 }
klauss 0:4d17cd9c8f9d 65
klauss 0:4d17cd9c8f9d 66 Call_Box * __find_CB__( Vector * v_cb, int ext ){
klauss 0:4d17cd9c8f9d 67 Call_Box * cb = NULL;
klauss 0:4d17cd9c8f9d 68 for( register int i = 0; i < v_cb->size(); i++ ){
klauss 0:4d17cd9c8f9d 69 cb = ( Call_Box * )v_cb->get_element( i );
klauss 0:4d17cd9c8f9d 70 if( cb->get_ext() == ext ) return( cb );
klauss 0:4d17cd9c8f9d 71 }
klauss 0:4d17cd9c8f9d 72 return( NULL );
klauss 0:4d17cd9c8f9d 73 }
klauss 0:4d17cd9c8f9d 74
klauss 0:4d17cd9c8f9d 75 VZ_call * __find_Call__( Vector * v_call, int ext ){
klauss 0:4d17cd9c8f9d 76 VZ_call * call = NULL;
klauss 0:4d17cd9c8f9d 77 for( register int i = 0; i < v_call->size(); i++ ){
klauss 0:4d17cd9c8f9d 78 call = ( VZ_call * )v_call->get_element( i );
klauss 0:4d17cd9c8f9d 79 if( call->get_cb_ext() == ext ) return( call );
klauss 0:4d17cd9c8f9d 80 }
klauss 0:4d17cd9c8f9d 81 return( NULL );
klauss 0:4d17cd9c8f9d 82 }
klauss 0:4d17cd9c8f9d 83
klauss 0:4d17cd9c8f9d 84 void registry_aging( Vector * v_cb, uint8_t * data, uint8_t * write_buffer ){
klauss 7:019b08223b87 85 Call_Box * cb = NULL;
klauss 7:019b08223b87 86 if( v_cb && data && write_buffer ){
klauss 7:019b08223b87 87 for( register int i = 0; i < v_cb->size(); i++ ){
klauss 7:019b08223b87 88 cb = (Call_Box * )v_cb->get_element( i );
klauss 7:019b08223b87 89 if( cb->is_timeout() ){
klauss 7:019b08223b87 90 if( cb->reconfigure_timeout() == 0x00 ){
klauss 15:9c7456c1b6f4 91 // debug_msg("( ext %d removed", cb->get_ext() );
klauss 9:ffa64f38ef9c 92 //cb->unregistry();
klauss 9:ffa64f38ef9c 93 //v_cb->remove_element( i );
klauss 9:ffa64f38ef9c 94 //delete( cb );
klauss 7:019b08223b87 95 break;
klauss 7:019b08223b87 96 }else{
klauss 15:9c7456c1b6f4 97 // debug_msg("Ping on %d", cb->get_ext() );
klauss 14:22a35f575502 98
klauss 7:019b08223b87 99 cb->set_msg_id( ( ( cb->get_msg_id() ) + 1 ) & ( BIT7 ^ 0xff ) );
klauss 14:22a35f575502 100
klauss 14:22a35f575502 101 debug_msg("");
klauss 14:22a35f575502 102
klauss 7:019b08223b87 103 __send_to_cb__( __build_cb_package__( cb->get_ext(), cb->get_port(), __REGISTRY__,
klauss 7:019b08223b87 104 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 14:22a35f575502 105
klauss 14:22a35f575502 106 debug_msg("");
klauss 14:22a35f575502 107
klauss 7:019b08223b87 108 cb->registry();
klauss 14:22a35f575502 109
klauss 14:22a35f575502 110 debug_msg("");
klauss 7:019b08223b87 111 }
klauss 7:019b08223b87 112 }
klauss 7:019b08223b87 113 }
klauss 7:019b08223b87 114 }
klauss 4:de46f0d9b14d 115 /*
klauss 0:4d17cd9c8f9d 116 Call_Box * cb = NULL;
klauss 4:de46f0d9b14d 117 if( v_cb && data && write_buffer ){
klauss 4:de46f0d9b14d 118 bool remove_slave = false;
klauss 4:de46f0d9b14d 119 int slave = 0x00;
klauss 4:de46f0d9b14d 120 int tam = v_cb->size();
klauss 4:de46f0d9b14d 121 for( register int i = 0; i < v_cb->size(); i++ ){
klauss 3:cd9148672e25 122 cb = (Call_Box * )v_cb->get_element( i );
klauss 4:de46f0d9b14d 123 if( cb->get_ext() % 2 ) continue;
klauss 3:cd9148672e25 124 if( cb->is_timeout() ){
klauss 3:cd9148672e25 125 if( cb->reconfigure_timeout() == 0x00 ){
klauss 4:de46f0d9b14d 126 debug_msg("( ext %d removed", cb->get_ext() );
klauss 4:de46f0d9b14d 127 cb->unregistry();
klauss 4:de46f0d9b14d 128 slave = cb->get_ext() + 1;
klauss 4:de46f0d9b14d 129 remove_slave = true;
klauss 3:cd9148672e25 130 v_cb->remove_element( i );
klauss 3:cd9148672e25 131 delete( cb );
klauss 4:de46f0d9b14d 132 break;
klauss 3:cd9148672e25 133 }else{
klauss 3:cd9148672e25 134 cb->set_msg_id( ( ( cb->get_msg_id() ) + 1 ) & ( BIT7 ^ 0xff ) );
klauss 3:cd9148672e25 135 __send_to_cb__( __build_cb_package__( cb->get_ext(), cb->get_port(), __REGISTRY__,
klauss 3:cd9148672e25 136 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 3:cd9148672e25 137 cb->registry();
klauss 3:cd9148672e25 138 }
klauss 2:93bec7313ccc 139 }
klauss 0:4d17cd9c8f9d 140 }
klauss 4:de46f0d9b14d 141 if( remove_slave ){
klauss 4:de46f0d9b14d 142 for( register int i = 0; i < v_cb->size(); i++ ){
klauss 4:de46f0d9b14d 143 cb = (Call_Box * )v_cb->get_element( i );
klauss 4:de46f0d9b14d 144 if( cb->get_ext() == slave ){
klauss 4:de46f0d9b14d 145 debug_msg("( ext %d removed", cb->get_ext() );
klauss 4:de46f0d9b14d 146 cb->unregistry();
klauss 4:de46f0d9b14d 147 v_cb->remove_element( i );
klauss 4:de46f0d9b14d 148 delete( cb );
klauss 4:de46f0d9b14d 149 }
klauss 4:de46f0d9b14d 150 }
klauss 4:de46f0d9b14d 151 }
klauss 4:de46f0d9b14d 152 if( tam != v_cb->size() ) debug_msg("%d ---> %d", tam, v_cb->size() );
klauss 0:4d17cd9c8f9d 153 }
klauss 4:de46f0d9b14d 154 */
klauss 15:9c7456c1b6f4 155 //debug_msg("");
klauss 0:4d17cd9c8f9d 156 }
klauss 0:4d17cd9c8f9d 157
klauss 0:4d17cd9c8f9d 158 int sip_manager( Vector * v_cb, Vector * v_call, uint8_t * write_buffer ){
klauss 0:4d17cd9c8f9d 159 static int index = 0;
klauss 15:9c7456c1b6f4 160 //debug_msg("");
klauss 0:4d17cd9c8f9d 161 if( v_cb && write_buffer ){
klauss 0:4d17cd9c8f9d 162 if( v_cb->size() > 0 ){
klauss 15:9c7456c1b6f4 163 //debug_msg("");
klauss 0:4d17cd9c8f9d 164 if( index >= v_cb->size() ) index = 0;
klauss 0:4d17cd9c8f9d 165 }else return 0;
klauss 0:4d17cd9c8f9d 166 Call_Box * cb = (Call_Box * )v_cb->get_element( index );
klauss 0:4d17cd9c8f9d 167 /* Retorna
klauss 0:4d17cd9c8f9d 168 = 0 :: ok
klauss 0:4d17cd9c8f9d 169 < 0 :: tive problemas
klauss 0:4d17cd9c8f9d 170 > 0 :: devo remover essa call do vetor de calls
klauss 0:4d17cd9c8f9d 171 */
klauss 0:4d17cd9c8f9d 172 int returned_value = 0;
klauss 13:ae278302dffe 173
klauss 14:22a35f575502 174 if( cb->status == cb_on_call || cb->status == cb_idle ){
klauss 15:9c7456c1b6f4 175 //debug_msg("");
klauss 14:22a35f575502 176 returned_value = cb->listen_SIP_server();
klauss 14:22a35f575502 177 }
klauss 0:4d17cd9c8f9d 178 index++;
klauss 0:4d17cd9c8f9d 179 return( returned_value );
klauss 0:4d17cd9c8f9d 180 }
klauss 0:4d17cd9c8f9d 181 led1 = !led1;
klauss 0:4d17cd9c8f9d 182 return( -1 );
klauss 0:4d17cd9c8f9d 183 }
klauss 0:4d17cd9c8f9d 184
klauss 0:4d17cd9c8f9d 185 /* remove calls por timeout */
klauss 0:4d17cd9c8f9d 186 void call_manager( Vector * v_call, Vector * v_cb, uint8_t * data, uint8_t * write_buffer, Timeslice * ts ){
klauss 0:4d17cd9c8f9d 187 for( register int i = 0; i < v_call->size(); i++ ){
klauss 0:4d17cd9c8f9d 188 VZ_call * call = ( VZ_call * )v_call->get_element( i );
klauss 0:4d17cd9c8f9d 189 if( call->is_timeout() || call->is_timetofinish() ){
klauss 0:4d17cd9c8f9d 190 v_call->remove_element( i );
klauss 0:4d17cd9c8f9d 191 Call_Box * cb = __find_CB__( v_cb, call->get_cb_ext() );
klauss 0:4d17cd9c8f9d 192 if( cb ){
klauss 0:4d17cd9c8f9d 193 cb->status = cb_idle;
klauss 0:4d17cd9c8f9d 194 ts->return_timeslice( cb->get_timeslice() );
klauss 0:4d17cd9c8f9d 195 cb->set_timeslice( 0x00 );
klauss 0:4d17cd9c8f9d 196 data[ __TIMESLICE_PLACE__ ] = 0x00;
klauss 0:4d17cd9c8f9d 197 cb->set_msg_id( ( ( cb->get_msg_id() ) + 1 ) & ( BIT7 ^ 0xff ) );
klauss 0:4d17cd9c8f9d 198 __send_to_cb__( __build_cb_package__( cb->get_ext(), cb->get_port(), __CB_BYE__,
klauss 0:4d17cd9c8f9d 199 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 0:4d17cd9c8f9d 200 cb->send_bye();
klauss 13:ae278302dffe 201 set_status( cb->sip->status, sip_idle );
klauss 0:4d17cd9c8f9d 202 }
klauss 9:ffa64f38ef9c 203 delete( call );
klauss 0:4d17cd9c8f9d 204 }
klauss 0:4d17cd9c8f9d 205 }
klauss 0:4d17cd9c8f9d 206 }
klauss 0:4d17cd9c8f9d 207
klauss 0:4d17cd9c8f9d 208 void build_telemetry_report( int ext, int port, char * data ){
klauss 0:4d17cd9c8f9d 209 // construir o pacote de telemetria aqui
klauss 0:4d17cd9c8f9d 210 // decidir se isso sera escrito em disco e de tempos em tempos enviado para o servidor ...
klauss 0:4d17cd9c8f9d 211 // ou se sera enviado toda vez que determinado cb se registrar ...
klauss 0:4d17cd9c8f9d 212 }
klauss 0:4d17cd9c8f9d 213
klauss 0:4d17cd9c8f9d 214 void __send_to_cb__( uint8_t * buffer ){
klauss 0:4d17cd9c8f9d 215 xmemcpy( TXBuffer, buffer, DATA_SIZE );
klauss 0:4d17cd9c8f9d 216 send2callboxes();
klauss 0:4d17cd9c8f9d 217 }