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

sip.cpp@33:735fd60e96d8, 2014-09-30 (annotated)

Committer:
klauss
Date:
Tue Sep 30 11:37:31 2014 +0000
Revision:
33:735fd60e96d8
Parent:
29:7246460b73f8
Child:
38:af5ecd6997ab
versao 1 do protocolo de comunicao udp pra comunicao externa com a header e consequentemente, criacao do bootloader

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