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

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 "sip.h"
klauss 0:4d17cd9c8f9d 2 #include "utils.h"
klauss 0:4d17cd9c8f9d 3
klauss 0:4d17cd9c8f9d 4 void Sip::__init_sock__( void ){
klauss 0:4d17cd9c8f9d 5 sip_server.set_address( this->server_ip , this->server_port );
klauss 0:4d17cd9c8f9d 6 sock.set_blocking( false, 1 ); // verificar isso com mais cuidado depois
klauss 0:4d17cd9c8f9d 7 sock.bind( this->my_port );
klauss 0:4d17cd9c8f9d 8 sock.init();
klauss 0:4d17cd9c8f9d 9 }
klauss 0:4d17cd9c8f9d 10
klauss 0:4d17cd9c8f9d 11 void Sip::__end_sock__(){
klauss 0:4d17cd9c8f9d 12 sock.close();
klauss 0:4d17cd9c8f9d 13 }
klauss 0:4d17cd9c8f9d 14
klauss 0:4d17cd9c8f9d 15 Sip::Sip( char * server_ip, int server_port, char * my_ip, int my_port, int my_ext, int peer_ext, int id ){
klauss 0:4d17cd9c8f9d 16 this->id = id;
klauss 0:4d17cd9c8f9d 17 strncpy( this->server_ip, server_ip, 20 );
klauss 0:4d17cd9c8f9d 18 this->server_ip[19] = 0;
klauss 0:4d17cd9c8f9d 19 this->server_port = server_port;
klauss 0:4d17cd9c8f9d 20 strncpy( this->my_ip, my_ip, 20 );
klauss 0:4d17cd9c8f9d 21 this->my_ip[19] = 0;
klauss 0:4d17cd9c8f9d 22 this->my_port = my_port;
klauss 0:4d17cd9c8f9d 23 this->my_rtp_port = fill_random_rtp_port();
klauss 0:4d17cd9c8f9d 24 this->my_ext = my_ext;
klauss 0:4d17cd9c8f9d 25 itoa( this->my_ext, this->my_display, 10 );
klauss 0:4d17cd9c8f9d 26 this->peer_ext = peer_ext;
klauss 0:4d17cd9c8f9d 27
klauss 0:4d17cd9c8f9d 28 strcpy( this->fill_random_aux, "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789pP" );
klauss 0:4d17cd9c8f9d 29 strcpy( this->last_invite_tag, "" );
klauss 0:4d17cd9c8f9d 30 strcpy( this->last_invite_callid, "");
klauss 0:4d17cd9c8f9d 31 strcpy( this->SVNREV, "COLA" );
klauss 0:4d17cd9c8f9d 32 status = sip_idle;
klauss 0:4d17cd9c8f9d 33
klauss 0:4d17cd9c8f9d 34 __init_sock__();
klauss 0:4d17cd9c8f9d 35 }
klauss 0:4d17cd9c8f9d 36
klauss 0:4d17cd9c8f9d 37 Sip::Sip(){
klauss 0:4d17cd9c8f9d 38 this->id = __MY_EXT__;
klauss 0:4d17cd9c8f9d 39 strncpy( this->server_ip, __SEVER_IP__, 20 );
klauss 0:4d17cd9c8f9d 40 this->server_ip[19] = 0;
klauss 0:4d17cd9c8f9d 41 this->server_port = __SERVER_PORT__;
klauss 0:4d17cd9c8f9d 42 strncpy( this->my_ip, __MY_IP__, 20 );
klauss 0:4d17cd9c8f9d 43 this->my_ip[19] = 0;
klauss 0:4d17cd9c8f9d 44 this->my_port = __MY_PORT__;
klauss 0:4d17cd9c8f9d 45 this->my_rtp_port = fill_random_rtp_port();
klauss 0:4d17cd9c8f9d 46 this->my_ext = __MY_EXT__;
klauss 0:4d17cd9c8f9d 47 itoa( this->my_ext, this->my_display, 10 );
klauss 0:4d17cd9c8f9d 48 this->peer_ext = __PEER_EXT__;
klauss 0:4d17cd9c8f9d 49
klauss 0:4d17cd9c8f9d 50 strcpy( this->fill_random_aux, "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789pP" );
klauss 0:4d17cd9c8f9d 51 strcpy( this->last_invite_tag, "" );
klauss 0:4d17cd9c8f9d 52 strcpy( this->last_invite_callid, "");
klauss 0:4d17cd9c8f9d 53 strcpy( this->SVNREV, "COLA" );
klauss 0:4d17cd9c8f9d 54 status = sip_idle;
klauss 0:4d17cd9c8f9d 55
klauss 0:4d17cd9c8f9d 56 __init_sock__();
klauss 0:4d17cd9c8f9d 57 }
klauss 0:4d17cd9c8f9d 58
klauss 0:4d17cd9c8f9d 59 Sip::Sip( int id, uint16_t my_port ){
klauss 0:4d17cd9c8f9d 60 this->id = id;
klauss 0:4d17cd9c8f9d 61 strncpy( this->server_ip, __SEVER_IP__, 20 );
klauss 0:4d17cd9c8f9d 62 this->server_ip[19] = 0;
klauss 0:4d17cd9c8f9d 63 this->server_port = __SERVER_PORT__;
klauss 0:4d17cd9c8f9d 64 strncpy( this->my_ip, __MY_IP__, 20 );
klauss 0:4d17cd9c8f9d 65 this->my_ip[19] = 0;
klauss 0:4d17cd9c8f9d 66 this->my_port = my_port;
klauss 0:4d17cd9c8f9d 67 this->my_rtp_port = fill_random_rtp_port();
klauss 0:4d17cd9c8f9d 68 this->my_ext = id;
klauss 0:4d17cd9c8f9d 69 itoa( this->my_ext, this->my_display, 10 );
klauss 0:4d17cd9c8f9d 70 this->peer_ext = __PEER_EXT__;
klauss 0:4d17cd9c8f9d 71
klauss 0:4d17cd9c8f9d 72 strcpy( this->fill_random_aux, "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789pP" );
klauss 0:4d17cd9c8f9d 73 strcpy( this->last_invite_tag, "" );
klauss 0:4d17cd9c8f9d 74 strcpy( this->last_invite_callid, "");
klauss 0:4d17cd9c8f9d 75 strcpy( this->SVNREV, "COLA" );
klauss 0:4d17cd9c8f9d 76 status = sip_idle;
klauss 0:4d17cd9c8f9d 77
klauss 0:4d17cd9c8f9d 78 __init_sock__();
klauss 0:4d17cd9c8f9d 79 }
klauss 0:4d17cd9c8f9d 80
klauss 0:4d17cd9c8f9d 81 Sip::Sip( int id, uint16_t my_port, int dest_ext ){
klauss 0:4d17cd9c8f9d 82 this->id = id;
klauss 0:4d17cd9c8f9d 83 strncpy( this->server_ip, __SEVER_IP__, 20 );
klauss 0:4d17cd9c8f9d 84 this->server_ip[19] = 0;
klauss 0:4d17cd9c8f9d 85 this->server_port = __SERVER_PORT__;
klauss 0:4d17cd9c8f9d 86 strncpy( this->my_ip, __MY_IP__, 20 );
klauss 0:4d17cd9c8f9d 87 this->my_ip[19] = 0;
klauss 0:4d17cd9c8f9d 88 this->my_port = my_port;
klauss 0:4d17cd9c8f9d 89 this->my_rtp_port = fill_random_rtp_port();
klauss 0:4d17cd9c8f9d 90 this->my_ext = id;
klauss 0:4d17cd9c8f9d 91 itoa( this->my_ext, this->my_display, 10 );
klauss 0:4d17cd9c8f9d 92 this->peer_ext = dest_ext;
klauss 0:4d17cd9c8f9d 93
klauss 0:4d17cd9c8f9d 94 strcpy( this->fill_random_aux, "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789pP" );
klauss 0:4d17cd9c8f9d 95 strcpy( this->last_invite_tag, "" );
klauss 0:4d17cd9c8f9d 96 strcpy( this->last_invite_callid, "");
klauss 0:4d17cd9c8f9d 97 strcpy( this->SVNREV, "COLA" );
klauss 0:4d17cd9c8f9d 98 status = sip_idle;
klauss 0:4d17cd9c8f9d 99
klauss 0:4d17cd9c8f9d 100 __init_sock__();
klauss 0:4d17cd9c8f9d 101 }
klauss 0:4d17cd9c8f9d 102
klauss 0:4d17cd9c8f9d 103 Sip::~Sip(){
klauss 0:4d17cd9c8f9d 104 __end_sock__();
klauss 0:4d17cd9c8f9d 105 }
klauss 0:4d17cd9c8f9d 106
klauss 0:4d17cd9c8f9d 107 void Sip::registry(){
klauss 13:ae278302dffe 108 char out[ 1000 ];
klauss 4:de46f0d9b14d 109 debug_msg("registrando -- %d", this->my_ext );
klauss 0:4d17cd9c8f9d 110 build_registry_package( buffer );
klauss 13:ae278302dffe 111 int sent = sock.sendTo( sip_server, buffer, sizeof( buffer ) );
klauss 0:4d17cd9c8f9d 112 sock.receiveFrom( sip_server, buffer, sizeof( buffer ) );
klauss 9:ffa64f38ef9c 113 debug_msg(" Recebidos %d bytes para o o ext %d", sent, my_ext );
klauss 0:4d17cd9c8f9d 114 if( decode_gettag( (unsigned char *)buffer, "cseq: ", out ) ){
klauss 0:4d17cd9c8f9d 115 if(strlen( out ) > 7){
klauss 0:4d17cd9c8f9d 116 if(strcasecmp("options",out+strlen(out)-7) == 0){
klauss 13:ae278302dffe 117 char ans[ 2000 ];
klauss 0:4d17cd9c8f9d 118 build_reply_package( ans, (unsigned char*)buffer );
klauss 0:4d17cd9c8f9d 119 sock.sendTo( sip_server, ans, sizeof( ans ) );
klauss 0:4d17cd9c8f9d 120 }
klauss 0:4d17cd9c8f9d 121 }
klauss 0:4d17cd9c8f9d 122 }
klauss 14:22a35f575502 123 debug_msg("");
klauss 0:4d17cd9c8f9d 124 }
klauss 0:4d17cd9c8f9d 125
klauss 0:4d17cd9c8f9d 126 VZ_call * Sip::invite(){
klauss 0:4d17cd9c8f9d 127 Timer t;
klauss 0:4d17cd9c8f9d 128 char callbox_string[ 32 ];
klauss 0:4d17cd9c8f9d 129 itoa( get_id(), callbox_string, 10 );
klauss 0:4d17cd9c8f9d 130
klauss 14:22a35f575502 131 if( status != sip_on_call ){
klauss 14:22a35f575502 132 set_status(status, sip_waiting_trying );
klauss 14:22a35f575502 133 }
klauss 0:4d17cd9c8f9d 134
klauss 0:4d17cd9c8f9d 135 else return( NULL );
klauss 0:4d17cd9c8f9d 136
klauss 0:4d17cd9c8f9d 137 int cseq = 0;
klauss 0:4d17cd9c8f9d 138
klauss 0:4d17cd9c8f9d 139 build_invite_package( buffer, callbox_string, &cseq );
klauss 0:4d17cd9c8f9d 140 sock.sendTo( sip_server, buffer, sizeof( buffer ) );
klauss 0:4d17cd9c8f9d 141
klauss 0:4d17cd9c8f9d 142 debug_msg( "Inicio do invite" );
klauss 0:4d17cd9c8f9d 143 debug_msg( "Sip::status::%d", status );
klauss 0:4d17cd9c8f9d 144 t.start();
klauss 0:4d17cd9c8f9d 145
klauss 0:4d17cd9c8f9d 146 sock.set_blocking( false, 5 );
klauss 0:4d17cd9c8f9d 147
klauss 0:4d17cd9c8f9d 148 int loop_times = 0;
klauss 0:4d17cd9c8f9d 149 int received_loop_times = 0;
klauss 0:4d17cd9c8f9d 150 Timer reconnect;
klauss 0:4d17cd9c8f9d 151 reconnect.start();
klauss 0:4d17cd9c8f9d 152 static int id_ = 0;
klauss 0:4d17cd9c8f9d 153 int length = 0;
klauss 3:cd9148672e25 154 bool waiting = false;
klauss 3:cd9148672e25 155
klauss 3:cd9148672e25 156 VZ_call * call = NULL;
klauss 0:4d17cd9c8f9d 157 while( t.read() < __INVITE_MAX_WAITING_TIME__ ){
klauss 0:4d17cd9c8f9d 158 loop_times++;
klauss 4:de46f0d9b14d 159 length = sock.receiveFrom( sip_server, buffer, sizeof( buffer ) );
klauss 0:4d17cd9c8f9d 160 if( length > 0 ){
klauss 0:4d17cd9c8f9d 161 reconnect.reset();
klauss 0:4d17cd9c8f9d 162 debug_msg("Pacotes recebidos :: %d", id_ );
klauss 4:de46f0d9b14d 163 buffer[ length ] = 0;
klauss 0:4d17cd9c8f9d 164 received_loop_times++;
klauss 0:4d17cd9c8f9d 165 if( ( status == sip_trying ) || ( status == sip_ringing ) ){
klauss 4:de46f0d9b14d 166 if( !( strncasecmp( buffer + 12, "ok", strlen("ok") ) ) ){
klauss 0:4d17cd9c8f9d 167 // tratar depois o esquema do Cseq ::
klauss 0:4d17cd9c8f9d 168 debug_msg( "Cseq == %d", cseq );
klauss 0:4d17cd9c8f9d 169 set_status(status, sip_on_call);
klauss 4:de46f0d9b14d 170 char *ref = strstr( buffer, "audio" );
klauss 0:4d17cd9c8f9d 171 debug_msg("ok");
klauss 0:4d17cd9c8f9d 172 if( ref != NULL ){
klauss 0:4d17cd9c8f9d 173 ref += 6; // audio
klauss 0:4d17cd9c8f9d 174 ref = strtok( ref, " ");
klauss 3:cd9148672e25 175 if( call == NULL ) call = new VZ_call( this->my_ext, this->my_rtp_port, this->peer_ext, atoi( ref ) );
klauss 13:ae278302dffe 176 char ans[ 1024 ];
klauss 4:de46f0d9b14d 177 build_ack_package( ans, ( unsigned char *)buffer );
klauss 0:4d17cd9c8f9d 178 sock.sendTo( sip_server, ans, sizeof( ans ) );
klauss 1:a1758104fa1d 179 debug_msg("Call alocada -- Sip::status::%d -- loop_times :: %d :: received_loop_times :: %d", status, loop_times, received_loop_times );
klauss 0:4d17cd9c8f9d 180 set_status( status, sip_on_call );
klauss 0:4d17cd9c8f9d 181 return( call );
klauss 0:4d17cd9c8f9d 182 }
klauss 0:4d17cd9c8f9d 183 }
klauss 0:4d17cd9c8f9d 184 }
klauss 3:cd9148672e25 185 if( ( status == sip_trying ) || ( status == sip_ringing ) ){
klauss 17:67a6b557eda5 186 if( !( strncasecmp( buffer + 12, "Busy Here", strlen("Busy Here") ) ) ){
klauss 17:67a6b557eda5 187 debug_msg("Busy Here");
klauss 17:67a6b557eda5 188 send_bye();
klauss 17:67a6b557eda5 189 delete( call );
klauss 17:67a6b557eda5 190 set_status( status, sip_busy );
klauss 17:67a6b557eda5 191 return( NULL );
klauss 17:67a6b557eda5 192 }
klauss 17:67a6b557eda5 193 }
klauss 17:67a6b557eda5 194 if( ( status == sip_trying ) || ( status == sip_ringing ) ){
klauss 4:de46f0d9b14d 195 if( !( strncasecmp( buffer + 12, "Session Progress", strlen("Session Progress") ) ) ){
klauss 3:cd9148672e25 196 debug_msg( "Trocando dados de audio -- musica de espera com o CBx" );
klauss 4:de46f0d9b14d 197 char *ref = strstr( buffer, "audio" );
klauss 3:cd9148672e25 198 if( ref != NULL ){
klauss 3:cd9148672e25 199 ref += 6; // audio
klauss 3:cd9148672e25 200 ref = strtok( ref, " ");
klauss 3:cd9148672e25 201 if( call == NULL ) call = new VZ_call( this->my_ext, this->my_rtp_port, this->peer_ext, atoi( ref ) );
klauss 3:cd9148672e25 202 waiting = true;
klauss 3:cd9148672e25 203 }
klauss 3:cd9148672e25 204 }
klauss 3:cd9148672e25 205 }
klauss 0:4d17cd9c8f9d 206 if( status == sip_trying ){
klauss 4:de46f0d9b14d 207 if( !( strncasecmp( buffer + 12, "ringing", strlen("ringing") ) ) ){
klauss 0:4d17cd9c8f9d 208 debug_msg("ringing");
klauss 0:4d17cd9c8f9d 209 t.reset();
klauss 0:4d17cd9c8f9d 210 set_status( status, sip_ringing );
klauss 0:4d17cd9c8f9d 211 }
klauss 0:4d17cd9c8f9d 212 }
klauss 0:4d17cd9c8f9d 213 if( status == sip_waiting_trying ){
klauss 4:de46f0d9b14d 214 if( !( strncasecmp( buffer + 12, "trying", strlen("trying") ) ) ){
klauss 0:4d17cd9c8f9d 215 debug_msg("trying")
klauss 0:4d17cd9c8f9d 216 t.reset();
klauss 0:4d17cd9c8f9d 217 set_status( status, sip_trying );
klauss 0:4d17cd9c8f9d 218 }
klauss 0:4d17cd9c8f9d 219 }
klauss 0:4d17cd9c8f9d 220 }else if( reconnect.read() > 4 ){
klauss 0:4d17cd9c8f9d 221 sock.close();
klauss 0:4d17cd9c8f9d 222 sock.bind( this->my_port );
klauss 0:4d17cd9c8f9d 223 sock.init();
klauss 0:4d17cd9c8f9d 224 sock.set_blocking( false, 1 );
klauss 0:4d17cd9c8f9d 225 debug_msg("Reconnect");
klauss 17:67a6b557eda5 226 wdt.kick();
klauss 0:4d17cd9c8f9d 227 reconnect.reset();
klauss 0:4d17cd9c8f9d 228 //sock.sendTo( sip_server, buffer, sizeof( buffer ) );
klauss 0:4d17cd9c8f9d 229 led4 = !led4;
klauss 0:4d17cd9c8f9d 230 }
klauss 3:cd9148672e25 231 if( waiting == true ){
klauss 3:cd9148672e25 232 char * tmp = call->get_eth_message( &length );
klauss 3:cd9148672e25 233 if( tmp != NULL ){
klauss 3:cd9148672e25 234 uint8_t * pkg2cb = __build_cb_package__( this->my_ext, this->my_port, __AUDIO__,
klauss 3:cd9148672e25 235 tmp, __AUDIO__, length, (uint8_t *)buffer );
klauss 3:cd9148672e25 236 __send_to_cb__( pkg2cb );
klauss 3:cd9148672e25 237 }
klauss 3:cd9148672e25 238 }
klauss 0:4d17cd9c8f9d 239 }
klauss 0:4d17cd9c8f9d 240
klauss 0:4d17cd9c8f9d 241 debug_msg("Call nao alocada -- Sip::status::%d -- loop_times :: %d :: received_loop_times :: %d", status, loop_times, received_loop_times );
klauss 0:4d17cd9c8f9d 242 if( t.read() > __INVITE_MAX_WAITING_TIME__ ){
klauss 0:4d17cd9c8f9d 243 set_status(status, sip_denied);
klauss 14:22a35f575502 244 send_bye();
klauss 0:4d17cd9c8f9d 245 }
klauss 3:cd9148672e25 246 delete( call );
klauss 0:4d17cd9c8f9d 247 return( NULL );
klauss 0:4d17cd9c8f9d 248 }
klauss 0:4d17cd9c8f9d 249
klauss 0:4d17cd9c8f9d 250 char * Sip::build_registry_package( char * buffer ){
klauss 0:4d17cd9c8f9d 251 char branch[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 252 char tag[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 253 char callid[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 254 fill_random16h( branch );
klauss 0:4d17cd9c8f9d 255 fill_random( tag, 18 );
klauss 0:4d17cd9c8f9d 256 fill_random16h( callid );
klauss 0:4d17cd9c8f9d 257 char itoa_buffer[ 65 ];
klauss 0:4d17cd9c8f9d 258 strcpy( buffer, "REGISTER sip:" );
klauss 0:4d17cd9c8f9d 259 strcat( buffer, server_ip );
klauss 0:4d17cd9c8f9d 260 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 261 itoa( server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 262 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 263 strcat( buffer, " SIP/2.0\r\nVia: SIP/2.0/UDP " );
klauss 0:4d17cd9c8f9d 264 strcat( buffer, my_ip );
klauss 0:4d17cd9c8f9d 265 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 266 itoa( my_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 267 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 268 strcat( buffer, ";branch=" );
klauss 0:4d17cd9c8f9d 269 strcat( buffer, branch );
klauss 0:4d17cd9c8f9d 270 strcat( buffer, "\r\nFrom: " );
klauss 4:de46f0d9b14d 271 // mudar isso aqui pra algo mais compreensivel pra cc
klauss 0:4d17cd9c8f9d 272 itoa( my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 273 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 274 strcat( buffer, " <sip:" );
klauss 0:4d17cd9c8f9d 275 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 276 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 277 strcat( buffer, server_ip );
klauss 0:4d17cd9c8f9d 278 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 279 itoa( server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 280 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 281 strcat( buffer, ">;tag=" );
klauss 0:4d17cd9c8f9d 282 strcat( buffer, tag );
klauss 0:4d17cd9c8f9d 283 strcat( buffer, "\r\nTo: " );
klauss 0:4d17cd9c8f9d 284 itoa( my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 285 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 286 strcat( buffer, " <sip:" );
klauss 0:4d17cd9c8f9d 287 itoa( my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 288 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 289 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 290 strcat( buffer, server_ip );
klauss 0:4d17cd9c8f9d 291 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 292 itoa( server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 293 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 294 strcat( buffer, ">\r\nCall-ID: " );
klauss 0:4d17cd9c8f9d 295 strcat( buffer, callid );
klauss 0:4d17cd9c8f9d 296 strcat( buffer, "\r\nCSeq: " );
klauss 0:4d17cd9c8f9d 297 itoa( get_cseq(), itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 298 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 299 strcat( buffer, " REGISTER\r\n" );
klauss 0:4d17cd9c8f9d 300 strcat( buffer, "Max-Forwards: " );
klauss 0:4d17cd9c8f9d 301 itoa( 70, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 302 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 303 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 304
klauss 0:4d17cd9c8f9d 305 strcat( buffer, "Contact: " );
klauss 0:4d17cd9c8f9d 306 itoa( my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 307 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 308 strcat( buffer, " <sip:" );
klauss 0:4d17cd9c8f9d 309 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 310 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 311 strcat( buffer, my_ip );
klauss 0:4d17cd9c8f9d 312 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 313 itoa( server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 314 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 315 strcat( buffer, ">;expires=120" );
klauss 0:4d17cd9c8f9d 316 //itoa( 1200, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 317 //strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 318 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 319
klauss 0:4d17cd9c8f9d 320 strcat( buffer, "User-Agent: VZtech/pabxdriver-" );
klauss 0:4d17cd9c8f9d 321 strcat( buffer, SVNREV );
klauss 0:4d17cd9c8f9d 322 strcat( buffer, "\r\nContent-Length: 0\r\n" );
klauss 0:4d17cd9c8f9d 323 strcat( buffer, SIP_ALLOW );
klauss 0:4d17cd9c8f9d 324 strcat( buffer, "\r\n\r\n" );
klauss 0:4d17cd9c8f9d 325 buffer[ SIP_MAXMSGSIZE - 1 ] = 0;
klauss 0:4d17cd9c8f9d 326 return buffer;
klauss 0:4d17cd9c8f9d 327 }
klauss 0:4d17cd9c8f9d 328
klauss 0:4d17cd9c8f9d 329 char * Sip::build_invite_package( char * pkg, char * callbox_string, int * cseq ){
klauss 0:4d17cd9c8f9d 330 char header[ SIP_MAXMSGSIZE ], body[ SIP_MAXMSGSIZE ];
klauss 0:4d17cd9c8f9d 331 char branch[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 332 char tag[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 333 char callid[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 334 char itoa_buffer[ 65 ];
klauss 0:4d17cd9c8f9d 335 *cseq = get_cseq();
klauss 0:4d17cd9c8f9d 336 fill_random16h( branch );
klauss 0:4d17cd9c8f9d 337 fill_random( tag,18 );
klauss 0:4d17cd9c8f9d 338 fill_random16h( callid );
klauss 0:4d17cd9c8f9d 339
klauss 0:4d17cd9c8f9d 340 strcpy( last_invite_tag,tag );
klauss 0:4d17cd9c8f9d 341 strcpy( last_invite_callid, callid );
klauss 0:4d17cd9c8f9d 342
klauss 0:4d17cd9c8f9d 343 strcpy( header, "INVITE sip:" );
klauss 0:4d17cd9c8f9d 344 itoa( this->peer_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 345 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 346 strcat( header, "@" );
klauss 0:4d17cd9c8f9d 347 strcat( header, this->server_ip );
klauss 0:4d17cd9c8f9d 348 strcat( header, ":" );
klauss 0:4d17cd9c8f9d 349 itoa( this->server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 350 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 351 strcat( header, " SIP/" );
klauss 0:4d17cd9c8f9d 352 itoa( 2, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 353 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 354 strcat( header, "." );
klauss 0:4d17cd9c8f9d 355 itoa( 0, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 356 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 357 strcat( header, "\r\n" );
klauss 0:4d17cd9c8f9d 358 strcat( header, "Via: SIP/" );
klauss 0:4d17cd9c8f9d 359 itoa( 2, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 360 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 361 strcat( header, "." );
klauss 0:4d17cd9c8f9d 362 itoa( 0, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 363 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 364 strcat( header, "/UDP" );
klauss 0:4d17cd9c8f9d 365 strcat( header, this->my_ip );
klauss 0:4d17cd9c8f9d 366 strcat( header, ":" );
klauss 0:4d17cd9c8f9d 367 itoa( this->my_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 368 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 369 strcat( header, ";branch=" );
klauss 0:4d17cd9c8f9d 370 strcat( header, branch );
klauss 0:4d17cd9c8f9d 371 strcat( header, "\r\n" );
klauss 0:4d17cd9c8f9d 372 strcat( header, "From: " );
klauss 0:4d17cd9c8f9d 373 strcat( header, callbox_string );
klauss 0:4d17cd9c8f9d 374 strcat( header, " <sip:" );
klauss 0:4d17cd9c8f9d 375 itoa( this->my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 376 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 377 strcat( header, "@" );
klauss 0:4d17cd9c8f9d 378 strcat( header, this->server_ip );
klauss 0:4d17cd9c8f9d 379 strcat( header, ":" );
klauss 0:4d17cd9c8f9d 380 itoa( this->server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 381 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 382 strcat( header, ">;tag=" );
klauss 0:4d17cd9c8f9d 383 strcat( header, tag );
klauss 0:4d17cd9c8f9d 384 strcat( header, "\r\n" );
klauss 0:4d17cd9c8f9d 385 strcat( header, "To: <sip:" );
klauss 0:4d17cd9c8f9d 386 itoa( this->peer_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 387 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 388 strcat( header, "@" );
klauss 0:4d17cd9c8f9d 389 strcat( header, this->server_ip );
klauss 0:4d17cd9c8f9d 390 strcat( header, ":" );
klauss 0:4d17cd9c8f9d 391 itoa( this->server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 392 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 393 strcat( header, ">\r\n" );
klauss 0:4d17cd9c8f9d 394 strcat( header, "Call-ID: " );
klauss 0:4d17cd9c8f9d 395 strcat( header, callid );
klauss 0:4d17cd9c8f9d 396 strcat( header, "@" );
klauss 0:4d17cd9c8f9d 397 strcat( header, this->my_ip );
klauss 0:4d17cd9c8f9d 398 strcat( header, "\r\n" );
klauss 0:4d17cd9c8f9d 399 strcat( header, "CSeq: " );
klauss 0:4d17cd9c8f9d 400 itoa( *cseq, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 401 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 402 strcat( header, " INVITE\r\n" );
klauss 0:4d17cd9c8f9d 403 strcat( header, "Contact: " );
klauss 0:4d17cd9c8f9d 404 itoa( this->my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 405 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 406 strcat( header, " <sip:" );
klauss 0:4d17cd9c8f9d 407 itoa( this->my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 408 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 409 strcat( header, "@" );
klauss 0:4d17cd9c8f9d 410 strcat( header, this->my_ip );
klauss 0:4d17cd9c8f9d 411 strcat( header, ":" );
klauss 0:4d17cd9c8f9d 412 itoa( this->my_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 413 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 414 strcat( header, ">\r\n" );
klauss 0:4d17cd9c8f9d 415 strcat( header, "Max-Forwards: " );
klauss 0:4d17cd9c8f9d 416 itoa( 20, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 417 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 418 strcat( header, "\r\n" );
klauss 0:4d17cd9c8f9d 419 strcat( header, "User-Agent: VZtech/pabxdriver-" );
klauss 0:4d17cd9c8f9d 420 strcat( header, SVNREV );
klauss 0:4d17cd9c8f9d 421 strcat( header, "\r\n" );
klauss 0:4d17cd9c8f9d 422 strcat( header, "Expires: " );
klauss 0:4d17cd9c8f9d 423 itoa( 70, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 424 strcat( header, itoa_buffer );
klauss 0:4d17cd9c8f9d 425 strcat( header, "\r\n" );
klauss 0:4d17cd9c8f9d 426 strcat( header, SIP_ALLOW );
klauss 0:4d17cd9c8f9d 427 strcat( header, "\r\n" );
klauss 0:4d17cd9c8f9d 428 strcat( header, "Content-Type: application/sdp\r\n" );
klauss 0:4d17cd9c8f9d 429 header[ SIP_MAXMSGSIZE - 1 ] = 0;
klauss 0:4d17cd9c8f9d 430
klauss 0:4d17cd9c8f9d 431 strcpy( body, "v=0\r\n" );
klauss 0:4d17cd9c8f9d 432 strcat( body, "o=- " );
klauss 0:4d17cd9c8f9d 433 itoa( 7377, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 434 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 435 strcat( body, " " );
klauss 0:4d17cd9c8f9d 436 itoa( 18176, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 437 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 438 strcat( body, " IN IP" );
klauss 0:4d17cd9c8f9d 439 itoa( 4, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 440 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 441 strcat( body, " " );
klauss 0:4d17cd9c8f9d 442 strcat( body, this->my_ip );
klauss 0:4d17cd9c8f9d 443 strcat( body, "\r\n" );
klauss 0:4d17cd9c8f9d 444 strcat( body, "s=-\r\n" );
klauss 0:4d17cd9c8f9d 445 strcat( body, "c=IN IP" );
klauss 0:4d17cd9c8f9d 446 itoa( 4, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 447 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 448 strcat( body, " " );
klauss 0:4d17cd9c8f9d 449 strcat( body, this->my_ip );
klauss 0:4d17cd9c8f9d 450 strcat( body, "\r\n" );
klauss 0:4d17cd9c8f9d 451 strcat( body, "t=" );
klauss 0:4d17cd9c8f9d 452 itoa( 0, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 453 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 454 strcat( body, " " );
klauss 0:4d17cd9c8f9d 455 itoa( 0, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 456 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 457 strcat( body, "\r\n" );
klauss 0:4d17cd9c8f9d 458 strcat( body, "m=audio " );
klauss 0:4d17cd9c8f9d 459 itoa( this->my_rtp_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 460 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 461 strcat( body, " RTP/AVP " );
klauss 0:4d17cd9c8f9d 462 itoa( 8, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 463 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 464 strcat( body, " " );
klauss 0:4d17cd9c8f9d 465 itoa( 101, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 466 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 467 strcat( body, "\r\n" );
klauss 0:4d17cd9c8f9d 468 strcat( body, "a=rtpmap:" );
klauss 0:4d17cd9c8f9d 469 itoa( 8, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 470 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 471 strcat( body, " PCMA/" );
klauss 0:4d17cd9c8f9d 472 itoa( 8000, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 473 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 474 strcat( body, "/" );
klauss 0:4d17cd9c8f9d 475 itoa( 1, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 476 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 477 strcat( body, "\r\n" );
klauss 0:4d17cd9c8f9d 478 strcat( body, "a=rtpmap:" );
klauss 0:4d17cd9c8f9d 479 itoa( 101, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 480 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 481 strcat( body, " telephone-event/" );
klauss 0:4d17cd9c8f9d 482 itoa( 8000, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 483 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 484 strcat( body, "\r\n" );
klauss 0:4d17cd9c8f9d 485 strcat( body, "a=fmtp: " );
klauss 0:4d17cd9c8f9d 486 itoa( 101, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 487 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 488 strcat( body, " " );
klauss 0:4d17cd9c8f9d 489 itoa( 0, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 490 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 491 strcat( body, "-" );
klauss 0:4d17cd9c8f9d 492 itoa( 11, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 493 strcat( body, itoa_buffer );
klauss 0:4d17cd9c8f9d 494 body[ SIP_MAXMSGSIZE - 1 ] = 0;
klauss 0:4d17cd9c8f9d 495
klauss 0:4d17cd9c8f9d 496 make_content_length( header, body, pkg );
klauss 0:4d17cd9c8f9d 497 return( pkg );
klauss 0:4d17cd9c8f9d 498 }
klauss 0:4d17cd9c8f9d 499
klauss 0:4d17cd9c8f9d 500 char * Sip::make_content_length( char * header, char * body, char * pkg ){
klauss 0:4d17cd9c8f9d 501 int size;
klauss 0:4d17cd9c8f9d 502 char itoa_buffer[ 65 ];
klauss 0:4d17cd9c8f9d 503 size = strlen( body );
klauss 0:4d17cd9c8f9d 504 strcpy( pkg, header );
klauss 0:4d17cd9c8f9d 505 strcat( pkg, "Content-Length: " );
klauss 0:4d17cd9c8f9d 506 itoa( size, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 507 strcat( pkg, itoa_buffer );
klauss 0:4d17cd9c8f9d 508 strcat( pkg, "\r\n\r\n" );
klauss 0:4d17cd9c8f9d 509 strcat( pkg, body );
klauss 0:4d17cd9c8f9d 510 pkg[ SIP_MAXMSGSIZE - 1 ] = 0;
klauss 0:4d17cd9c8f9d 511 return pkg;
klauss 0:4d17cd9c8f9d 512 }
klauss 0:4d17cd9c8f9d 513
klauss 0:4d17cd9c8f9d 514 char * Sip::build_bye_package( char * buffer ){
klauss 0:4d17cd9c8f9d 515 char branch[SIP_MAXFIELDSIZE];
klauss 0:4d17cd9c8f9d 516 char tag[SIP_MAXFIELDSIZE];
klauss 0:4d17cd9c8f9d 517 char itoa_buffer[ 65 ];
klauss 0:4d17cd9c8f9d 518 fill_random16h(branch);
klauss 0:4d17cd9c8f9d 519 fill_random(tag,18);
klauss 0:4d17cd9c8f9d 520
klauss 0:4d17cd9c8f9d 521 strcpy( buffer, "BYE sip:" );
klauss 0:4d17cd9c8f9d 522 itoa( this->peer_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 523 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 524 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 525 strcat( buffer, this->server_ip );
klauss 0:4d17cd9c8f9d 526 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 527 itoa( this->server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 528 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 529 strcat( buffer, " SIP/2.0\r\n" );
klauss 0:4d17cd9c8f9d 530 strcat( buffer, "Via: SIP/2.0/UDP " );
klauss 0:4d17cd9c8f9d 531 strcat( buffer, this->my_ip );
klauss 0:4d17cd9c8f9d 532 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 533 itoa( this->my_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 534 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 535 strcat( buffer, ";branch=" );
klauss 0:4d17cd9c8f9d 536 strcat( buffer, branch );
klauss 0:4d17cd9c8f9d 537 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 538 strcat( buffer, "From: " );
klauss 0:4d17cd9c8f9d 539 itoa( this->my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 540 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 541 strcat( buffer, " <sip:" );
klauss 0:4d17cd9c8f9d 542 itoa( this->my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 543 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 544 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 545 strcat( buffer, this->server_ip );
klauss 0:4d17cd9c8f9d 546 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 547 itoa( this->server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 548 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 549 strcat( buffer, ">;tag=" );
klauss 0:4d17cd9c8f9d 550 strcat( buffer, last_invite_tag );
klauss 0:4d17cd9c8f9d 551 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 552 strcat( buffer, "To: <sip:" );
klauss 0:4d17cd9c8f9d 553 itoa( this->peer_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 554 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 555 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 556 strcat( buffer, this->server_ip );
klauss 0:4d17cd9c8f9d 557 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 558 itoa( this->server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 559 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 560 strcat( buffer, ">;tag=" );
klauss 0:4d17cd9c8f9d 561 strcat( buffer, tag );
klauss 0:4d17cd9c8f9d 562 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 563 strcat( buffer, "Call-ID: " );
klauss 0:4d17cd9c8f9d 564 strcat( buffer, last_invite_callid );
klauss 0:4d17cd9c8f9d 565 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 566 strcat( buffer, this->my_ip );
klauss 0:4d17cd9c8f9d 567 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 568 strcat( buffer, "CSeq: " );
klauss 0:4d17cd9c8f9d 569 itoa( get_cseq(), itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 570 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 571 strcat( buffer, " BYE\r\n" );
klauss 0:4d17cd9c8f9d 572 strcat( buffer, "Max-Forwards: 70\r\n" );
klauss 0:4d17cd9c8f9d 573 strcat( buffer, "User-Agent: VZtech/pabxdriver-" );
klauss 0:4d17cd9c8f9d 574 strcat( buffer, SVNREV );
klauss 0:4d17cd9c8f9d 575 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 576 strcat( buffer, "Content-Length: 0\r\n\r\n" );
klauss 0:4d17cd9c8f9d 577 return( buffer );
klauss 0:4d17cd9c8f9d 578 }
klauss 0:4d17cd9c8f9d 579 char * Sip::build_ack_package( char * buffer, unsigned char * orig ){
klauss 0:4d17cd9c8f9d 580 char to[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 581 char from[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 582 char callid[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 583 char via[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 584 char branch[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 585 char cseq[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 586 char itoa_buffer[ 65 ];
klauss 0:4d17cd9c8f9d 587 // FIXME confirmar se nao preciso converter todos os ints com itoa
klauss 0:4d17cd9c8f9d 588 if( decode_gettag( orig, "to: ", to ) == 0) {
klauss 0:4d17cd9c8f9d 589 buffer[ 0 ] = 0;
klauss 0:4d17cd9c8f9d 590 return NULL;
klauss 0:4d17cd9c8f9d 591 }
klauss 0:4d17cd9c8f9d 592 if( decode_gettag( orig, "from: ", from ) == 0) {
klauss 0:4d17cd9c8f9d 593 buffer[ 0 ] = 0;
klauss 0:4d17cd9c8f9d 594 return NULL;
klauss 0:4d17cd9c8f9d 595 }
klauss 0:4d17cd9c8f9d 596 if( decode_gettag( orig, "call-id: ", callid ) == 0) {
klauss 0:4d17cd9c8f9d 597 buffer[ 0 ] = 0;
klauss 0:4d17cd9c8f9d 598 return NULL;
klauss 0:4d17cd9c8f9d 599 }
klauss 0:4d17cd9c8f9d 600 decode_branch( orig, branch );
klauss 0:4d17cd9c8f9d 601 decode_cseq( orig, cseq );
klauss 0:4d17cd9c8f9d 602
klauss 0:4d17cd9c8f9d 603 if( strlen( via ) > 6 ) {
klauss 0:4d17cd9c8f9d 604 if( strcasecmp( ";rport", via+strlen( via )-6) == 0) {
klauss 0:4d17cd9c8f9d 605 via[strlen(via)-6] = 0;
klauss 0:4d17cd9c8f9d 606 }
klauss 0:4d17cd9c8f9d 607 }
klauss 0:4d17cd9c8f9d 608 strcpy( buffer, "ACK sip:" );
klauss 0:4d17cd9c8f9d 609 itoa( this->peer_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 610 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 611 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 612 strcat( buffer, this->server_ip );
klauss 0:4d17cd9c8f9d 613 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 614 itoa( this->server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 615 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 616 strcat( buffer, " SIP/2.0\r\n" );
klauss 0:4d17cd9c8f9d 617 strcat( buffer, "Via: SIP/2.0/UDP " );
klauss 0:4d17cd9c8f9d 618 strcat( buffer, this->my_ip );
klauss 0:4d17cd9c8f9d 619 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 620 itoa( this->my_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 621 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 622 strcat( buffer, ";branch=" );
klauss 0:4d17cd9c8f9d 623 strcat( buffer, branch );
klauss 0:4d17cd9c8f9d 624 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 625 strcat( buffer, "From: " );
klauss 0:4d17cd9c8f9d 626 strcat( buffer, from );
klauss 0:4d17cd9c8f9d 627 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 628 strcat( buffer, "To: " );
klauss 0:4d17cd9c8f9d 629 strcat( buffer, to );
klauss 0:4d17cd9c8f9d 630 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 631 strcat( buffer, "Call-ID: " );
klauss 0:4d17cd9c8f9d 632 strcat( buffer, callid );
klauss 0:4d17cd9c8f9d 633 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 634 strcat( buffer, "CSeq: " );
klauss 0:4d17cd9c8f9d 635 strcat( buffer, cseq );
klauss 0:4d17cd9c8f9d 636 strcat( buffer, " ACK\r\n" );
klauss 0:4d17cd9c8f9d 637 strcat( buffer, "Max-Forwards: 70\r\n" );
klauss 0:4d17cd9c8f9d 638 strcat( buffer, "Contact: " );
klauss 0:4d17cd9c8f9d 639 itoa( this->my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 640 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 641 strcat( buffer, " <sip:" );
klauss 0:4d17cd9c8f9d 642 itoa( this->my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 643 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 644 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 645 strcat( buffer, this->my_ip );
klauss 0:4d17cd9c8f9d 646 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 647 itoa( this->my_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 648 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 649 strcat( buffer, ">\r\n" );
klauss 0:4d17cd9c8f9d 650 strcat( buffer, "User-Agent: VZtech/pabxdriver-" );
klauss 0:4d17cd9c8f9d 651 strcat( buffer, SVNREV );
klauss 0:4d17cd9c8f9d 652 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 653 strcat( buffer, "Content-Length: 0\r\n\r\n" );
klauss 0:4d17cd9c8f9d 654 buffer[SIP_MAXMSGSIZE-1] = 0;
klauss 0:4d17cd9c8f9d 655 return( buffer );
klauss 0:4d17cd9c8f9d 656 }
klauss 0:4d17cd9c8f9d 657
klauss 0:4d17cd9c8f9d 658 int Sip::get_return_code( char * buffer ){
klauss 0:4d17cd9c8f9d 659 char a[32];
klauss 0:4d17cd9c8f9d 660 int i = 0, j;
klauss 0:4d17cd9c8f9d 661 if( strncmp( "SIP/", buffer, 4 ) != 0 ) return 0;
klauss 0:4d17cd9c8f9d 662 if( strlen( buffer ) < 32) return 0;
klauss 0:4d17cd9c8f9d 663 strncpy( a, buffer, 31 );
klauss 0:4d17cd9c8f9d 664 a[ 31 ] = 0;
klauss 0:4d17cd9c8f9d 665 while ( a[ i ] > ' ') i++;
klauss 0:4d17cd9c8f9d 666 j = i+i;
klauss 0:4d17cd9c8f9d 667 while( (a[ j ] >= '0') && ( a[ j ] <= '9') ) j++;
klauss 0:4d17cd9c8f9d 668 a[ j ] = 0;
klauss 0:4d17cd9c8f9d 669 return atoi( a + i + 1 );
klauss 0:4d17cd9c8f9d 670 }
klauss 0:4d17cd9c8f9d 671
klauss 0:4d17cd9c8f9d 672 char * Sip::build_generic_reply_package(char * buffer, unsigned char * orig, char * tag){
klauss 0:4d17cd9c8f9d 673 char to[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 674 char from[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 675 char callid[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 676 char cseq[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 677 char via[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 678
klauss 0:4d17cd9c8f9d 679 if( decode_gettag( orig, "to: ", to ) == 0) {
klauss 0:4d17cd9c8f9d 680 buffer[0] = 0;
klauss 0:4d17cd9c8f9d 681 return NULL;
klauss 0:4d17cd9c8f9d 682 }
klauss 0:4d17cd9c8f9d 683 if( decode_gettag( orig, "from: ", from ) == 0) {
klauss 0:4d17cd9c8f9d 684 buffer[0] = 0;
klauss 0:4d17cd9c8f9d 685 return NULL;
klauss 0:4d17cd9c8f9d 686 }
klauss 0:4d17cd9c8f9d 687 if( decode_gettag( orig, "call-id: ", callid ) == 0) {
klauss 0:4d17cd9c8f9d 688 buffer[0] = 0;
klauss 0:4d17cd9c8f9d 689 return NULL;
klauss 0:4d17cd9c8f9d 690 }
klauss 0:4d17cd9c8f9d 691 if( decode_gettag( orig, "cseq: ", cseq ) == 0) {
klauss 0:4d17cd9c8f9d 692 buffer[0] = 0;
klauss 0:4d17cd9c8f9d 693 return NULL;
klauss 0:4d17cd9c8f9d 694 }
klauss 0:4d17cd9c8f9d 695 if( decode_gettag( orig, "via: ", via ) == 0) {
klauss 0:4d17cd9c8f9d 696 buffer[0] = 0;
klauss 0:4d17cd9c8f9d 697 return NULL;
klauss 0:4d17cd9c8f9d 698 }
klauss 0:4d17cd9c8f9d 699
klauss 0:4d17cd9c8f9d 700 if (strlen(via) > 6) {
klauss 0:4d17cd9c8f9d 701 if (strcasecmp(";rport",via+strlen(via)-6)==0) {
klauss 0:4d17cd9c8f9d 702 via[strlen(via)-6] = 0;
klauss 0:4d17cd9c8f9d 703 }
klauss 0:4d17cd9c8f9d 704 }
klauss 0:4d17cd9c8f9d 705
klauss 0:4d17cd9c8f9d 706 strcpy( buffer, "SIP/2.0 " );
klauss 0:4d17cd9c8f9d 707 strcat( buffer, tag );
klauss 0:4d17cd9c8f9d 708 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 709 strcat( buffer, "To: " );
klauss 0:4d17cd9c8f9d 710 strcat( buffer, to );
klauss 0:4d17cd9c8f9d 711 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 712 strcat( buffer, "From: " );
klauss 0:4d17cd9c8f9d 713 strcat( buffer, from );
klauss 0:4d17cd9c8f9d 714 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 715 strcat( buffer, "Call-ID: " );
klauss 0:4d17cd9c8f9d 716 strcat( buffer, callid );
klauss 0:4d17cd9c8f9d 717 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 718 strcat( buffer, "CSeq: " );
klauss 0:4d17cd9c8f9d 719 strcat( buffer, cseq );
klauss 0:4d17cd9c8f9d 720 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 721 strcat( buffer, "Via: " );
klauss 0:4d17cd9c8f9d 722 strcat( buffer, via );
klauss 0:4d17cd9c8f9d 723 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 724 strcat( buffer, "Server: VZtech/pabxdriver-" );
klauss 0:4d17cd9c8f9d 725 strcat( buffer, SVNREV );
klauss 0:4d17cd9c8f9d 726 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 727 strcat( buffer, "Content-Length: 0\r\n\r\n" );
klauss 0:4d17cd9c8f9d 728 buffer[ SIP_MAXMSGSIZE - 1 ] = 0;
klauss 0:4d17cd9c8f9d 729 return( buffer );
klauss 0:4d17cd9c8f9d 730 }
klauss 0:4d17cd9c8f9d 731 char * Sip::build_trying_package( char * buffer, unsigned char * orig ){
klauss 0:4d17cd9c8f9d 732 // FIXME trocar 100 para itoa( 100 ... )
klauss 0:4d17cd9c8f9d 733 build_generic_reply_package( buffer, orig, "100 Trying" );
klauss 0:4d17cd9c8f9d 734 return( buffer );
klauss 0:4d17cd9c8f9d 735 }
klauss 0:4d17cd9c8f9d 736
klauss 0:4d17cd9c8f9d 737 char * Sip::build_busy_package( char * buffer, unsigned char * orig ){
klauss 0:4d17cd9c8f9d 738 // FIXME trocar 100 para itoa( 100 ... )
klauss 0:4d17cd9c8f9d 739 build_generic_reply_package( buffer, orig, "486 Busy Here");
klauss 0:4d17cd9c8f9d 740 return( buffer );
klauss 0:4d17cd9c8f9d 741 }
klauss 0:4d17cd9c8f9d 742 char * Sip::build_reply_package( char * buffer, unsigned char * orig ){
klauss 0:4d17cd9c8f9d 743 char to[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 744 char from[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 745 char callid[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 746 char cseq[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 747 char via[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 748 char tag[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 749
klauss 0:4d17cd9c8f9d 750 if( decode_gettag( orig, "to: ", to ) == 0) {
klauss 0:4d17cd9c8f9d 751 buffer[ 0 ] = 0;
klauss 0:4d17cd9c8f9d 752 return NULL;
klauss 0:4d17cd9c8f9d 753 }
klauss 0:4d17cd9c8f9d 754 if( decode_gettag( orig, "from: ", from ) == 0) {
klauss 0:4d17cd9c8f9d 755 buffer[ 0 ] = 0;
klauss 0:4d17cd9c8f9d 756 return NULL;
klauss 0:4d17cd9c8f9d 757 }
klauss 0:4d17cd9c8f9d 758 if( decode_gettag( orig, "call-id: ", callid ) == 0 ) {
klauss 0:4d17cd9c8f9d 759 buffer[ 0 ] = 0;
klauss 0:4d17cd9c8f9d 760 return NULL;
klauss 0:4d17cd9c8f9d 761 }
klauss 0:4d17cd9c8f9d 762 if( decode_gettag( orig, "cseq: ", cseq) == 0 ) {
klauss 0:4d17cd9c8f9d 763 buffer[ 0 ] = 0;
klauss 0:4d17cd9c8f9d 764 return NULL;
klauss 0:4d17cd9c8f9d 765 }
klauss 0:4d17cd9c8f9d 766 if( decode_gettag( orig, "via: ", via) == 0 ) {
klauss 0:4d17cd9c8f9d 767 buffer[ 0 ] = 0;
klauss 0:4d17cd9c8f9d 768 return NULL;
klauss 0:4d17cd9c8f9d 769 }
klauss 0:4d17cd9c8f9d 770
klauss 0:4d17cd9c8f9d 771 if (strlen(via) > 6) {
klauss 0:4d17cd9c8f9d 772 if (strcasecmp(";rport",via+strlen(via)-6)==0) {
klauss 0:4d17cd9c8f9d 773 via[strlen(via)-6] = 0;
klauss 0:4d17cd9c8f9d 774 }
klauss 0:4d17cd9c8f9d 775 }
klauss 0:4d17cd9c8f9d 776 fill_random(tag,18);
klauss 0:4d17cd9c8f9d 777
klauss 0:4d17cd9c8f9d 778 strcpy( buffer, "SIP/2.0 200 OK\r\n" );
klauss 0:4d17cd9c8f9d 779 strcat( buffer, "To: " );
klauss 0:4d17cd9c8f9d 780 strcat( buffer, to );
klauss 0:4d17cd9c8f9d 781 strcat( buffer, ";tag=" );
klauss 0:4d17cd9c8f9d 782 strcat( buffer, tag );
klauss 0:4d17cd9c8f9d 783 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 784
klauss 0:4d17cd9c8f9d 785 strcat( buffer, "From: " );
klauss 0:4d17cd9c8f9d 786 strcat( buffer, from );
klauss 0:4d17cd9c8f9d 787 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 788
klauss 0:4d17cd9c8f9d 789 strcat( buffer, "Call-ID: " );
klauss 0:4d17cd9c8f9d 790 strcat( buffer, callid );
klauss 0:4d17cd9c8f9d 791 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 792
klauss 0:4d17cd9c8f9d 793 strcat( buffer, "CSeq: " );
klauss 0:4d17cd9c8f9d 794 strcat( buffer, cseq );
klauss 0:4d17cd9c8f9d 795 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 796
klauss 0:4d17cd9c8f9d 797 strcat( buffer, "Via: " );
klauss 0:4d17cd9c8f9d 798 strcat( buffer, via );
klauss 0:4d17cd9c8f9d 799 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 800
klauss 0:4d17cd9c8f9d 801 strcat( buffer, "Server: VZtech/pabxdriver-" );
klauss 0:4d17cd9c8f9d 802 strcat( buffer, SVNREV );
klauss 0:4d17cd9c8f9d 803 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 804 strcat( buffer, "Content-Length: 0\r\n" );
klauss 0:4d17cd9c8f9d 805 strcat( buffer, SIP_ALLOW );
klauss 0:4d17cd9c8f9d 806 strcat( buffer, "\r\n\r\n" );
klauss 0:4d17cd9c8f9d 807
klauss 0:4d17cd9c8f9d 808 buffer[ SIP_MAXMSGSIZE - 1 ] = 0;
klauss 0:4d17cd9c8f9d 809 return( buffer );
klauss 0:4d17cd9c8f9d 810 }
klauss 0:4d17cd9c8f9d 811 char * Sip::fill_random16h(char * buffer ){
klauss 0:4d17cd9c8f9d 812 fill_random( buffer, 16 );
klauss 0:4d17cd9c8f9d 813 buffer[ 7 ] = '-';
klauss 0:4d17cd9c8f9d 814 return( buffer );
klauss 0:4d17cd9c8f9d 815 }
klauss 0:4d17cd9c8f9d 816
klauss 0:4d17cd9c8f9d 817 char * Sip::fill_random( char * buffer, int size ){
klauss 0:4d17cd9c8f9d 818 static uint16_t seed = time( NULL );
klauss 0:4d17cd9c8f9d 819 seed += 1;
klauss 0:4d17cd9c8f9d 820 srand( seed );
klauss 0:4d17cd9c8f9d 821
klauss 0:4d17cd9c8f9d 822 int i;
klauss 0:4d17cd9c8f9d 823 for (i=0; i<size; i++) {
klauss 0:4d17cd9c8f9d 824 buffer[ i ] = fill_random_aux[ rand() & 0x3f ];
klauss 0:4d17cd9c8f9d 825 }
klauss 0:4d17cd9c8f9d 826 buffer[ size ] = 0;
klauss 0:4d17cd9c8f9d 827 return( buffer );
klauss 0:4d17cd9c8f9d 828 }
klauss 0:4d17cd9c8f9d 829
klauss 0:4d17cd9c8f9d 830 int Sip::get_cseq( void ){
klauss 0:4d17cd9c8f9d 831 static unsigned int cseq = 0;
klauss 0:4d17cd9c8f9d 832 if( cseq == 0 ) {
klauss 0:4d17cd9c8f9d 833 /* initial value, random number */
klauss 0:4d17cd9c8f9d 834 cseq = rand();
klauss 0:4d17cd9c8f9d 835 cseq &= 0x7fff;
klauss 0:4d17cd9c8f9d 836 }
klauss 0:4d17cd9c8f9d 837 cseq++;
klauss 0:4d17cd9c8f9d 838 cseq &= 0x7fff;
klauss 0:4d17cd9c8f9d 839 if( cseq == 0 ) cseq++;
klauss 0:4d17cd9c8f9d 840 return cseq;
klauss 0:4d17cd9c8f9d 841 }
klauss 0:4d17cd9c8f9d 842
klauss 0:4d17cd9c8f9d 843 char * Sip::decode_cseq( unsigned char * package, char * cseq ){
klauss 0:4d17cd9c8f9d 844 char pkg[ 2048 ], cs[ 2048 ];
klauss 0:4d17cd9c8f9d 845 if( decode_gettag( package, "cseq: ", pkg ) != 0) {
klauss 0:4d17cd9c8f9d 846 int i = 0;
klauss 0:4d17cd9c8f9d 847 strcpy( cs, pkg );
klauss 0:4d17cd9c8f9d 848 while( ( cs[ i ] != 0 ) && ( cs[ i ] != ' ' ) ) i++;
klauss 0:4d17cd9c8f9d 849 cs[ i ] = 0;
klauss 0:4d17cd9c8f9d 850 strcpy( cseq, cs );
klauss 0:4d17cd9c8f9d 851 } else {
klauss 0:4d17cd9c8f9d 852 cseq[ 0 ] = 0;
klauss 0:4d17cd9c8f9d 853 }
klauss 0:4d17cd9c8f9d 854 return( cseq );
klauss 0:4d17cd9c8f9d 855 }
klauss 0:4d17cd9c8f9d 856
klauss 0:4d17cd9c8f9d 857 char * Sip::decode_branch( unsigned char * package, char * branch ){
klauss 0:4d17cd9c8f9d 858 char pkg[ 2048 ];
klauss 0:4d17cd9c8f9d 859 if( decode_gettag( package, "branch=", pkg ) != 0 ) {
klauss 0:4d17cd9c8f9d 860 int i = 0;
klauss 0:4d17cd9c8f9d 861 strcpy( branch, pkg );
klauss 0:4d17cd9c8f9d 862 while( ( branch[ i ] != 0 ) && ( branch[ i ] != ';' ) ) i++;
klauss 0:4d17cd9c8f9d 863 branch[ i ] = 0;
klauss 0:4d17cd9c8f9d 864 } else {
klauss 0:4d17cd9c8f9d 865 branch[ 0 ] = 0;
klauss 0:4d17cd9c8f9d 866 }
klauss 0:4d17cd9c8f9d 867 return( branch );
klauss 0:4d17cd9c8f9d 868 }
klauss 0:4d17cd9c8f9d 869 int Sip::decode_gettag( unsigned char * package, char * tag, char * out ){
klauss 0:4d17cd9c8f9d 870 int size, i, cmpsize;
klauss 0:4d17cd9c8f9d 871 cmpsize = strlen( tag );
klauss 0:4d17cd9c8f9d 872 size = strlen( ( char * )package )-cmpsize;
klauss 0:4d17cd9c8f9d 873 for ( i=0; i<size; i++) {
klauss 0:4d17cd9c8f9d 874 if( strncasecmp( tag, (char*)package+i, cmpsize ) == 0) {
klauss 0:4d17cd9c8f9d 875 char * s;
klauss 0:4d17cd9c8f9d 876 s = (char*)package+i+cmpsize;
klauss 0:4d17cd9c8f9d 877 register int j = 0;
klauss 0:4d17cd9c8f9d 878 while ((s[ j ] != '\r') && (s[ j ] != '\n')) j++;
klauss 0:4d17cd9c8f9d 879 strncpy( out, s, j ); // copy string to output
klauss 0:4d17cd9c8f9d 880 out[ j ] = 0; // terminate string
klauss 0:4d17cd9c8f9d 881 return 1; // found
klauss 0:4d17cd9c8f9d 882 }
klauss 0:4d17cd9c8f9d 883 }
klauss 0:4d17cd9c8f9d 884 return 0; // not found
klauss 0:4d17cd9c8f9d 885 }
klauss 0:4d17cd9c8f9d 886
klauss 0:4d17cd9c8f9d 887 int Sip::get_id( void ){
klauss 0:4d17cd9c8f9d 888 return this->id;
klauss 0:4d17cd9c8f9d 889 }
klauss 0:4d17cd9c8f9d 890 int Sip::get_my_rtp_port( void ){
klauss 0:4d17cd9c8f9d 891 return this->my_rtp_port;
klauss 0:4d17cd9c8f9d 892 }
klauss 0:4d17cd9c8f9d 893 inline int Sip::fill_random_rtp_port(){
klauss 0:4d17cd9c8f9d 894 // o range [ 16384 - 32767 ] eh configuravel no server
klauss 4:de46f0d9b14d 895 return ( ( this->my_ext + 16384 ) );
klauss 0:4d17cd9c8f9d 896 }
klauss 0:4d17cd9c8f9d 897
klauss 0:4d17cd9c8f9d 898 void Sip::change_sip_server(){
klauss 0:4d17cd9c8f9d 899 // just in case sip server don't answer, invite another server
klauss 0:4d17cd9c8f9d 900 // mudar para os sets
klauss 0:4d17cd9c8f9d 901 set_server_ip( get_next_server_ip( this->buffer) );
klauss 0:4d17cd9c8f9d 902 set_server_ext( get_next_server_ext() );
klauss 0:4d17cd9c8f9d 903 set_server_port( get_next_server_port() );
klauss 0:4d17cd9c8f9d 904 registry();
klauss 0:4d17cd9c8f9d 905 }
klauss 0:4d17cd9c8f9d 906
klauss 0:4d17cd9c8f9d 907 char * Sip::get_next_server_ip( char * server_ip ){
klauss 0:4d17cd9c8f9d 908 strcpy( server_ip, this->server_ip );
klauss 0:4d17cd9c8f9d 909 return server_ip;
klauss 0:4d17cd9c8f9d 910 }
klauss 0:4d17cd9c8f9d 911 int Sip::get_next_server_port(){
klauss 0:4d17cd9c8f9d 912 return this->server_port;
klauss 0:4d17cd9c8f9d 913 }
klauss 0:4d17cd9c8f9d 914 int Sip::get_next_server_ext(){
klauss 0:4d17cd9c8f9d 915 return this->peer_ext;
klauss 0:4d17cd9c8f9d 916 }
klauss 0:4d17cd9c8f9d 917 void Sip::set_server_port( int new_server_port ){
klauss 0:4d17cd9c8f9d 918 this->server_port = new_server_port;
klauss 0:4d17cd9c8f9d 919 }
klauss 0:4d17cd9c8f9d 920 void Sip::set_server_ext( int new_server_ext ){
klauss 0:4d17cd9c8f9d 921 this->peer_ext = new_server_ext;
klauss 0:4d17cd9c8f9d 922 }
klauss 0:4d17cd9c8f9d 923 void Sip::set_server_ip( char * new_server_ip ){
klauss 0:4d17cd9c8f9d 924 strcpy( this->server_ip, new_server_ip );
klauss 0:4d17cd9c8f9d 925 this->server_ip[19] = 0;
klauss 0:4d17cd9c8f9d 926 }
klauss 0:4d17cd9c8f9d 927
klauss 0:4d17cd9c8f9d 928 /* Retorna
klauss 0:4d17cd9c8f9d 929 = 0 :: ok
klauss 0:4d17cd9c8f9d 930 < 0 :: tive problemas
klauss 0:4d17cd9c8f9d 931 > 0 :: devo remover essa call do vetor de calls
klauss 0:4d17cd9c8f9d 932 */
klauss 0:4d17cd9c8f9d 933 int Sip::listen_SIP_server( void ){
klauss 14:22a35f575502 934 sock.set_blocking( false, 1 );
klauss 15:9c7456c1b6f4 935 //debug_msg("");
klauss 0:4d17cd9c8f9d 936 uint8_t read = sock.receiveFrom( sip_server, this->buffer, sizeof( this->buffer ) );
klauss 9:ffa64f38ef9c 937 if( read > 0 ){
klauss 13:ae278302dffe 938 //debug_msg( "-- SIP recebeu algo --" );
klauss 0:4d17cd9c8f9d 939 if( !( strncasecmp( buffer, "bye", strlen("bye") ) ) ){
klauss 13:ae278302dffe 940 char ans[ 2000 ];
klauss 0:4d17cd9c8f9d 941 build_reply_package( ans, (unsigned char*)buffer );
klauss 13:ae278302dffe 942 sock.sendTo( sip_server, ans, sizeof( ans ) );
klauss 13:ae278302dffe 943 debug_msg(" Server request BYE to %d ext", my_ext );
klauss 0:4d17cd9c8f9d 944 return( this->my_ext );
klauss 0:4d17cd9c8f9d 945 }else if( !( strncasecmp( buffer, "options", strlen("options") ) ) ){
klauss 13:ae278302dffe 946 char ans[ 2000 ];
klauss 13:ae278302dffe 947 debug_msg(" Options received ");
klauss 0:4d17cd9c8f9d 948 build_reply_package( ans, (unsigned char*)buffer );
klauss 13:ae278302dffe 949 sock.sendTo( sip_server, ans, sizeof( ans ) );
klauss 15:9c7456c1b6f4 950 //debug_msg("");
klauss 0:4d17cd9c8f9d 951 }
klauss 0:4d17cd9c8f9d 952 }
klauss 0:4d17cd9c8f9d 953 return( 0 );
klauss 0:4d17cd9c8f9d 954 }
klauss 0:4d17cd9c8f9d 955
klauss 0:4d17cd9c8f9d 956 void Sip::set_ext( int ext ){
klauss 0:4d17cd9c8f9d 957 my_ext = ext;
klauss 0:4d17cd9c8f9d 958 }
klauss 0:4d17cd9c8f9d 959
klauss 0:4d17cd9c8f9d 960 void Sip::set_port( int port ){
klauss 0:4d17cd9c8f9d 961 my_port = port;
klauss 0:4d17cd9c8f9d 962 }
klauss 0:4d17cd9c8f9d 963
klauss 0:4d17cd9c8f9d 964 void Sip::send_bye( void ){
klauss 0:4d17cd9c8f9d 965 build_bye_package( this->buffer );
klauss 0:4d17cd9c8f9d 966 sock.sendTo( sip_server, build_bye_package( this->buffer ), sizeof( this->buffer ) );
klauss 0:4d17cd9c8f9d 967 }
klauss 0:4d17cd9c8f9d 968
klauss 0:4d17cd9c8f9d 969 void Sip::send_unregistry_pkg(){
klauss 0:4d17cd9c8f9d 970 build_unregistry_package( this->buffer );
klauss 0:4d17cd9c8f9d 971 for( register int i = 0; i < 7; i++ )
klauss 0:4d17cd9c8f9d 972 sock.sendTo( sip_server, build_bye_package( this->buffer ), sizeof( this->buffer ) );
klauss 0:4d17cd9c8f9d 973 }
klauss 0:4d17cd9c8f9d 974
klauss 0:4d17cd9c8f9d 975 char * Sip::build_unregistry_package( char * buffer ){
klauss 0:4d17cd9c8f9d 976 char branch[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 977 char tag[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 978 char callid[ SIP_MAXFIELDSIZE ];
klauss 0:4d17cd9c8f9d 979 fill_random16h( branch );
klauss 0:4d17cd9c8f9d 980 fill_random( tag, 18 );
klauss 0:4d17cd9c8f9d 981 fill_random16h( callid );
klauss 0:4d17cd9c8f9d 982 char itoa_buffer[ 65 ];
klauss 0:4d17cd9c8f9d 983 strcpy( buffer, "REGISTER sip:" );
klauss 0:4d17cd9c8f9d 984 strcat( buffer, server_ip );
klauss 0:4d17cd9c8f9d 985 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 986 itoa( server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 987 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 988 strcat( buffer, " SIP/2.0\r\nVia: SIP/2.0/UDP " );
klauss 0:4d17cd9c8f9d 989 strcat( buffer, my_ip );
klauss 0:4d17cd9c8f9d 990 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 991 itoa( my_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 992 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 993 strcat( buffer, ";branch=" );
klauss 0:4d17cd9c8f9d 994 strcat( buffer, branch );
klauss 0:4d17cd9c8f9d 995 strcat( buffer, "\r\nFrom: " );
klauss 0:4d17cd9c8f9d 996 itoa( my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 997 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 998 strcat( buffer, " <sip:" );
klauss 0:4d17cd9c8f9d 999 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 1000 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 1001 strcat( buffer, server_ip );
klauss 0:4d17cd9c8f9d 1002 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 1003 itoa( server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 1004 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 1005 strcat( buffer, ">;tag=" );
klauss 0:4d17cd9c8f9d 1006 strcat( buffer, tag );
klauss 0:4d17cd9c8f9d 1007 strcat( buffer, "\r\nTo: " );
klauss 0:4d17cd9c8f9d 1008 itoa( my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 1009 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 1010 strcat( buffer, " <sip:" );
klauss 0:4d17cd9c8f9d 1011 itoa( my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 1012 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 1013 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 1014 strcat( buffer, server_ip );
klauss 0:4d17cd9c8f9d 1015 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 1016 itoa( server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 1017 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 1018 strcat( buffer, ">\r\nCall-ID: " );
klauss 0:4d17cd9c8f9d 1019 strcat( buffer, callid );
klauss 0:4d17cd9c8f9d 1020 strcat( buffer, "\r\nCSeq: " );
klauss 0:4d17cd9c8f9d 1021 itoa( get_cseq(), itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 1022 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 1023 strcat( buffer, " REGISTER\r\n" );
klauss 0:4d17cd9c8f9d 1024 strcat( buffer, "Max-Forwards: " );
klauss 0:4d17cd9c8f9d 1025 itoa( 70, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 1026 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 1027 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 1028
klauss 0:4d17cd9c8f9d 1029 strcat( buffer, "Contact: " );
klauss 0:4d17cd9c8f9d 1030 itoa( my_ext, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 1031 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 1032 strcat( buffer, " <sip:" );
klauss 0:4d17cd9c8f9d 1033 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 1034 strcat( buffer, "@" );
klauss 0:4d17cd9c8f9d 1035 strcat( buffer, my_ip );
klauss 0:4d17cd9c8f9d 1036 strcat( buffer, ":" );
klauss 0:4d17cd9c8f9d 1037 itoa( server_port, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 1038 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 1039 strcat( buffer, ">;expires=0\r\n" );
klauss 0:4d17cd9c8f9d 1040 /*
klauss 0:4d17cd9c8f9d 1041 strcat( buffer, ">;expires=" );
klauss 0:4d17cd9c8f9d 1042 itoa( 0, itoa_buffer, 10 );
klauss 0:4d17cd9c8f9d 1043 strcat( buffer, itoa_buffer );
klauss 0:4d17cd9c8f9d 1044 strcat( buffer, "\r\n" );
klauss 0:4d17cd9c8f9d 1045 */
klauss 0:4d17cd9c8f9d 1046
klauss 0:4d17cd9c8f9d 1047 strcat( buffer, "User-Agent: VZtech/pabxdriver-" );
klauss 0:4d17cd9c8f9d 1048 strcat( buffer, SVNREV );
klauss 0:4d17cd9c8f9d 1049 strcat( buffer, "\r\nContent-Length: 0\r\n" );
klauss 0:4d17cd9c8f9d 1050 strcat( buffer, SIP_ALLOW );
klauss 0:4d17cd9c8f9d 1051 strcat( buffer, "\r\n\r\n" );
klauss 0:4d17cd9c8f9d 1052 buffer[ SIP_MAXMSGSIZE - 1 ] = 0;
klauss 0:4d17cd9c8f9d 1053 return buffer;
klauss 0:4d17cd9c8f9d 1054 }