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

main.cpp@22:d2a4b5939115, 2014-09-20 (annotated)

Committer:
Cola
Date:
Sat Sep 20 20:43:33 2014 +0000
Revision:
22:d2a4b5939115
Parent:
21:0bd688722e81
Child:
23:4a6d631a6298
20-09-14 - led externo;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
klauss 0:4d17cd9c8f9d 1 #include "bits.h"
klauss 0:4d17cd9c8f9d 2 #include "utils.h"
klauss 0:4d17cd9c8f9d 3 #include "configs.h"
klauss 0:4d17cd9c8f9d 4 #include "UART3Interrupt.h"
klauss 0:4d17cd9c8f9d 5 #include "parallelcpld.h"
Cola 21:0bd688722e81 6 #include "prompt.h"
klauss 18:01a93677e40c 7
klauss 0:4d17cd9c8f9d 8 #include "debug.h"
klauss 0:4d17cd9c8f9d 9 #include "utils.h"
Cola 21:0bd688722e81 10 #include "flood.h"
klauss 0:4d17cd9c8f9d 11
klauss 0:4d17cd9c8f9d 12 /*
klauss 0:4d17cd9c8f9d 13 #define set_status(a,b) _set_status(a,b)
klauss 0:4d17cd9c8f9d 14 #define _set_status(a,b) { \
klauss 0:4d17cd9c8f9d 15 a = b; \
klauss 0:4d17cd9c8f9d 16 sprintf( debug_msg, "-- State == %d -- Line %d", a, __LINE__ ); \
klauss 0:4d17cd9c8f9d 17 debug.sendTo( debug_server, debug_msg, strlen( debug_msg ) ); \
klauss 0:4d17cd9c8f9d 18 }
klauss 0:4d17cd9c8f9d 19 #define whereami() _whereami()
klauss 0:4d17cd9c8f9d 20 #define _whereami() { \
klauss 0:4d17cd9c8f9d 21 sprintf( debug_msg, "-- whereami %d", __LINE__ ); \
klauss 0:4d17cd9c8f9d 22 debug.sendTo( debug_server, debug_msg, strlen( debug_msg ) ); \
klauss 0:4d17cd9c8f9d 23 }
klauss 0:4d17cd9c8f9d 24 */
klauss 0:4d17cd9c8f9d 25 volatile uint8_t status = 0x00;
klauss 0:4d17cd9c8f9d 26
klauss 0:4d17cd9c8f9d 27 bool debug_bool = true;
klauss 0:4d17cd9c8f9d 28
klauss 0:4d17cd9c8f9d 29 int main(){
klauss 0:4d17cd9c8f9d 30 start_cpld();
klauss 0:4d17cd9c8f9d 31 config_lpc();
klauss 0:4d17cd9c8f9d 32
klauss 0:4d17cd9c8f9d 33 /* referencia e inicio da conexao com a ethernet */
klauss 0:4d17cd9c8f9d 34 EthernetInterface eth;
klauss 13:ae278302dffe 35
klauss 9:ffa64f38ef9c 36 int eth_status = __init_eth__( &eth );
klauss 9:ffa64f38ef9c 37
Cola 20:2d6ab23956e5 38
klauss 8:e3bfe62a477e 39 if( eth_status ){
klauss 18:01a93677e40c 40 debug_msg("Sem conexao eth");
klauss 8:e3bfe62a477e 41 }
klauss 0:4d17cd9c8f9d 42
klauss 0:4d17cd9c8f9d 43 /* debugs */
klauss 2:93bec7313ccc 44 // debug_server.set_address( "192.168.120.144", 9897 );
klauss 2:93bec7313ccc 45 // debug.bind( 72133 );
klauss 2:93bec7313ccc 46 // debug.init();
klauss 0:4d17cd9c8f9d 47
klauss 0:4d17cd9c8f9d 48 Timer t;
klauss 0:4d17cd9c8f9d 49 t.start();
klauss 0:4d17cd9c8f9d 50
klauss 0:4d17cd9c8f9d 51 /* representa ramal do call box */
klauss 0:4d17cd9c8f9d 52 int ext = 0;
klauss 0:4d17cd9c8f9d 53
klauss 0:4d17cd9c8f9d 54 /* representa porta do call box */
klauss 0:4d17cd9c8f9d 55 int port = 0;
klauss 0:4d17cd9c8f9d 56
klauss 0:4d17cd9c8f9d 57 /* buffer para onde se copia os dados vindos do cb para tratameno interno */
klauss 0:4d17cd9c8f9d 58 uint8_t buffer[ __CB_BUFFER_SIZE__ ];
klauss 0:4d17cd9c8f9d 59
klauss 0:4d17cd9c8f9d 60 /* buffer de escrita do pacote de saida que sera enviado pro cb / servidor */
klauss 0:4d17cd9c8f9d 61 uint8_t write_buffer[ __CB_BUFFER_SIZE__ ];
klauss 0:4d17cd9c8f9d 62
klauss 0:4d17cd9c8f9d 63 /* ponteiro que aponta para os dados vindo do CPLD */
klauss 0:4d17cd9c8f9d 64 uint8_t * buffer_from_cb_ptr = ( uint8_t * )RXBuffer;
klauss 0:4d17cd9c8f9d 65
klauss 0:4d17cd9c8f9d 66 /* referencia para os dados contidos no pacote, sem o header */
klauss 0:4d17cd9c8f9d 67 uint8_t * data = NULL;
klauss 0:4d17cd9c8f9d 68
klauss 0:4d17cd9c8f9d 69 /* gerencia o tipo do pacote para providenciar tratamento adequado */
klauss 0:4d17cd9c8f9d 70 volatile uint8_t type = __DO_NOTHING__;
klauss 0:4d17cd9c8f9d 71
klauss 0:4d17cd9c8f9d 72 /* representa a lista dos Call Boxes atualmente reconhecidos pela cabeceira */
klauss 0:4d17cd9c8f9d 73 Vector * v_cb = new Vector();
klauss 0:4d17cd9c8f9d 74
klauss 0:4d17cd9c8f9d 75 /* representa a lista de ligacoes ativas na cabeceira */
klauss 0:4d17cd9c8f9d 76 Vector * v_call = new Vector();
klauss 0:4d17cd9c8f9d 77
klauss 0:4d17cd9c8f9d 78 /* gerencia a distribuicao de timeslice para os call boxes */
klauss 0:4d17cd9c8f9d 79 Timeslice * ts = new Timeslice();
klauss 0:4d17cd9c8f9d 80
klauss 0:4d17cd9c8f9d 81 /* tenta instanciar o vetor de call boxes, acende o led 1 antes de encerrar o programa */
klauss 0:4d17cd9c8f9d 82 reset_leds();
klauss 0:4d17cd9c8f9d 83 if( v_cb == NULL ){
klauss 0:4d17cd9c8f9d 84 led1 = 0;
klauss 0:4d17cd9c8f9d 85 while( v_cb == NULL ){
klauss 0:4d17cd9c8f9d 86 Vector * v_cb = new Vector();
klauss 0:4d17cd9c8f9d 87 led1 = led1;
klauss 0:4d17cd9c8f9d 88 if( t.read() > 5 ){
klauss 0:4d17cd9c8f9d 89 debug_msg("Erro ao alocar o vetor de CBx");
klauss 0:4d17cd9c8f9d 90 t.reset();
klauss 0:4d17cd9c8f9d 91 }
klauss 0:4d17cd9c8f9d 92 }
klauss 0:4d17cd9c8f9d 93 }else if( v_call == NULL ){
klauss 0:4d17cd9c8f9d 94 led2 = 0;
klauss 0:4d17cd9c8f9d 95 led1 = 1;
klauss 0:4d17cd9c8f9d 96 while( v_call == NULL ){
klauss 0:4d17cd9c8f9d 97 Vector * v_call = new Vector();
klauss 0:4d17cd9c8f9d 98 led1 = led1;
klauss 0:4d17cd9c8f9d 99 if( t.read() > 5 ){
klauss 0:4d17cd9c8f9d 100 debug_msg("Erro ao alocar o vetor de Calls");
klauss 0:4d17cd9c8f9d 101 t.reset();
klauss 0:4d17cd9c8f9d 102 }
klauss 0:4d17cd9c8f9d 103 }
klauss 0:4d17cd9c8f9d 104 }
klauss 0:4d17cd9c8f9d 105 reset_leds();
klauss 0:4d17cd9c8f9d 106 debug_msg( " Ready " );
Cola 21:0bd688722e81 107
Cola 21:0bd688722e81 108 while( true ){
Cola 21:0bd688722e81 109 prompt_process();
Cola 21:0bd688722e81 110
Cola 22:d2a4b5939115 111 if (pcks_s == 1){
Cola 22:d2a4b5939115 112 pc.printf("\n\r PKG_CSK OK: %d", pkg_cksok);
Cola 22:d2a4b5939115 113 pc.printf("\n\r PKG_CSK ERR: %d\n\r", pkg_ckserr);
Cola 22:d2a4b5939115 114 pcks_s =0;
Cola 22:d2a4b5939115 115 }
Cola 22:d2a4b5939115 116
Cola 21:0bd688722e81 117 if (pflood == 1) flood();
Cola 21:0bd688722e81 118
Cola 21:0bd688722e81 119
klauss 0:4d17cd9c8f9d 120 if( status != __WAITING__ ){
klauss 0:4d17cd9c8f9d 121 __read_cb_buffer__( buffer, buffer_from_cb_ptr );
klauss 0:4d17cd9c8f9d 122 status = __WAITING__;
klauss 0:4d17cd9c8f9d 123
klauss 0:4d17cd9c8f9d 124 data = __parse_cb_buffer__( &ext, &port, &type, buffer );
klauss 0:4d17cd9c8f9d 125
klauss 3:cd9148672e25 126 if( data != NULL ){
klauss 18:01a93677e40c 127 debug_msg("Procurando pelo CBx :: %d -- Type :: %d", ext, type );
klauss 7:019b08223b87 128 if( type != __AUDIO__ ){
klauss 0:4d17cd9c8f9d 129 Call_Box * cb = __find_CB__( v_cb, ext );
klauss 0:4d17cd9c8f9d 130 if( cb != NULL ){
klauss 3:cd9148672e25 131 cb->reset_elapsed_time();
klauss 0:4d17cd9c8f9d 132 if( ( data[ 0 ] ^ cb->get_msg_id() ) == BIT7 ){
klauss 0:4d17cd9c8f9d 133 // some pkg reply
klauss 0:4d17cd9c8f9d 134 if( ( data[ 0 ] | BIT7 ) == cb->get_msg_id() ){
klauss 7:019b08223b87 135 if( type == __BOOT__ ) type = __REGISTRY__;
klauss 0:4d17cd9c8f9d 136 __send_to_cb__( __build_cb_package__( ext, port, type,
klauss 0:4d17cd9c8f9d 137 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 0:4d17cd9c8f9d 138 type = __DO_NOTHING__;
klauss 0:4d17cd9c8f9d 139 debug_msg("-- Renviado ultimo pkg --");
klauss 0:4d17cd9c8f9d 140 }else if( data[ 0 ] == ( cb->get_msg_id() | BIT7 ) ){
klauss 0:4d17cd9c8f9d 141 // ack from CBx
klauss 3:cd9148672e25 142 debug_msg("-- ACK do meu pkg --");
klauss 0:4d17cd9c8f9d 143 type = __DO_NOTHING__;
klauss 0:4d17cd9c8f9d 144 }
klauss 0:4d17cd9c8f9d 145 }
klauss 0:4d17cd9c8f9d 146 }
klauss 0:4d17cd9c8f9d 147 }
klauss 0:4d17cd9c8f9d 148 }else type = __DO_NOTHING__;
klauss 0:4d17cd9c8f9d 149 }
klauss 2:93bec7313ccc 150 //----------------------
klauss 18:01a93677e40c 151 if( t.read() > 5 ){
klauss 18:01a93677e40c 152 for( register uint8_t i = 0; i < v_cb->size(); i++ ){
klauss 18:01a93677e40c 153 Call_Box * cb = ( Call_Box * )v_cb->get_element( i );
Cola 21:0bd688722e81 154 if (debug_alive){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 );}
klauss 0:4d17cd9c8f9d 155 }
Cola 22:d2a4b5939115 156
Cola 21:0bd688722e81 157 if (debug_alive == 1){
Cola 22:d2a4b5939115 158 debug_msg("");
Cola 21:0bd688722e81 159 //uint32_t errper = 100*(pkg_ckserr/(pkg_ckserr + pkg_cksok));
Cola 21:0bd688722e81 160 //pc.printf("\n\r Error = %d", errper);
Cola 21:0bd688722e81 161 }
klauss 0:4d17cd9c8f9d 162 t.reset();
klauss 0:4d17cd9c8f9d 163 led3 = !led3;
Cola 22:d2a4b5939115 164 CAB_LED = !CAB_LED;
klauss 0:4d17cd9c8f9d 165 }
klauss 0:4d17cd9c8f9d 166 //----------------------
klauss 0:4d17cd9c8f9d 167 switch( type ){
klauss 0:4d17cd9c8f9d 168 case __DO_NOTHING__ :{}
klauss 0:4d17cd9c8f9d 169 break;
klauss 0:4d17cd9c8f9d 170
klauss 0:4d17cd9c8f9d 171 case __CB_BYE__ : {
klauss 0:4d17cd9c8f9d 172 Call_Box * cb = __find_CB__( v_cb, ext );
klauss 0:4d17cd9c8f9d 173 if( cb != NULL ){
klauss 18:01a93677e40c 174 debug_msg("Nao encontrado CBx :: %d -- Type :: %d", ext, type );
klauss 0:4d17cd9c8f9d 175 data[ 0 ] |= BIT7;
klauss 0:4d17cd9c8f9d 176 cb->set_msg_id( data[ 0 ] );
klauss 0:4d17cd9c8f9d 177 debug_msg( " Request bye from CBx " );
klauss 0:4d17cd9c8f9d 178 for( register uint8_t i = 0; i < v_call->size(); i++ ){
klauss 0:4d17cd9c8f9d 179 VZ_call * call = (VZ_call *)v_call->get_element( i );
klauss 0:4d17cd9c8f9d 180 if( call->get_cb_ext() == ext ){
klauss 4:de46f0d9b14d 181 cb->send_bye();
klauss 0:4d17cd9c8f9d 182 ts->return_timeslice( cb->get_timeslice() );
klauss 0:4d17cd9c8f9d 183 cb->set_timeslice( 0x00 );
klauss 0:4d17cd9c8f9d 184 set_status( cb->status, cb_idle );
klauss 13:ae278302dffe 185 v_call->remove_element( i );
klauss 13:ae278302dffe 186 set_status( cb->sip->status, sip_idle);
klauss 0:4d17cd9c8f9d 187 data[ __TIMESLICE_PLACE__ ] = 0x00;
klauss 0:4d17cd9c8f9d 188 __send_to_cb__( __build_cb_package__( ext, port, __CB_BYE__,
klauss 0:4d17cd9c8f9d 189 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 13:ae278302dffe 190 set_status( cb->sip->status, sip_idle );
klauss 3:cd9148672e25 191 delete( call );
klauss 0:4d17cd9c8f9d 192 }
klauss 0:4d17cd9c8f9d 193 }
klauss 0:4d17cd9c8f9d 194 }
klauss 7:019b08223b87 195 }break;
klauss 7:019b08223b87 196
klauss 0:4d17cd9c8f9d 197 case __INVITE__ : {
klauss 13:ae278302dffe 198 debug_msg("ok -- recebido o invite pelo menos");
klauss 0:4d17cd9c8f9d 199 Call_Box * cb = __find_CB__( v_cb, ext );
klauss 0:4d17cd9c8f9d 200 if( cb == NULL ){
klauss 18:01a93677e40c 201 debug_msg("Nao encontrado CBx :: %d -- Type :: %d", ext, type );
klauss 0:4d17cd9c8f9d 202 cb = new Call_Box( ext, port );
klauss 0:4d17cd9c8f9d 203 v_cb->add( cb );
klauss 0:4d17cd9c8f9d 204 set_status( cb->status, cb_idle );
klauss 0:4d17cd9c8f9d 205 cb->registry();
klauss 0:4d17cd9c8f9d 206 }
klauss 13:ae278302dffe 207 cb->reset_elapsed_time();
klauss 10:22da1a0ac1e1 208 if( v_call->size() != 0 ){
klauss 10:22da1a0ac1e1 209 data[ 0 ] |= BIT7;
klauss 10:22da1a0ac1e1 210 cb->set_msg_id( data[ 0 ] );
klauss 10:22da1a0ac1e1 211 set_status(cb->status,cb_idle);
klauss 10:22da1a0ac1e1 212 cb->set_timeslice( 0x00 );
klauss 10:22da1a0ac1e1 213 data[ __TIMESLICE_PLACE__ ] = 0x00;
klauss 10:22da1a0ac1e1 214 __send_to_cb__( __build_cb_package__( ext, port, __INVITE__,
klauss 10:22da1a0ac1e1 215 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 10:22da1a0ac1e1 216 debug_msg( "-- Negando chamada, uma ja em andamento -- " );
klauss 10:22da1a0ac1e1 217 break;
klauss 10:22da1a0ac1e1 218 }
klauss 0:4d17cd9c8f9d 219 set_status( cb->status, cb_trying );
klauss 18:01a93677e40c 220 debug_msg(" Ok temos um cbx encontrado com status :: %d", cb->status );
klauss 0:4d17cd9c8f9d 221 switch( cb->status ){
klauss 0:4d17cd9c8f9d 222 case cb_on_call : {
klauss 0:4d17cd9c8f9d 223 // a priori, nao fazer nada
klauss 0:4d17cd9c8f9d 224 //data[ __TIMESLICE_PLACE__ ] = 0x00;
klauss 0:4d17cd9c8f9d 225 //__send_to_cb__( __build_cb_package__( ext, port, __BYE__,
klauss 0:4d17cd9c8f9d 226 // ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 0:4d17cd9c8f9d 227 }break;
klauss 0:4d17cd9c8f9d 228
klauss 0:4d17cd9c8f9d 229 case cb_ringing : {
klauss 0:4d17cd9c8f9d 230 // tratar sip 2
klauss 0:4d17cd9c8f9d 231 }break;
klauss 0:4d17cd9c8f9d 232
klauss 0:4d17cd9c8f9d 233 case cb_trying : {
klauss 0:4d17cd9c8f9d 234 data[ 0 ] |= BIT7;
klauss 0:4d17cd9c8f9d 235 cb->set_msg_id( data[ 0 ] );
klauss 0:4d17cd9c8f9d 236 cb->set_timeslice( ts->get_timeslice() );
klauss 0:4d17cd9c8f9d 237 if( cb->get_timeslice() == 0x00 ){
klauss 0:4d17cd9c8f9d 238 //sem timeslice pra tratar com o *
klauss 9:ffa64f38ef9c 239 set_status(cb->status,cb_idle);
klauss 0:4d17cd9c8f9d 240 data[ __TIMESLICE_PLACE__ ] = 0x00;
klauss 0:4d17cd9c8f9d 241 __send_to_cb__( __build_cb_package__( ext, port, __INVITE__,
klauss 0:4d17cd9c8f9d 242 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 13:ae278302dffe 243 set_status( cb->sip->status, sip_idle);
klauss 13:ae278302dffe 244 debug_msg( "-- Trying -- Sem TS -- %s ", write_buffer );
klauss 0:4d17cd9c8f9d 245 }else{
klauss 0:4d17cd9c8f9d 246 set_status(cb->status,cb_busy);
klauss 0:4d17cd9c8f9d 247 data[ __TIMESLICE_PLACE__ ] = cb->get_timeslice();
klauss 0:4d17cd9c8f9d 248 __send_to_cb__( __build_cb_package__( ext, port, __INVITE__,
klauss 0:4d17cd9c8f9d 249 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 0:4d17cd9c8f9d 250
klauss 0:4d17cd9c8f9d 251 debug_msg(" -- %d on %d -- ", cb->get_ext(), data[ __TIMESLICE_PLACE__ ] );
klauss 0:4d17cd9c8f9d 252
klauss 3:cd9148672e25 253 cb->set_msg_id( ( ( cb->get_msg_id() ) + 1 ) & ( BIT7 ^ 0xff ) );
klauss 0:4d17cd9c8f9d 254 VZ_call * call = cb->invite();
klauss 0:4d17cd9c8f9d 255
klauss 0:4d17cd9c8f9d 256 if( call != NULL ){
klauss 0:4d17cd9c8f9d 257 v_call->add( call );
klauss 0:4d17cd9c8f9d 258 set_status(cb->status,cb_on_call);
klauss 0:4d17cd9c8f9d 259
klauss 0:4d17cd9c8f9d 260 debug_msg(" -- %d on %d -- ", cb->get_ext(), data[ __TIMESLICE_PLACE__ ] );
klauss 0:4d17cd9c8f9d 261 __send_to_cb__( __build_cb_package__( ext, port, __INVITE__,
klauss 0:4d17cd9c8f9d 262 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 18:01a93677e40c 263 debug_msg( "-- Trying -- aceitando pedido de invite -- %s ", write_buffer );
klauss 0:4d17cd9c8f9d 264 //debug_pkg( 300, write_buffer );
klauss 0:4d17cd9c8f9d 265 }else{
klauss 4:de46f0d9b14d 266 set_status( cb->status,cb_idle);
klauss 0:4d17cd9c8f9d 267 ts->return_timeslice( cb->get_timeslice() );
klauss 0:4d17cd9c8f9d 268 cb->set_timeslice( 0x00 );
klauss 0:4d17cd9c8f9d 269 data[ __TIMESLICE_PLACE__ ] = 0x00;
klauss 0:4d17cd9c8f9d 270 debug_msg(" -- %d on %d -- ", cb->get_ext(), data[ __TIMESLICE_PLACE__ ] );
klauss 0:4d17cd9c8f9d 271 __send_to_cb__( __build_cb_package__( ext, port, __CB_BYE__,
klauss 0:4d17cd9c8f9d 272 ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 18:01a93677e40c 273 debug_msg( "-- Trying -- Negando pedido de invite -- %s ", write_buffer );
klauss 13:ae278302dffe 274 set_status( cb->sip->status, sip_idle);
klauss 0:4d17cd9c8f9d 275 }
klauss 0:4d17cd9c8f9d 276 }
klauss 4:de46f0d9b14d 277 }break;
klauss 0:4d17cd9c8f9d 278 case cb_busy : {
klauss 18:01a93677e40c 279 // tratar sip
klauss 0:4d17cd9c8f9d 280 }break;
klauss 0:4d17cd9c8f9d 281 }
klauss 0:4d17cd9c8f9d 282 }break;
klauss 4:de46f0d9b14d 283 case __REGISTRY__ : {
klauss 4:de46f0d9b14d 284 Call_Box * cb = NULL;
klauss 2:93bec7313ccc 285
klauss 4:de46f0d9b14d 286 data[ 0 ] |= BIT7 ;
klauss 4:de46f0d9b14d 287 cb = __find_CB__( v_cb, ext );
klauss 4:de46f0d9b14d 288 if( cb != NULL ){
klauss 4:de46f0d9b14d 289 cb->reset_elapsed_time();
klauss 4:de46f0d9b14d 290 debug_msg(" reset_elapsed_time CBx -- %d", ext );
klauss 0:4d17cd9c8f9d 291 }else{
klauss 18:01a93677e40c 292 debug_msg("Nao encontrado CBx :: %d -- Type :: %d", ext, type );
klauss 4:de46f0d9b14d 293 cb = new Call_Box( ext, port );
klauss 4:de46f0d9b14d 294 v_cb->add( cb );
klauss 4:de46f0d9b14d 295 debug_msg(" Criado CBx -- %d", ext );
klauss 0:4d17cd9c8f9d 296 }
klauss 4:de46f0d9b14d 297 debug_msg("::Registrado %d - %d::", ext, port );
klauss 4:de46f0d9b14d 298 cb->registry();
klauss 4:de46f0d9b14d 299 }break;
klauss 4:de46f0d9b14d 300 case __BOOT__ : {
klauss 4:de46f0d9b14d 301 __send_to_cb__( __build_cb_package__( ext, port, __REGISTRY__,
klauss 4:de46f0d9b14d 302 ( char * )data, data[ 0 ], __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 4:de46f0d9b14d 303 }break;
klauss 4:de46f0d9b14d 304 case __TELEMETRY__ : {
klauss 13:ae278302dffe 305 debug_msg("Leitura da bateria :: ( Id : %x, MSB : %x, LSB : %x )", data[ 0 ], data[ 1 ], data[ 2 ] );
klauss 4:de46f0d9b14d 306 }break;
klauss 0:4d17cd9c8f9d 307 case __AUDIO__ : {
klauss 0:4d17cd9c8f9d 308 Call_Box * cb;
klauss 0:4d17cd9c8f9d 309 VZ_call * call = NULL;
klauss 0:4d17cd9c8f9d 310 cb = NULL;
klauss 0:4d17cd9c8f9d 311 call = __find_Call__( v_call, ext );
klauss 0:4d17cd9c8f9d 312 if( call != NULL ){
klauss 0:4d17cd9c8f9d 313 //debug_( 240, data );
klauss 0:4d17cd9c8f9d 314 //debug_pkg( 242, data );
klauss 0:4d17cd9c8f9d 315 //char * pkg = call->build_eth_package( oitocentos );
klauss 0:4d17cd9c8f9d 316 //char * pkg = call->build_eth_package( data );
klauss 9:ffa64f38ef9c 317 char * pkg = call->build_eth_package( data + 2 );
klauss 0:4d17cd9c8f9d 318 call->send_message( pkg );
klauss 0:4d17cd9c8f9d 319 cb = __find_CB__( v_cb, ext );
klauss 0:4d17cd9c8f9d 320 if( cb != NULL ) cb->reset_elapsed_time();
klauss 18:01a93677e40c 321 }else{
klauss 18:01a93677e40c 322 debug_msg("Nao encontrado CBx :: %d -- Type :: %d", ext, type );
klauss 0:4d17cd9c8f9d 323 }
klauss 0:4d17cd9c8f9d 324 }break;
klauss 9:ffa64f38ef9c 325 }// fim switch
klauss 0:4d17cd9c8f9d 326 for( register int i = 0; i < v_call->size(); i++ ){
klauss 0:4d17cd9c8f9d 327 VZ_call * call = ( VZ_call * )v_call->get_element( i );
klauss 0:4d17cd9c8f9d 328 int length = 0;
klauss 0:4d17cd9c8f9d 329 char * tmp = call->get_eth_message( &length );
klauss 0:4d17cd9c8f9d 330 if( tmp != NULL ){
klauss 0:4d17cd9c8f9d 331 Call_Box * cb = NULL;
klauss 0:4d17cd9c8f9d 332 int cb_port = 0xffff;
klauss 0:4d17cd9c8f9d 333 cb = __find_CB__( v_cb, call->get_cb_ext() );
klauss 4:de46f0d9b14d 334
klauss 4:de46f0d9b14d 335 if( cb != NULL ){
klauss 4:de46f0d9b14d 336 cb_port = cb->get_port();
klauss 18:01a93677e40c 337 }else debug_msg("Nao encontrado CBx :: %d -- Type :: %d", ext, type );
klauss 4:de46f0d9b14d 338
klauss 0:4d17cd9c8f9d 339 uint8_t * pkg2cb = __build_cb_package__( call->get_cb_ext(), cb_port, __AUDIO__,
klauss 0:4d17cd9c8f9d 340 tmp, __AUDIO__, length, write_buffer );
klauss 4:de46f0d9b14d 341
klauss 0:4d17cd9c8f9d 342 __send_to_cb__( pkg2cb );
klauss 0:4d17cd9c8f9d 343 }
klauss 14:22a35f575502 344 }
klauss 15:9c7456c1b6f4 345 ///debug_msg("");
klauss 13:ae278302dffe 346 registry_aging( v_cb, buffer, write_buffer );
klauss 4:de46f0d9b14d 347
klauss 0:4d17cd9c8f9d 348 int ret = sip_manager( v_cb, v_call, write_buffer );
klauss 0:4d17cd9c8f9d 349 if( ret > 0x00 ){
klauss 0:4d17cd9c8f9d 350 Call_Box * cb = __find_CB__( v_cb, ret );
klauss 4:de46f0d9b14d 351 if( cb != NULL ){
klauss 4:de46f0d9b14d 352 if( cb->status == cb_on_call ){
klauss 4:de46f0d9b14d 353 ts->return_timeslice( cb->get_timeslice() );
klauss 4:de46f0d9b14d 354 cb->set_timeslice( 0x00 );
klauss 4:de46f0d9b14d 355 set_status(cb->status,cb_idle);
klauss 4:de46f0d9b14d 356 buffer[ __TIMESLICE_PLACE__ ] = 0x00;
klauss 4:de46f0d9b14d 357 cb->set_msg_id( ( ( cb->get_msg_id() ) + 1 ) & ( BIT7 ^ 0xff ) );
klauss 4:de46f0d9b14d 358 for( register uint8_t i = 0; i < v_call->size(); i++ ){
klauss 4:de46f0d9b14d 359 VZ_call * call = ( VZ_call * )v_call->get_element( i );
klauss 4:de46f0d9b14d 360 if( call->get_cb_ext() == ret ){
klauss 4:de46f0d9b14d 361 v_call->remove_element( i );
klauss 4:de46f0d9b14d 362 delete( call );
klauss 4:de46f0d9b14d 363 }
klauss 2:93bec7313ccc 364 }
klauss 4:de46f0d9b14d 365 __send_to_cb__( __build_cb_package__( ext, port, __CB_BYE__,
klauss 4:de46f0d9b14d 366 ( char * )buffer, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
klauss 4:de46f0d9b14d 367 cb->reset_sip();
klauss 13:ae278302dffe 368 set_status( cb->sip->status, sip_idle );
klauss 0:4d17cd9c8f9d 369 }
klauss 18:01a93677e40c 370 }else debug_msg("Nao encontrado CBx :: %d -- Type :: %d", ext, type );
klauss 0:4d17cd9c8f9d 371 }
klauss 13:ae278302dffe 372
klauss 10:22da1a0ac1e1 373 call_manager( v_call, v_cb, buffer, write_buffer, ts );
klauss 0:4d17cd9c8f9d 374
klauss 0:4d17cd9c8f9d 375 static uint8_t flag = 0;
klauss 0:4d17cd9c8f9d 376 if( v_call->size() == 0 ){
klauss 0:4d17cd9c8f9d 377 if (flag == 0) { flag = 1; }
klauss 0:4d17cd9c8f9d 378 ts->reset();
klauss 0:4d17cd9c8f9d 379 }else {
klauss 0:4d17cd9c8f9d 380 if (flag == 1) { flag = 0; }
klauss 0:4d17cd9c8f9d 381 }
klauss 0:4d17cd9c8f9d 382 /* eu deveria tirar ts que nao constam em chamadas aqui */
klauss 13:ae278302dffe 383 /* for( register uint8_t i = 0; i < v_cb->size(); i++ ){
klauss 0:4d17cd9c8f9d 384 Call_Box * cb = ( Call_Box * )v_cb->get_element( i );
klauss 0:4d17cd9c8f9d 385 if( cb->get_timeslice() != 0x00 ){
klauss 0:4d17cd9c8f9d 386 VZ_call * call = __find_Call__( v_call, cb->get_ext() );
klauss 0:4d17cd9c8f9d 387 if( call == NULL ){
klauss 0:4d17cd9c8f9d 388 ts->return_timeslice( cb->get_timeslice() );
klauss 0:4d17cd9c8f9d 389 cb->set_timeslice( 0x00 );
klauss 0:4d17cd9c8f9d 390 set_status(cb->status,cb_idle);
klauss 0:4d17cd9c8f9d 391 }
klauss 0:4d17cd9c8f9d 392 }
klauss 0:4d17cd9c8f9d 393 }
klauss 4:de46f0d9b14d 394 */ type = __DO_NOTHING__;
klauss 0:4d17cd9c8f9d 395 }
klauss 0:4d17cd9c8f9d 396 }