VZTECH
voltando a versao de n aberturas e fechamentos de sockets
Dependencies: EthernetInterface NTPClient mbed-rtos_old mbed
Fork of
header_main_public
by 
VZTECH
Diff: main.cpp
- Revision:
- 0:4d17cd9c8f9d
- Child:
- 1:a1758104fa1d
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Tue Sep 09 20:01:24 2014 +0000
@@ -0,0 +1,460 @@
+#include "bits.h"
+#include "utils.h"
+#include "configs.h"
+#include "UART3Interrupt.h"
+#include "parallelcpld.h"
+
+#include "debug.h"
+#include "utils.h"
+
+
+// for aditional debugs
+#define on_work
+
+/*
+#define set_status(a,b) _set_status(a,b)
+#define _set_status(a,b) { \
+ a = b; \
+ sprintf( debug_msg, "-- State == %d -- Line %d", a, __LINE__ ); \
+ debug.sendTo( debug_server, debug_msg, strlen( debug_msg ) ); \
+}
+#define whereami() _whereami()
+#define _whereami() { \
+ sprintf( debug_msg, "-- whereami %d", __LINE__ ); \
+ debug.sendTo( debug_server, debug_msg, strlen( debug_msg ) ); \
+}
+*/
+volatile uint8_t status = 0x00;
+
+bool debug_bool = true;
+
+int main(){
+ start_cpld();
+ config_lpc();
+
+ /* referencia e inicio da conexao com a ethernet */
+ EthernetInterface eth;
+ __init_eth__( ð );
+
+ /* debugs */
+ debug_server.set_address( "192.168.120.144", 9897 );
+ debug.bind( 72133 );
+ debug.init();
+
+ Timer t;
+ Timer reboot;
+ t.start();
+
+ /* representa ramal do call box */
+ int ext = 0;
+
+ /* representa porta do call box */
+ int port = 0;
+
+ /* buffer para onde se copia os dados vindos do cb para tratameno interno */
+ uint8_t buffer[ __CB_BUFFER_SIZE__ ];
+
+ /* buffer de escrita do pacote de saida que sera enviado pro cb / servidor */
+ uint8_t write_buffer[ __CB_BUFFER_SIZE__ ];
+
+ /* ponteiro que aponta para os dados vindo do CPLD */
+ uint8_t * buffer_from_cb_ptr = ( uint8_t * )RXBuffer;
+
+ /* referencia para os dados contidos no pacote, sem o header */
+ uint8_t * data = NULL;
+
+ /* gerencia o tipo do pacote para providenciar tratamento adequado */
+ volatile uint8_t type = __DO_NOTHING__;
+
+ /* representa a lista dos Call Boxes atualmente reconhecidos pela cabeceira */
+ Vector * v_cb = new Vector();
+
+ /* representa a lista de ligacoes ativas na cabeceira */
+ Vector * v_call = new Vector();
+
+ /* gerencia a distribuicao de timeslice para os call boxes */
+ Timeslice * ts = new Timeslice();
+
+ /* tenta instanciar o vetor de call boxes, acende o led 1 antes de encerrar o programa */
+ reset_leds();
+ if( v_cb == NULL ){
+ led1 = 0;
+ while( v_cb == NULL ){
+ Vector * v_cb = new Vector();
+ led1 = led1;
+ if( t.read() > 5 ){
+ debug_msg("Erro ao alocar o vetor de CBx");
+ t.reset();
+ }
+ }
+ }else if( v_call == NULL ){
+ led2 = 0;
+ led1 = 1;
+ while( v_call == NULL ){
+ Vector * v_call = new Vector();
+ led1 = led1;
+ if( t.read() > 5 ){
+ debug_msg("Erro ao alocar o vetor de Calls");
+ t.reset();
+ }
+ }
+ }
+ reset_leds();
+ reboot.start();
+ debug_msg( " Ready " );
+
+
+ char test_buffer[400];
+ UDPSocket test_sock;
+ Endpoint test_server;
+ test_server.set_address( "192.168.120.144" , 12345 );
+ test_sock.set_blocking( false, 1 );
+ test_sock.bind( 78965 );
+ test_sock.init();
+ int n = 0;
+ strcpy( test_buffer, "a");
+ test_sock.sendTo( test_server, test_buffer, sizeof( test_buffer ) );
+ Timer reconnect;
+ reconnect.start();
+
+ while( true ){
+
+ n = test_sock.receiveFrom( test_server, test_buffer, sizeof( test_buffer ) );
+ if( n > 0 ){
+ test_sock.sendTo( test_server, test_buffer, n );
+ reconnect.reset();
+ }else if( reconnect.read() > 1 ){
+ test_sock.close();
+ test_sock.bind( 78965 );
+ test_sock.init();
+ reconnect.reset();
+ test_sock.sendTo( test_server, test_buffer, n );
+ led4 = !led4;
+ }
+
+ if( status != __WAITING__ ){
+ __read_cb_buffer__( buffer, buffer_from_cb_ptr );
+ status = __WAITING__;
+
+ data = __parse_cb_buffer__( &ext, &port, &type, buffer );
+
+ if( data != NULL ){
+
+ if( type == __CB_BYE__ ){
+ debug_msg("--> %s <--", buffer);
+ }
+ if( type != __AUDIO__ ){
+ Call_Box * cb = __find_CB__( v_cb, ext );
+ if( cb != NULL ){
+ if( ( data[ 0 ] ^ cb->get_msg_id() ) == BIT7 ){
+ // some pkg reply
+ if( ( data[ 0 ] | BIT7 ) == cb->get_msg_id() ){
+ if( type == __BOOT__ ) type = __REGISTRY__;
+ __send_to_cb__( __build_cb_package__( ext, port, type,
+ ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+ type = __DO_NOTHING__;
+ debug_msg("-- Renviado ultimo pkg --");
+ }else if( data[ 0 ] == ( cb->get_msg_id() | BIT7 ) ){
+ // ack from CBx
+ type = __DO_NOTHING__;
+ debug_msg("-- ACK do meu pkg --");
+ }
+ }
+ }
+ }
+ }else type = __DO_NOTHING__;
+ /*
+ if( data == NULL ) type = __DO_NOTHING__;
+ */
+ }
+//----------------------
+ if( t.read() > 5 ){
+ for( register uint8_t i = 0; i < v_cb->size(); i++ ){
+ Call_Box * cb = ( Call_Box * )v_cb->get_element( i );
+ 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 );
+ }
+ t.reset();
+ led3 = !led3;
+ }
+ if( reboot.read() > 180 ){
+ for( register uint8_t i = 0; i < v_cb->size(); i++ ){
+ Call_Box * cb = ( Call_Box * )v_cb->get_element( i );
+ cb->set_timeslice( 0x00 );
+ set_status(cb->status,cb_idle);
+ set_status( cb->sip->status, sip_idle );
+ 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 );
+ }
+ for( register uint8_t i = 0; i < v_call->size(); i++ ){
+ VZ_call * call = ( VZ_call * )v_call->get_element( i );
+ v_call->remove_element( i );
+ delete( call );
+ }
+ reboot.reset();
+ led4 = !led4;
+ }
+//----------------------
+ switch( type ){
+ case __DO_NOTHING__ :{}
+ break;
+
+ case __CB_BYE__ : {
+ Call_Box * cb = __find_CB__( v_cb, ext );
+ if( cb != NULL ){
+ data[ 0 ] |= BIT7;
+ cb->set_msg_id( data[ 0 ] );
+ debug_msg( " Request bye from CBx " );
+ for( register uint8_t i = 0; i < v_call->size(); i++ ){
+ VZ_call * call = (VZ_call *)v_call->get_element( i );
+ if( call->get_cb_ext() == ext ){
+ ts->return_timeslice( cb->get_timeslice() );
+ cb->set_timeslice( 0x00 );
+ set_status( cb->status, cb_idle );
+ v_call->remove_element( i );
+ cb->send_bye();
+ set_status( cb->sip->status, sip_idle);
+ data[ __TIMESLICE_PLACE__ ] = 0x00;
+ __send_to_cb__( __build_cb_package__( ext, port, __CB_BYE__,
+ ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+ set_status( cb->sip->status, sip_idle );
+ }
+ }
+ }
+ }break;
+
+ case __INVITE__ : {
+ #ifndef on_work
+ // invite de uma ligacao em andamento ?
+ Call_Box * cb = __find_CB__( v_cb, ext );
+ if( cb != NULL ){
+ cb->reset_elapsed_time();
+ if( cb->status == cb_on_call ){
+ VZ_call * vz = __find_Call__( v_call, cb->get_ext() );
+ if( vz != NULL ) break;
+ ts->return_timeslice( cb->get_timeslice() );
+ cb->set_timeslice( 0x00 );
+ set_status(cb->status,cb_idle);
+ }
+ }else{
+ cb = new Call_Box( ext, port );
+ v_cb->add( cb );
+ }
+ if( cb->status != cb_on_call ) set_status(cb->status,cb_ringing);
+ if( data[ __TIMESLICE_PLACE__ ] == __CB_BYE__ ){
+ if( cb->status == cb_on_call ){
+ for( register uint8_t i = 0; i < v_call->size(); i++ ){
+ if( ( (VZ_call *)v_call->get_element( i ) )->get_cb_ext() == ext ){
+ v_call->remove_element( i );
+ ts->return_timeslice( cb->get_timeslice() );
+ cb->set_timeslice( 0x00 );
+ set_status(cb->status,cb_idle);
+ cb->send_bye();
+ break;
+ }
+ }
+ }
+ }
+ if( cb->status == cb_ringing ){
+ data[ 0 ] |= BIT7;
+ cb->set_msg_id( data[ 0 ] );
+ cb->set_timeslice( ts->get_timeslice() );
+ if( cb->get_timeslice() == 0x00 ){
+ set_status(cb->status,cb_idle);
+ data[ __CLOCK_SYNC_SIZE__ ] = 0x00;
+ __send_to_cb__( __build_cb_package__( ext, port, __INVITE__,
+ ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+ break;
+ }
+ if( cb->status == cb_ringing ){
+ data[ __CLOCK_SYNC_SIZE__ ] = cb->get_timeslice();
+ __send_to_cb__( __build_cb_package__( ext, port, __INVITE__,
+ ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+
+ VZ_call * call = cb->invite();
+
+ if( call != NULL ){
+ v_call->add( call );
+ set_status(cb->status,cb_on_call);
+ data[ __CLOCK_SYNC_SIZE__ ] = cb->get_timeslice();
+ __send_to_cb__( __build_cb_package__( ext, port, __INVITE__,
+ ( char * )data, cb->get_msg_id()+1, __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+ }else{
+ set_status(cb->status,cb_idle);
+ ts->return_timeslice( cb->get_timeslice() );
+ data[ __CLOCK_SYNC_SIZE__ ] = 0x00;
+ __send_to_cb__( __build_cb_package__( ext, port, __INVITE__,
+ ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+ }
+ }
+ }
+ }break;
+ #endif
+ #ifdef on_work
+ Call_Box * cb = __find_CB__( v_cb, ext );
+ if( cb == NULL ){
+ cb = new Call_Box( ext, port );
+ v_cb->add( cb );
+ set_status( cb->status, cb_idle );
+ cb->registry();
+ }
+ cb->reset_elapsed_time();
+ set_status( cb->status, cb_trying );
+ debug_msg(" Ok temos um cbx encontrado com status :: %d", cb->status );
+ switch( cb->status ){
+ case cb_on_call : {
+ // a priori, nao fazer nada
+ //data[ __TIMESLICE_PLACE__ ] = 0x00;
+ //__send_to_cb__( __build_cb_package__( ext, port, __BYE__,
+ // ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+ }break;
+
+ case cb_ringing : {
+ // tratar sip 2
+ }break;
+
+ case cb_trying : {
+ data[ 0 ] |= BIT7;
+ cb->set_msg_id( data[ 0 ] );
+ cb->set_timeslice( ts->get_timeslice() );
+ if( cb->get_timeslice() == 0x00 ){
+ //sem timeslice pra tratar com o *
+ set_status(cb->status,cb_idle);
+ data[ __TIMESLICE_PLACE__ ] = 0x00;
+ __send_to_cb__( __build_cb_package__( ext, port, __INVITE__,
+ ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+ set_status( cb->sip->status, sip_idle);
+ debug_msg( "-- Trying -- Sem TS -- %s ", write_buffer );
+ }else{
+ set_status(cb->status,cb_busy);
+ data[ __TIMESLICE_PLACE__ ] = cb->get_timeslice();
+ __send_to_cb__( __build_cb_package__( ext, port, __INVITE__,
+ ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+
+ debug_msg(" -- %d on %d -- ", cb->get_ext(), data[ __TIMESLICE_PLACE__ ] );
+
+ cb->set_msg_id( ( ( cb->get_msg_id() ) + 1 ) & ( BIT7 ^ 0xff ) );
+ VZ_call * call = cb->invite();
+
+ if( call != NULL ){
+ v_call->add( call );
+ set_status(cb->status,cb_on_call);
+
+ debug_msg(" -- %d on %d -- ", cb->get_ext(), data[ __TIMESLICE_PLACE__ ] );
+ __send_to_cb__( __build_cb_package__( ext, port, __INVITE__,
+ ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+ debug_msg( "-- Trying -- aceitando pedido de invite -- %s ", write_buffer );
+ //debug_pkg( 300, write_buffer );
+ }else{
+ set_status(cb->status,cb_idle);
+ ts->return_timeslice( cb->get_timeslice() );
+ cb->set_timeslice( 0x00 );
+ data[ __TIMESLICE_PLACE__ ] = 0x00;
+ debug_msg(" -- %d on %d -- ", cb->get_ext(), data[ __TIMESLICE_PLACE__ ] );
+ __send_to_cb__( __build_cb_package__( ext, port, __CB_BYE__,
+ ( char * )data, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+ debug_msg( "-- Trying -- Negando pedido de invite -- %s ", write_buffer );
+ set_status( cb->sip->status, sip_idle);
+ }
+ }
+ }break;
+
+ case cb_busy : {
+ // tratar sip
+ }break;
+ }
+ }break;
+ #endif
+ case __REGISTRY__ :
+ {
+ Call_Box * cb;
+ data[ 0 ] |= BIT7;
+ cb = __find_CB__( v_cb, ext );
+ if( cb != NULL ){
+ cb->reset_elapsed_time();
+ }else{
+ cb = new Call_Box( ext, port );
+ v_cb->add( cb );
+ }
+ cb->registry();
+ }break;
+ case __BOOT__ :
+ __send_to_cb__( __build_cb_package__( ext, port, __REGISTRY__,
+ ( char * )data, data[ 0 ], __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+ break;
+ case __TELEMETRY__ :
+ debug_msg("Leitura da bateria :: ( Id : %x, MSB : %x, LSB : %x )", data[ 0 ], data[ 1 ], data[ 2 ] );
+ break;
+ case __AUDIO__ : {
+ Call_Box * cb;
+ VZ_call * call = NULL;
+ cb = NULL;
+ call = __find_Call__( v_call, ext );
+ if( call != NULL ){
+ //debug_( 240, data );
+ //debug_pkg( 242, data );
+ //char * pkg = call->build_eth_package( oitocentos );
+ //char * pkg = call->build_eth_package( data );
+ char * pkg = call->build_eth_package( data + 2 );
+ call->send_message( pkg );
+ cb = __find_CB__( v_cb, ext );
+ if( cb != NULL ) cb->reset_elapsed_time();
+ }
+ }break;
+ }// fim switch
+ for( register int i = 0; i < v_call->size(); i++ ){
+ VZ_call * call = ( VZ_call * )v_call->get_element( i );
+ int length = 0;
+ char * tmp = call->get_eth_message( &length );
+ if( tmp != NULL ){
+ Call_Box * cb = NULL;
+ int cb_port = 0xffff;
+ cb = __find_CB__( v_cb, call->get_cb_ext() );
+ if( cb != NULL ) cb_port = cb->get_port();
+ uint8_t * pkg2cb = __build_cb_package__( call->get_cb_ext(), cb_port, __AUDIO__,
+ tmp, __AUDIO__, length, write_buffer );
+ __send_to_cb__( pkg2cb );
+ }
+ }
+ //nessa funcao eu deveria me registar a cada 2 min por exemplo
+ registry_aging( v_cb, data, write_buffer );
+ int ret = sip_manager( v_cb, v_call, write_buffer );
+ if( ret > 0x00 ){
+ Call_Box * cb = __find_CB__( v_cb, ret );
+ if( cb->status == cb_on_call ){
+ ts->return_timeslice( cb->get_timeslice() );
+ cb->set_timeslice( 0x00 );
+ set_status(cb->status,cb_idle);
+ buffer[ __TIMESLICE_PLACE__ ] = 0x00;
+ cb->set_msg_id( ( ( cb->get_msg_id() ) + 1 ) & ( BIT7 ^ 0xff ) );
+ for( register uint8_t i = 0; i < v_call->size(); i++ ){
+ VZ_call * call = ( VZ_call * )v_call->get_element( i );
+ v_call->remove_element( i );
+ }
+ __send_to_cb__( __build_cb_package__( ext, port, __CB_BYE__,
+ ( char * )buffer, cb->get_msg_id(), __CB_BUFFER_SIZE__ - __VZ_HEADER_OFFSET__, write_buffer ) );
+ set_status( cb->sip->status, sip_idle );
+ }
+ }
+ call_manager( v_call, v_cb, data, write_buffer, ts );
+
+ static uint8_t flag = 0;
+ if( v_call->size() == 0 ){
+ if (flag == 0) { flag = 1; }
+ ts->reset();
+ }else {
+ if (flag == 1) { flag = 0; }
+ }
+ /* eu deveria tirar ts que nao constam em chamadas aqui */
+ for( register uint8_t i = 0; i < v_cb->size(); i++ ){
+ Call_Box * cb = ( Call_Box * )v_cb->get_element( i );
+ if( cb->get_timeslice() != 0x00 ){
+ VZ_call * call = __find_Call__( v_call, cb->get_ext() );
+ if( call == NULL ){
+ ts->return_timeslice( cb->get_timeslice() );
+ cb->set_timeslice( 0x00 );
+ set_status(cb->status,cb_idle);
+ }
+ }
+ }
+ type = __DO_NOTHING__;
+ }
+}
\ No newline at end of file