VZTECH
/
header_main
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: EthernetInterface NTPClient mbed-rtos mbed
Embed:
(wiki syntax)
Show/hide line numbers
main.cpp
00001 #include "bits.h" 00002 #include "utils.h" 00003 #include "configs.h" 00004 #include "UART3Interrupt.h" 00005 #include "parallelcpld.h" 00006 00007 #include "debug.h" 00008 #include "utils.h" 00009 00010 // for aditional debugs 00011 #define on_work 00012 00013 /* 00014 #define set_status(a,b) _set_status(a,b) 00015 #define _set_status(a,b) { \ 00016 a = b; \ 00017 sprintf( debug_msg, "-- State == %d -- Line %d", a, __LINE__ ); \ 00018 debug.sendTo( debug_server, debug_msg, strlen( debug_msg ) ); \ 00019 } 00020 #define whereami() _whereami() 00021 #define _whereami() { \ 00022 sprintf( debug_msg, "-- whereami %d", __LINE__ ); \ 00023 debug.sendTo( debug_server, debug_msg, strlen( debug_msg ) ); \ 00024 } 00025 */ 00026 volatile uint8_t status = 0x00; 00027 00028 bool debug_bool = true; 00029 00030 int main(){ 00031 start_cpld(); 00032 config_lpc(); 00033 00034 /* referencia e inicio da conexao com a ethernet */ 00035 EthernetInterface eth; 00036 __init_eth__( ð ); 00037 00038 /* debugs */ 00039 debug_server.set_address( "192.168.120.144", 9897 ); 00040 debug.bind( 72133 ); 00041 debug.init(); 00042 00043 Timer t; 00044 Timer reboot; 00045 t.start(); 00046 00047 /* representa ramal do call box */ 00048 int ext = 0; 00049 00050 /* representa porta do call box */ 00051 int port = 0; 00052 00053 /* buffer para onde se copia os dados vindos do cb para tratameno interno */ 00054 uint8_t buffer[ __CB_BUFFER_SIZE__ ]; 00055 00056 /* buffer de escrita do pacote de saida que sera enviado pro cb / servidor */ 00057 uint8_t write_buffer[ __CB_BUFFER_SIZE__ ]; 00058 00059 /* ponteiro que aponta para os dados vindo do CPLD */ 00060 uint8_t * buffer_from_cb_ptr = ( uint8_t * )RXBuffer; 00061 00062 /* referencia para os dados contidos no pacote, sem o header */ 00063 uint8_t * data = NULL; 00064 00065 /* gerencia o tipo do pacote para providenciar tratamento adequado */ 00066 volatile uint8_t type = __DO_NOTHING__; 00067 00068 /* representa a lista dos Call Boxes atualmente reconhecidos pela cabeceira */ 00069 Vector * v_cb = new Vector(); 00070 00071 /* representa a lista de ligacoes ativas na cabeceira */ 00072 Vector * v_call = new Vector(); 00073 00074 /* gerencia a distribuicao de timeslice para os call boxes */ 00075 Timeslice * ts = new Timeslice(); 00076 00077 /* tenta instanciar o vetor de call boxes, acende o led 1 antes de encerrar o programa */ 00078 reset_leds(); 00079 if( v_cb == NULL ){ 00080 led1 = 0; 00081 while( v_cb == NULL ){ 00082 Vector * v_cb = new Vector(); 00083 led1 = led1; 00084 if( t.read() > 5 ){ 00085 debug_msg("Erro ao alocar o vetor de CBx"); 00086 t.reset(); 00087 } 00088 } 00089 }else if( v_call == NULL ){ 00090 led2 = 0; 00091 led1 = 1; 00092 while( v_call == NULL ){ 00093 Vector * v_call = new Vector(); 00094 led1 = led1; 00095 if( t.read() > 5 ){ 00096 debug_msg("Erro ao alocar o vetor de Calls"); 00097 t.reset(); 00098 } 00099 } 00100 } 00101 reset_leds(); 00102 reboot.start(); 00103 debug_msg( " Ready " ); 00104 /* 00105 char test_buffer[400]; 00106 UDPSocket test_sock; 00107 Endpoint test_server; 00108 test_server.set_address( "192.168.120.144" , 12345 ); 00109 test_sock.set_blocking( false, 1 ); 00110 test_sock.bind( 78965 ); 00111 test_sock.init(); 00112 int n = 0; 00113 strcpy( test_buffer, "a"); 00114 test_sock.sendTo( test_server, test_buffer, sizeof( test_buffer ) ); 00115 Timer reconnect; 00116 reconnect.start(); 00117 */ 00118 while( true ){ 00119 /* 00120 n = test_sock.receiveFrom( test_server, test_buffer, sizeof( test_buffer ) ); 00121 if( n > 0 ){ 00122 test_sock.sendTo( test_server, test_buffer, n ); 00123 reconnect.reset(); 00124 }else if( reconnect.read() > 1 ){ 00125 test_sock.close(); 00126 test_sock.bind( 78965 ); 00127 test_sock.init(); 00128 reconnect.reset(); 00129 test_sock.sendTo( test_server, test_buffer, n ); 00130 led4 = !led4; 00131 }*/ 00132 if( status != __WAITING__ ){ 00133 __read_cb_buffer__( buffer, buffer_from_cb_ptr ); 00134 status = __WAITING__; 00135 00136 data = __parse_cb_buffer__( &ext, &port, &type, buffer ); 00137 00138 if( data != NULL ){ 00139 00140 if( type == __CB_BYE__ ){ 00141 debug_msg("--> %s <--", buffer); 00142 } 00143 if( type != __AUDIO__ ){ 00144 Call_Box * cb = __find_CB__( v_cb, ext ); 00145 if( cb != NULL ){ 00146 if( ( data[ 0 ] ^ cb->get_msg_id() ) == BIT7 ){ 00147 // some pkg reply 00148 if( ( data[ 0 ] | BIT7 ) == cb->get_msg_id() ){ 00149 if( type == __BOOT__ ) type = __REGISTRY__; 00150 __send_to_cb__( __build_cb_package__( ext, port, type, 00151 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00152 type = __DO_NOTHING__; 00153 debug_msg("-- Renviado ultimo pkg --"); 00154 }else if( data[ 0 ] == ( cb->get_msg_id() | BIT7 ) ){ 00155 // ack from CBx 00156 type = __DO_NOTHING__; 00157 debug_msg("-- ACK do meu pkg --"); 00158 } 00159 } 00160 } 00161 } 00162 }else type = __DO_NOTHING__; 00163 /* 00164 if( data == NULL ) type = __DO_NOTHING__; 00165 */ 00166 } 00167 //---------------------- 00168 if( t.read() > 5 ){ 00169 for( register uint8_t i = 0; i < v_cb->size(); i++ ){ 00170 Call_Box * cb = ( Call_Box * )v_cb->get_element( i ); 00171 debug_msg(" Type :: %d -- Ext :: %d -- TimeSlice :: %d -- remain_timeslices :: %d :: v_call->size() :: %d :: Status :: %d :: SIP Status %d", type , cb->get_ext(), cb->get_timeslice(), ts->remain_timeslices(), v_call->size(), cb->status, cb->sip->status ); 00172 } 00173 t.reset(); 00174 led3 = !led3; 00175 } 00176 if( reboot.read() > 180 ){ 00177 for( register uint8_t i = 0; i < v_cb->size(); i++ ){ 00178 Call_Box * cb = ( Call_Box * )v_cb->get_element( i ); 00179 cb->set_timeslice( 0x00 ); 00180 set_status(cb->status,cb_idle); 00181 set_status( cb->sip->status, sip_idle ); 00182 debug_msg( "Erased >> Type :: %d -- Ext :: %d -- TimeSlice :: %d -- remain_timeslices :: %d :: v_call->size() :: %d :: Status :: %d", type , cb->get_ext(), cb->get_timeslice(), ts->remain_timeslices(), v_call->size(), cb->status ); 00183 } 00184 for( register uint8_t i = 0; i < v_call->size(); i++ ){ 00185 VZ_call * call = ( VZ_call * )v_call->get_element( i ); 00186 v_call->remove_element( i ); 00187 delete( call ); 00188 } 00189 reboot.reset(); 00190 led4 = !led4; 00191 } 00192 //---------------------- 00193 switch( type ){ 00194 case __DO_NOTHING__ :{} 00195 break; 00196 00197 case __CB_BYE__ : { 00198 Call_Box * cb = __find_CB__( v_cb, ext ); 00199 if( cb != NULL ){ 00200 data[ 0 ] |= BIT7; 00201 cb->set_msg_id( data[ 0 ] ); 00202 debug_msg( " Request bye from CBx " ); 00203 for( register uint8_t i = 0; i < v_call->size(); i++ ){ 00204 VZ_call * call = (VZ_call *)v_call->get_element( i ); 00205 if( call->get_cb_ext() == ext ){ 00206 ts->return_timeslice( cb->get_timeslice() ); 00207 cb->set_timeslice( 0x00 ); 00208 set_status( cb->status, cb_idle ); 00209 v_call->remove_element( i ); 00210 cb->send_bye(); 00211 set_status( cb->sip->status, sip_idle); 00212 data[ __TIMESLICE_PLACE__ ] = 0x00; 00213 __send_to_cb__( __build_cb_package__( ext, port, __CB_BYE__, 00214 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00215 set_status( cb->sip->status, sip_idle ); 00216 } 00217 } 00218 } 00219 }break; 00220 00221 case __INVITE__ : { 00222 debug_msg("ok -- recebido o invite pelo menos"); 00223 #ifndef on_work 00224 // invite de uma ligacao em andamento ? 00225 Call_Box * cb = __find_CB__( v_cb, ext ); 00226 if( cb != NULL ){ 00227 cb->reset_elapsed_time(); 00228 if( cb->status == cb_on_call ){ 00229 VZ_call * vz = __find_Call__( v_call, cb->get_ext() ); 00230 if( vz != NULL ) break; 00231 ts->return_timeslice( cb->get_timeslice() ); 00232 cb->set_timeslice( 0x00 ); 00233 set_status(cb->status,cb_idle); 00234 } 00235 }else{ 00236 cb = new Call_Box( ext, port ); 00237 v_cb->add( cb ); 00238 } 00239 if( cb->status != cb_on_call ) set_status(cb->status,cb_ringing); 00240 if( data[ __TIMESLICE_PLACE__ ] == __CB_BYE__ ){ 00241 if( cb->status == cb_on_call ){ 00242 for( register uint8_t i = 0; i < v_call->size(); i++ ){ 00243 if( ( (VZ_call *)v_call->get_element( i ) )->get_cb_ext() == ext ){ 00244 v_call->remove_element( i ); 00245 ts->return_timeslice( cb->get_timeslice() ); 00246 cb->set_timeslice( 0x00 ); 00247 set_status(cb->status,cb_idle); 00248 cb->send_bye(); 00249 break; 00250 } 00251 } 00252 } 00253 } 00254 if( cb->status == cb_ringing ){ 00255 data[ 0 ] |= BIT7; 00256 cb->set_msg_id( data[ 0 ] ); 00257 cb->set_timeslice( ts->get_timeslice() ); 00258 if( cb->get_timeslice() == 0x00 ){ 00259 set_status(cb->status,cb_idle); 00260 data[ __CLOCK_SYNC_SIZE__ ] = 0x00; 00261 __send_to_cb__( __build_cb_package__( ext, port, __INVITE__, 00262 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00263 break; 00264 } 00265 if( cb->status == cb_ringing ){ 00266 data[ __CLOCK_SYNC_SIZE__ ] = cb->get_timeslice(); 00267 __send_to_cb__( __build_cb_package__( ext, port, __INVITE__, 00268 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00269 00270 VZ_call * call = cb->invite(); 00271 00272 if( call != NULL ){ 00273 v_call->add( call ); 00274 set_status(cb->status,cb_on_call); 00275 data[ __CLOCK_SYNC_SIZE__ ] = cb->get_timeslice(); 00276 __send_to_cb__( __build_cb_package__( ext, port, __INVITE__, 00277 ( char * )data, cb->get_msg_id()+1, __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00278 }else{ 00279 set_status(cb->status,cb_idle); 00280 ts->return_timeslice( cb->get_timeslice() ); 00281 data[ __CLOCK_SYNC_SIZE__ ] = 0x00; 00282 __send_to_cb__( __build_cb_package__( ext, port, __INVITE__, 00283 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00284 } 00285 } 00286 } 00287 }break; 00288 #endif 00289 #ifdef on_work 00290 Call_Box * cb = __find_CB__( v_cb, ext ); 00291 if( cb == NULL ){ 00292 cb = new Call_Box( ext, port ); 00293 v_cb->add( cb ); 00294 set_status( cb->status, cb_idle ); 00295 cb->registry(); 00296 } 00297 cb->reset_elapsed_time(); 00298 set_status( cb->status, cb_trying ); 00299 debug_msg(" Ok temos um cbx encontrado com status :: %d", cb->status ); 00300 switch( cb->status ){ 00301 case cb_on_call : { 00302 // a priori, nao fazer nada 00303 //data[ __TIMESLICE_PLACE__ ] = 0x00; 00304 //__send_to_cb__( __build_cb_package__( ext, port, __BYE__, 00305 // ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00306 }break; 00307 00308 case cb_ringing : { 00309 // tratar sip 2 00310 }break; 00311 00312 case cb_trying : { 00313 data[ 0 ] |= BIT7; 00314 cb->set_msg_id( data[ 0 ] ); 00315 cb->set_timeslice( ts->get_timeslice() ); 00316 if( cb->get_timeslice() == 0x00 ){ 00317 //sem timeslice pra tratar com o * 00318 set_status(cb->status,cb_idle); 00319 data[ __TIMESLICE_PLACE__ ] = 0x00; 00320 __send_to_cb__( __build_cb_package__( ext, port, __INVITE__, 00321 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00322 set_status( cb->sip->status, sip_idle); 00323 debug_msg( "-- Trying -- Sem TS -- %s ", write_buffer ); 00324 }else{ 00325 set_status(cb->status,cb_busy); 00326 data[ __TIMESLICE_PLACE__ ] = cb->get_timeslice(); 00327 __send_to_cb__( __build_cb_package__( ext, port, __INVITE__, 00328 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00329 00330 debug_msg(" -- %d on %d -- ", cb->get_ext(), data[ __TIMESLICE_PLACE__ ] ); 00331 00332 cb->set_msg_id( ( ( cb->get_msg_id() ) + 1 ) & ( BIT7 ^ 0xff ) ); 00333 VZ_call * call = cb->invite(); 00334 00335 if( call != NULL ){ 00336 v_call->add( call ); 00337 set_status(cb->status,cb_on_call); 00338 00339 debug_msg(" -- %d on %d -- ", cb->get_ext(), data[ __TIMESLICE_PLACE__ ] ); 00340 __send_to_cb__( __build_cb_package__( ext, port, __INVITE__, 00341 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00342 debug_msg( "-- Trying -- aceitando pedido de invite -- %s ", write_buffer ); 00343 //debug_pkg( 300, write_buffer ); 00344 }else{ 00345 set_status(cb->status,cb_idle); 00346 ts->return_timeslice( cb->get_timeslice() ); 00347 cb->set_timeslice( 0x00 ); 00348 data[ __TIMESLICE_PLACE__ ] = 0x00; 00349 debug_msg(" -- %d on %d -- ", cb->get_ext(), data[ __TIMESLICE_PLACE__ ] ); 00350 __send_to_cb__( __build_cb_package__( ext, port, __CB_BYE__, 00351 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00352 debug_msg( "-- Trying -- Negando pedido de invite -- %s ", write_buffer ); 00353 set_status( cb->sip->status, sip_idle); 00354 } 00355 } 00356 }break; 00357 00358 case cb_busy : { 00359 // tratar sip 00360 }break; 00361 } 00362 }break; 00363 #endif 00364 case __REGISTRY__ : 00365 { 00366 Call_Box * cb; 00367 data[ 0 ] |= BIT7; 00368 cb = __find_CB__( v_cb, ext ); 00369 if( cb != NULL ){ 00370 cb->reset_elapsed_time(); 00371 }else{ 00372 cb = new Call_Box( ext, port ); 00373 v_cb->add( cb ); 00374 } 00375 cb->registry(); 00376 }break; 00377 case __BOOT__ : 00378 __send_to_cb__( __build_cb_package__( ext, port, __REGISTRY__, 00379 ( char * )data, data[ 0 ], __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00380 break; 00381 case __TELEMETRY__ : 00382 debug_msg("Leitura da bateria :: ( Id : %x, MSB : %x, LSB : %x )", data[ 0 ], data[ 1 ], data[ 2 ] ); 00383 break; 00384 case __AUDIO__ : { 00385 Call_Box * cb; 00386 VZ_call * call = NULL; 00387 cb = NULL; 00388 call = __find_Call__( v_call, ext ); 00389 if( call != NULL ){ 00390 //debug_( 240, data ); 00391 //debug_pkg( 242, data ); 00392 //char * pkg = call->build_eth_package( oitocentos ); 00393 //char * pkg = call->build_eth_package( data ); 00394 char * pkg = call->build_eth_package( data + 2 ); 00395 call->send_message( pkg ); 00396 cb = __find_CB__( v_cb, ext ); 00397 if( cb != NULL ) cb->reset_elapsed_time(); 00398 } 00399 }break; 00400 }// fim switch 00401 for( register int i = 0; i < v_call->size(); i++ ){ 00402 VZ_call * call = ( VZ_call * )v_call->get_element( i ); 00403 int length = 0; 00404 char * tmp = call->get_eth_message( &length ); 00405 if( tmp != NULL ){ 00406 Call_Box * cb = NULL; 00407 int cb_port = 0xffff; 00408 cb = __find_CB__( v_cb, call->get_cb_ext() ); 00409 if( cb != NULL ) cb_port = cb->get_port(); 00410 uint8_t * pkg2cb = __build_cb_package__( call->get_cb_ext(), cb_port, __AUDIO__, 00411 tmp, __AUDIO__, length, write_buffer ); 00412 __send_to_cb__( pkg2cb ); 00413 } 00414 } 00415 //nessa funcao eu deveria me registar a cada 2 min por exemplo 00416 registry_aging( v_cb, data, write_buffer ); 00417 int ret = sip_manager( v_cb, v_call, write_buffer ); 00418 if( ret > 0x00 ){ 00419 Call_Box * cb = __find_CB__( v_cb, ret ); 00420 if( cb->status == cb_on_call ){ 00421 ts->return_timeslice( cb->get_timeslice() ); 00422 cb->set_timeslice( 0x00 ); 00423 set_status(cb->status,cb_idle); 00424 buffer[ __TIMESLICE_PLACE__ ] = 0x00; 00425 cb->set_msg_id( ( ( cb->get_msg_id() ) + 1 ) & ( BIT7 ^ 0xff ) ); 00426 for( register uint8_t i = 0; i < v_call->size(); i++ ){ 00427 VZ_call * call = ( VZ_call * )v_call->get_element( i ); 00428 v_call->remove_element( i ); 00429 } 00430 __send_to_cb__( __build_cb_package__( ext, port, __CB_BYE__, 00431 ( char * )buffer, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) ); 00432 cb->reset_sip(); 00433 set_status( cb->sip->status, sip_idle ); 00434 } 00435 } 00436 call_manager( v_call, v_cb, data, write_buffer, ts ); 00437 00438 static uint8_t flag = 0; 00439 if( v_call->size() == 0 ){ 00440 if (flag == 0) { flag = 1; } 00441 ts->reset(); 00442 }else { 00443 if (flag == 1) { flag = 0; } 00444 } 00445 /* eu deveria tirar ts que nao constam em chamadas aqui */ 00446 for( register uint8_t i = 0; i < v_cb->size(); i++ ){ 00447 Call_Box * cb = ( Call_Box * )v_cb->get_element( i ); 00448 if( cb->get_timeslice() != 0x00 ){ 00449 VZ_call * call = __find_Call__( v_call, cb->get_ext() ); 00450 if( call == NULL ){ 00451 ts->return_timeslice( cb->get_timeslice() ); 00452 cb->set_timeslice( 0x00 ); 00453 set_status(cb->status,cb_idle); 00454 } 00455 } 00456 } 00457 type = __DO_NOTHING__; 00458 } 00459 }
Generated on Fri Jul 22 2022 09:19:18 by
1.7.2