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

call_box_manager.cpp@109:a5b8264ffbbc, 2015-04-07 (annotated)

Committer:
klauss
Date:
Tue Apr 07 14:27:44 2015 +0000
Revision:
109:a5b8264ffbbc
Parent:
108:18a3702650f3
Child:
113:db67ae00550e
bl wip

Who changed what in which revision?

UserRevisionLine numberNew contents of line
klauss 74:81c47fff88a5 1 #include "call_box_manager.h"
klauss 74:81c47fff88a5 2
klauss 80:61d61c9eb75c 3 Timer timer_refresh;
klauss 78:1353744f01e1 4 Timer timer_aging;
klauss 89:0fe315117b00 5 Timer timer_sync_refresh;
klauss 78:1353744f01e1 6
klauss 74:81c47fff88a5 7 Call_Box * __find_CB__( Vector * v_cb, int ext ){
klauss 74:81c47fff88a5 8 Call_Box * cb = NULL;
klauss 74:81c47fff88a5 9 for( register int i = 0; i < v_cb->size(); i++ ){
klauss 74:81c47fff88a5 10 cb = ( Call_Box * )v_cb->get_element( i );
klauss 109:a5b8264ffbbc 11 if( cb->get_ext() == ext ) return( cb );
klauss 74:81c47fff88a5 12 }
klauss 74:81c47fff88a5 13 return( NULL );
klauss 74:81c47fff88a5 14 }
klauss 74:81c47fff88a5 15
klauss 109:a5b8264ffbbc 16 int refresh( Vector * v_cb, uint8_t * data, uint8_t * write_buffer, Call_Box * cb ){
klauss 109:a5b8264ffbbc 17 if( v_cb != NULL && data != NULL && write_buffer != NULL ){
klauss 81:3656f00ab3db 18 static int lst_index = 0;
klauss 109:a5b8264ffbbc 19
klauss 109:a5b8264ffbbc 20 if( cb != NULL ){
klauss 109:a5b8264ffbbc 21 timer_refresh.reset();
klauss 81:3656f00ab3db 22
klauss 109:a5b8264ffbbc 23 //cb->set_msg_id( ( cb->get_msg_id() + 1 ) & ( ~BIT7 ) );
klauss 109:a5b8264ffbbc 24 cb->set_msg_id( ( cb->get_msg_id() + 1 ) & ~BIT7 );
klauss 81:3656f00ab3db 25
klauss 109:a5b8264ffbbc 26 send2callboxes( __build_cb_package__( cb->get_ext(), cb->get_port(), __REGISTRY__,
klauss 109:a5b8264ffbbc 27 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 106:a34fcf9f0e02 28
klauss 109:a5b8264ffbbc 29 if( debug_refresh ) send_msg("Refresh specific %d", cb->get_ext() );
klauss 106:a34fcf9f0e02 30
klauss 109:a5b8264ffbbc 31 return( 0x10 );
klauss 109:a5b8264ffbbc 32 }else{
klauss 109:a5b8264ffbbc 33 if( v_cb->size() > 0 ){
klauss 109:a5b8264ffbbc 34 if( lst_index >= v_cb->size() ) lst_index = 0;
klauss 109:a5b8264ffbbc 35
klauss 109:a5b8264ffbbc 36 Call_Box * cb = (Call_Box * )v_cb->get_element( lst_index++ );
klauss 80:61d61c9eb75c 37
klauss 109:a5b8264ffbbc 38 if( cb != NULL && cb->status == cb_idle ){
klauss 109:a5b8264ffbbc 39
klauss 109:a5b8264ffbbc 40 if( cb->get_ext() % 2 == 1 ){
klauss 109:a5b8264ffbbc 41 Call_Box * cb_master = __find_CB__( v_cb, cb->get_ext() - 1 );
klauss 109:a5b8264ffbbc 42 if( cb_master != NULL && cb_master->status != cb_idle ) return( 0x20 );
klauss 109:a5b8264ffbbc 43 }
klauss 109:a5b8264ffbbc 44
klauss 109:a5b8264ffbbc 45 //cb->set_msg_id( ( cb->get_msg_id() + 1 ) & ( ~BIT7 ) );
klauss 109:a5b8264ffbbc 46 cb->set_msg_id( ( cb->get_msg_id() + 1 ) & ~BIT7 );
klauss 109:a5b8264ffbbc 47
klauss 109:a5b8264ffbbc 48 send2callboxes( __build_cb_package__( cb->get_ext(), cb->get_port(), __REGISTRY__,
klauss 109:a5b8264ffbbc 49 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 109:a5b8264ffbbc 50
klauss 109:a5b8264ffbbc 51 if( debug_refresh ) send_msg("Refresh %d", cb->get_ext() );
klauss 109:a5b8264ffbbc 52
klauss 109:a5b8264ffbbc 53 return( 0 );
klauss 109:a5b8264ffbbc 54 }else return( -5 );
klauss 109:a5b8264ffbbc 55 }else return( -3 );
klauss 109:a5b8264ffbbc 56 }
klauss 89:0fe315117b00 57 }else return( -1 );
klauss 80:61d61c9eb75c 58 }
klauss 80:61d61c9eb75c 59
klauss 109:a5b8264ffbbc 60 //FiXME se validar, nao preciso de tantos parametros ...
klauss 74:81c47fff88a5 61 void registry_aging( Vector * v_cb, uint8_t * data, uint8_t * write_buffer ){
klauss 80:61d61c9eb75c 62 for( register int i = 0; i < v_cb->size(); i++ ){
klauss 80:61d61c9eb75c 63 Call_Box * cb = (Call_Box * )v_cb->get_element( i );
klauss 109:a5b8264ffbbc 64 if( cb->is_timeout() ){
klauss 80:61d61c9eb75c 65 if( debug_aging ) debug_msg("sands for %d", cb->get_ext() );
klauss 80:61d61c9eb75c 66 if( cb->has_next_try() == false ){
klauss 80:61d61c9eb75c 67 if( debug_aging ) debug_msg( "time to really go ( ext %d removed )", cb->get_ext() );
klauss 80:61d61c9eb75c 68 v_cb->remove_element( i );
klauss 80:61d61c9eb75c 69 delete( cb );
klauss 80:61d61c9eb75c 70 break;
klauss 89:0fe315117b00 71 }
klauss 80:61d61c9eb75c 72 }
klauss 80:61d61c9eb75c 73 }
klauss 78:1353744f01e1 74 }
klauss 78:1353744f01e1 75
klauss 109:a5b8264ffbbc 76 /*
klauss 109:a5b8264ffbbc 77 A ideia desse cara aqui ... a cada x sec. ele vai passar pelos cbx registrados na logica,
klauss 109:a5b8264ffbbc 78 contidos em v_cb e verificar quais estao ausentes ( pares, masters, slaves ) e mandar um
klauss 109:a5b8264ffbbc 79 registry pra cada um deles ... um por ver ... mantendo uma lista com os que estao ainda
klauss 109:a5b8264ffbbc 80 off, e deveriam estar on, e atualizar essa lista ... por exemplo a cada 3 sec.
klauss 109:a5b8264ffbbc 81
klauss 109:a5b8264ffbbc 82 */
klauss 109:a5b8264ffbbc 83 void wake_all_up( Vector * v_cb, uint8_t * data, uint8_t * write_buffer ){
klauss 109:a5b8264ffbbc 84 if( v_cb != NULL && data != NULL && write_buffer != NULL ){
klauss 109:a5b8264ffbbc 85 static int ext_list[ __MAX_CB_IN_A_BRANCH__ ];
klauss 109:a5b8264ffbbc 86 uint8_t size = v_cb->size();
klauss 105:a930035b6556 87
klauss 109:a5b8264ffbbc 88 bool once = true;
klauss 78:1353744f01e1 89
klauss 109:a5b8264ffbbc 90 if( size > 0 ){
klauss 78:1353744f01e1 91 for( register int i = 0; i < size; i++ ){
klauss 78:1353744f01e1 92 ext_list[ i ] = ( ( Call_Box * )v_cb->get_element( i ) )->get_ext();
klauss 78:1353744f01e1 93 }
klauss 78:1353744f01e1 94
klauss 78:1353744f01e1 95 qsort( ext_list, v_cb->size(), sizeof( int ), ls_comp );
klauss 109:a5b8264ffbbc 96
klauss 109:a5b8264ffbbc 97 for( register int i = 0; i < size; i++ ){
klauss 109:a5b8264ffbbc 98 // testa se eh o master
klauss 109:a5b8264ffbbc 99 if( ( ext_list[ i ] % 2 ) == 0 ){
klauss 109:a5b8264ffbbc 100 //testa se o slave nao esta registrado
klauss 109:a5b8264ffbbc 101 //FIXME resolver o que acontece com o ultimo carinha == master, provavelmente fazendo um || ( i == size )
klauss 109:a5b8264ffbbc 102 if( ( ( i + 1 ) < size ) && ( ext_list[ i + 1 ] != ( ext_list[ i ] + 1 ) ) || ( size == 1 ) ){
klauss 109:a5b8264ffbbc 103 if( debug_wake ) debug_msg("Mestre %d encontrado sem slave %d", ext_list[ i ], ext_list[ i ] + 1 );
klauss 109:a5b8264ffbbc 104 if( once ){
klauss 109:a5b8264ffbbc 105 strcpy( ( char * )data, "ping\r\r\r\n" );
klauss 109:a5b8264ffbbc 106 Call_Box * cb = __find_CB__( v_cb, ext_list[ i ] );
klauss 109:a5b8264ffbbc 107 if( cb != NULL ){
klauss 109:a5b8264ffbbc 108 //cb->set_msg_id( ( cb->get_msg_id() + 1 ) & ( ~BIT7 ) );
klauss 109:a5b8264ffbbc 109 cb->set_msg_id( ( cb->get_msg_id() + 1 ) & ~BIT7 );
klauss 109:a5b8264ffbbc 110
klauss 109:a5b8264ffbbc 111 send2callboxes( __build_cb_package__( ( cb->get_ext() + 1 ), ( cb->get_port() + 1 ), __PROMPT__,
klauss 109:a5b8264ffbbc 112 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 109:a5b8264ffbbc 113
klauss 109:a5b8264ffbbc 114 if( debug_wake ) debug_msg("Slave %d pingado", cb->get_ext() + 1 );
klauss 109:a5b8264ffbbc 115 }
klauss 109:a5b8264ffbbc 116 once = false;
klauss 109:a5b8264ffbbc 117 }
klauss 104:62646ef786a3 118 }
klauss 109:a5b8264ffbbc 119 }else{
klauss 109:a5b8264ffbbc 120 if( ( ( i - 1 ) > 0 ) && ( ext_list[ i - 1 ] != ( ext_list[ i ] - 1 ) ) || ( size == 1 ) ){
klauss 109:a5b8264ffbbc 121 if( debug_wake ) debug_msg("Escravo revolucionario %d encontrado sem master %d", ext_list[ i ], ext_list[ i ] - 1 );
klauss 109:a5b8264ffbbc 122 if( once ){
klauss 109:a5b8264ffbbc 123 strcpy( ( char * )data, "ping\r\r\r\n" );
klauss 109:a5b8264ffbbc 124 Call_Box * cb = __find_CB__( v_cb, ( ext_list[ i ] ) );
klauss 109:a5b8264ffbbc 125 if( cb != NULL ){
klauss 109:a5b8264ffbbc 126 //cb->set_msg_id( ( cb->get_msg_id() + 1 ) & ( ~BIT7 ) );
klauss 109:a5b8264ffbbc 127 cb->set_msg_id( ( cb->get_msg_id() + 1 ) & ~BIT7 );
klauss 78:1353744f01e1 128
klauss 109:a5b8264ffbbc 129 send2callboxes( __build_cb_package__( ( cb->get_ext() - 1 ), ( cb->get_port() - 1 ), __PROMPT__,
klauss 109:a5b8264ffbbc 130 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 109:a5b8264ffbbc 131
klauss 109:a5b8264ffbbc 132 if( debug_wake ) debug_msg("Master %d pingado", cb->get_ext() - 1 );
klauss 109:a5b8264ffbbc 133 }
klauss 109:a5b8264ffbbc 134 once = false;
klauss 109:a5b8264ffbbc 135 }
klauss 78:1353744f01e1 136 }
klauss 74:81c47fff88a5 137 }
klauss 74:81c47fff88a5 138 }
klauss 74:81c47fff88a5 139 }
klauss 74:81c47fff88a5 140 }
klauss 74:81c47fff88a5 141 }