Modularizando o src

Dependencies:   EALib EthernetInterface_vz mbed-rtos mbed

Fork of header_main_colinas_V0-20-09-14 by VZTECH

Committer:
klauss
Date:
Thu Jan 08 23:44:08 2015 +0000
Revision:
91:c2a86b1f8aaa
Parent:
89:0fe315117b00
Child:
92:92df17f538a8
- melhorias no tratamento dos pacotes udp, melhorando o tratamento da fila, evitando que ela transborde

Who changed what in which revision?

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