sip.cpp

   1 /*****************************************************************************\
   2 **                                                                           **
   3 ** Linux Call Router                                                         **
   4 **                                                                           **
   5 **---------------------------------------------------------------------------**
   6 ** Copyright: Andreas Eversberg                                              **
   7 **                                                                           **
   8 ** SIP port                                                                  **
   9 **                                                                           **
  10 \*****************************************************************************/
  11
  12 #include "main.h"
  13 #include <sofia-sip/sip_status.h>
  14 #include <sofia-sip/su_log.h>
  15 #include <sofia-sip/sdp.h>
  16 #include <sofia-sip/sip_header.h>
  17
  18 #undef NUTAG_AUTO100
  19
  20 unsigned char flip[256];
  21
  22 int any_sip_interface = 0;
  23
  24 //pthread_mutex_t mutex_msg;
  25 su_home_t       sip_home[1];
  26
  27 struct sip_inst {
  28         char                    interface_name[64];
  29         char                    local_peer[32];
  30         char                    remote_peer[32];
  31         su_root_t               *root;
  32         nua_t                   *nua;
  33 };
  34
  35 static int delete_event(struct lcr_work *work, void *instance, int index);
  36 static int load_timer(struct lcr_timer *timer, void *instance, int index);
  37
  38 /*
  39  * initialize SIP port
  40  */
  41 Psip::Psip(int type, char *portname, struct port_settings *settings, struct interface *interface) : Port(type, portname, settings, interface)
  42 {
  43         p_s_rtp_bridge = 0;
  44         if (interface->rtp_bridge)
  45                 p_s_rtp_bridge = 1;
  46         p_s_sip_inst = interface->sip_inst;
  47         memset(&p_s_delete, 0, sizeof(p_s_delete));
  48         add_work(&p_s_delete, delete_event, this, 0);
  49         p_s_handle = 0;
  50         p_s_magic = 0;
  51         memset(&p_s_rtp_fd, 0, sizeof(p_s_rtp_fd));
  52         memset(&p_s_rtcp_fd, 0, sizeof(p_s_rtcp_fd));
  53         memset(&p_s_rtp_sin_local, 0, sizeof(p_s_rtp_sin_local));
  54         memset(&p_s_rtcp_sin_local, 0, sizeof(p_s_rtcp_sin_local));
  55         memset(&p_s_rtp_sin_remote, 0, sizeof(p_s_rtp_sin_remote));
  56         memset(&p_s_rtcp_sin_remote, 0, sizeof(p_s_rtcp_sin_remote));
  57         p_s_rtp_ip_local = 0;
  58         p_s_rtp_ip_remote = 0;
  59         p_s_rtp_port_local = 0;
  60         p_s_rtp_port_remote = 0;
  61         p_s_b_sock = -1;
  62         p_s_b_index = -1;
  63         p_s_b_active = 0;
  64         p_s_rxpos = 0;
  65         p_s_rtp_tx_action = 0;
  66
  67         /* audio */
  68         memset(&p_s_loadtimer, 0, sizeof(p_s_loadtimer));
  69         add_timer(&p_s_loadtimer, load_timer, this, 0);
  70         p_s_next_tv_sec = 0;
  71
  72         PDEBUG(DEBUG_SIP, "Created new Psip(%s).\n", portname);
  73         if (!p_s_sip_inst)
  74                 FATAL("No SIP instance for interface\n");
  75 }
  76
  77
  78 /*
  79  * destructor
  80  */
  81 Psip::~Psip()
  82 {
  83         PDEBUG(DEBUG_SIP, "Destroyed SIP process(%s).\n", p_name);
  84
  85         del_timer(&p_s_loadtimer);
  86         del_work(&p_s_delete);
  87
  88         rtp_close();
  89 }
  90
  91 static const char *media_type2name(uint8_t media_type) {
  92         switch (media_type) {
  93         case MEDIA_TYPE_ULAW:
  94                 return "PCMU";
  95         case MEDIA_TYPE_ALAW:
  96                 return "PCMA";
  97         case MEDIA_TYPE_GSM:
  98                 return "GSM";
  99         case MEDIA_TYPE_GSM_HR:
 100                 return "GSM-HR";
 101         case MEDIA_TYPE_GSM_EFR:
 102                 return "GSM-EFR";
 103         case MEDIA_TYPE_AMR:
 104                 return "AMR";
 105         }
 106
 107         return "UKN";
 108 }
 109
 110 static void sip_trace_header(class Psip *sip, const char *message, int direction)
 111 {
 112         /* init trace with given values */
 113         start_trace(-1,
 114                     NULL,
 115                     sip?numberrize_callerinfo(sip->p_callerinfo.id, sip->p_callerinfo.ntype, options.national, options.international):NULL,
 116                     sip?sip->p_dialinginfo.id:NULL,
 117                     direction,
 118                     CATEGORY_CH,
 119                     sip?sip->p_serial:0,
 120                     message);
 121 }
 122
 123 /*
 124  * RTP
 125  */
 126
 127 /* according to RFC 3550 */
 128 struct rtp_hdr {
 129 #if __BYTE_ORDER == __LITTLE_ENDIAN
 130         uint8_t  csrc_count:4,
 131                   extension:1,
 132                   padding:1,
 133                   version:2;
 134         uint8_t  payload_type:7,
 135                   marker:1;
 136 #elif __BYTE_ORDER == __BIG_ENDIAN
 137         uint8_t  version:2,
 138                   padding:1,
 139                   extension:1,
 140                   csrc_count:4;
 141         uint8_t  marker:1,
 142                   payload_type:7;
 143 #endif
 144         uint16_t sequence;
 145         uint32_t timestamp;
 146         uint32_t ssrc;
 147 } __attribute__((packed));
 148
 149 struct rtp_x_hdr {
 150         uint16_t by_profile;
 151         uint16_t length;
 152 } __attribute__((packed));
 153
 154 #define RTP_VERSION     2
 155
 156 #define PAYLOAD_TYPE_ULAW 0
 157 #define PAYLOAD_TYPE_ALAW 8
 158 #define PAYLOAD_TYPE_GSM 3
 159
 160 /* decode an rtp frame  */
 161 static int rtp_decode(class Psip *psip, unsigned char *data, int len)
 162 {
 163         struct rtp_hdr *rtph = (struct rtp_hdr *)data;
 164         struct rtp_x_hdr *rtpxh;
 165         uint8_t *payload;
 166         int payload_len;
 167         int x_len;
 168         unsigned char *from, *to;
 169         int n;
 170
 171         if (len < 12) {
 172                 PDEBUG(DEBUG_SIP, "received RTP frame too short (len = %d)\n", len);
 173                 return -EINVAL;
 174         }
 175         if (rtph->version != RTP_VERSION) {
 176                 PDEBUG(DEBUG_SIP, "received RTP version %d not supported.\n", rtph->version);
 177                 return -EINVAL;
 178         }
 179         payload = data + sizeof(struct rtp_hdr) + (rtph->csrc_count << 2);
 180         payload_len = len - sizeof(struct rtp_hdr) - (rtph->csrc_count << 2);
 181         if (payload_len < 0) {
 182                 PDEBUG(DEBUG_SIP, "received RTP frame too short (len = %d, "
 183                         "csrc count = %d)\n", len, rtph->csrc_count);
 184                 return -EINVAL;
 185         }
 186         if (rtph->extension) {
 187                 if (payload_len < (int)sizeof(struct rtp_x_hdr)) {
 188                         PDEBUG(DEBUG_SIP, "received RTP frame too short for "
 189                                 "extension header\n");
 190                         return -EINVAL;
 191                 }
 192                 rtpxh = (struct rtp_x_hdr *)payload;
 193                 x_len = ntohs(rtpxh->length) * 4 + sizeof(struct rtp_x_hdr);
 194                 payload += x_len;
 195                 payload_len -= x_len;
 196                 if (payload_len < 0) {
 197                         PDEBUG(DEBUG_SIP, "received RTP frame too short, "
 198                                 "extension header exceeds frame length\n");
 199                         return -EINVAL;
 200                 }
 201         }
 202         if (rtph->padding) {
 203                 if (payload_len < 0) {
 204                         PDEBUG(DEBUG_SIP, "received RTP frame too short for "
 205                                 "padding length\n");
 206                         return -EINVAL;
 207                 }
 208                 payload_len -= payload[payload_len - 1];
 209                 if (payload_len < 0) {
 210                         PDEBUG(DEBUG_SIP, "received RTP frame with padding "
 211                                 "greater than payload\n");
 212                         return -EINVAL;
 213                 }
 214         }
 215
 216         switch (rtph->payload_type) {
 217 #if 0
 218 we only support alaw and ulaw!
 219         case RTP_PT_GSM_FULL:
 220                 if (payload_len != 33) {
 221                         PDEBUG(DEBUG_SIP, "received RTP full rate frame with "
 222                                 "payload length != 33 (len = %d)\n",
 223                                 payload_len);
 224                         return -EINVAL;
 225                 }
 226                 break;
 227         case RTP_PT_GSM_EFR:
 228                 if (payload_len != 31) {
 229                         PDEBUG(DEBUG_SIP, "received RTP full rate frame with "
 230                                 "payload length != 31 (len = %d)\n",
 231                                 payload_len);
 232                         return -EINVAL;
 233                 }
 234                 break;
 235         case RTP_PT_GSM_HALF:
 236                 if (payload_len != 14) {
 237                         PDEBUG(DEBUG_SIP, "received RTP half rate frame with "
 238                                 "payload length != 14 (len = %d)\n",
 239                                 payload_len);
 240                         return -EINVAL;
 241                 }
 242                 break;
 243 #endif
 244         case PAYLOAD_TYPE_ALAW:
 245                 if (options.law != 'a') {
 246                         PDEBUG(DEBUG_SIP, "received Alaw, but we don't do Alaw\n");
 247                         return -EINVAL;
 248                 }
 249                 break;
 250         case PAYLOAD_TYPE_ULAW:
 251                 if (options.law == 'a') {
 252                         PDEBUG(DEBUG_SIP, "received Ulaw, but we don't do Ulaw\n");
 253                         return -EINVAL;
 254                 }
 255                 break;
 256         default:
 257                 PDEBUG(DEBUG_SIP, "received RTP frame with unknown payload "
 258                         "type %d\n", rtph->payload_type);
 259                 return -EINVAL;
 260         }
 261
 262         if (payload_len <= 0) {
 263                 PDEBUG(DEBUG_SIP, "received RTP payload is too small: %d\n", payload_len);
 264                 return 0;
 265         }
 266
 267         /* record audio */
 268         if (psip->p_record)
 269                 psip->record(payload, payload_len, 0); // from down
 270         if (psip->p_tap)
 271                 psip->tap(payload, payload_len, 0); // from down
 272
 273         n = payload_len;
 274         from = payload;
 275         to = payload;
 276         if (psip->p_echotest) {
 277                 /* echo rtp data we just received */
 278                 psip->rtp_send_frame(from, n, (options.law=='a')?PAYLOAD_TYPE_ALAW:PAYLOAD_TYPE_ULAW);
 279                 return 0;
 280         }
 281         while(n--)
 282                 *to++ = flip[*from++];
 283         psip->bridge_tx(payload, payload_len);
 284
 285         return 0;
 286 }
 287
 288 static int rtp_sock_callback(struct lcr_fd *fd, unsigned int what, void *instance, int index)
 289 {
 290         class Psip *psip = (class Psip *) instance;
 291         int len;
 292         unsigned char buffer[256];
 293         int rc = 0;
 294
 295         if ((what & LCR_FD_READ)) {
 296                 len = read(fd->fd, &buffer, sizeof(buffer));
 297                 if (len <= 0) {
 298                         PDEBUG(DEBUG_SIP, "read result=%d\n", len);
 299 //                      psip->rtp_close();
 300 //                      psip->rtp_shutdown();
 301                         return len;
 302                 }
 303                 if (psip->p_s_rtp_is_connected)
 304                         rc = rtp_decode(psip, buffer, len);
 305         }
 306
 307         return rc;
 308 }
 309
 310 static int rtcp_sock_callback(struct lcr_fd *fd, unsigned int what, void *instance, int index)
 311 {
 312 //      class Psip *psip = (class Psip *) instance;
 313         int len;
 314         unsigned char buffer[256];
 315
 316         if ((what & LCR_FD_READ)) {
 317                 len = read(fd->fd, &buffer, sizeof(buffer));
 318                 if (len <= 0) {
 319                         PDEBUG(DEBUG_SIP, "read result=%d\n", len);
 320 //                      psip->rtp_close();
 321 //                      psip->rtp_shutdown();
 322                         return len;
 323                 }
 324                 PDEBUG(DEBUG_SIP, "rtcp!\n");
 325         }
 326
 327         return 0;
 328 }
 329
 330 #define RTP_PORT_BASE   30000
 331 #define RTP_PORT_MAX    39998
 332 static unsigned short next_udp_port = RTP_PORT_BASE;
 333
 334 static int rtp_sub_socket_bind(int fd, struct sockaddr_in *sin_local, uint32_t ip, uint16_t port)
 335 {
 336         int rc;
 337         socklen_t alen = sizeof(*sin_local);
 338
 339         sin_local->sin_family = AF_INET;
 340         sin_local->sin_addr.s_addr = htonl(ip);
 341         sin_local->sin_port = htons(port);
 342
 343         rc = bind(fd, (struct sockaddr *) sin_local, sizeof(*sin_local));
 344         if (rc < 0)
 345                 return rc;
 346
 347         /* retrieve the address we actually bound to, in case we
 348          * passed INADDR_ANY as IP address */
 349         return getsockname(fd, (struct sockaddr *) sin_local, &alen);
 350 }
 351
 352 static int rtp_sub_socket_connect(int fd, struct sockaddr_in *sin_local, struct sockaddr_in *sin_remote, uint32_t ip, uint16_t port)
 353 {
 354         int rc;
 355         socklen_t alen = sizeof(*sin_local);
 356
 357         sin_remote->sin_family = AF_INET;
 358         sin_remote->sin_addr.s_addr = htonl(ip);
 359         sin_remote->sin_port = htons(port);
 360
 361         rc = connect(fd, (struct sockaddr *) sin_remote, sizeof(*sin_remote));
 362         if (rc < 0) {
 363                 PERROR("failed to connect to ip %08x port %d rc=%d\n", ip, port, rc);
 364                 return rc;
 365         }
 366
 367         return getsockname(fd, (struct sockaddr *) sin_local, &alen);
 368 }
 369
 370 int Psip::rtp_open(void)
 371 {
 372         int rc, rc2;
 373         struct in_addr ia;
 374         unsigned int ip;
 375         unsigned short start_port;
 376
 377         /* create socket */
 378         rc = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
 379         if (rc < 0) {
 380                 rtp_close();
 381                 return -EIO;
 382         }
 383         p_s_rtp_fd.fd = rc;
 384         register_fd(&p_s_rtp_fd, LCR_FD_READ, rtp_sock_callback, this, 0);
 385
 386         rc = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
 387         if (rc < 0) {
 388                 rtp_close();
 389                 return -EIO;
 390         }
 391         p_s_rtcp_fd.fd = rc;
 392         register_fd(&p_s_rtcp_fd, LCR_FD_READ, rtcp_sock_callback, this, 0);
 393
 394         /* bind socket */
 395         ip = htonl(INADDR_ANY);
 396         ia.s_addr = ip;
 397         start_port = next_udp_port;
 398         while (1) {
 399                 rc = rtp_sub_socket_bind(p_s_rtp_fd.fd, &p_s_rtp_sin_local, ip, next_udp_port);
 400                 if (rc != 0)
 401                         goto try_next_port;
 402
 403                 rc = rtp_sub_socket_bind(p_s_rtcp_fd.fd, &p_s_rtcp_sin_local, ip, next_udp_port + 1);
 404                 if (rc == 0) {
 405                         p_s_rtp_port_local = next_udp_port;
 406                         next_udp_port = (next_udp_port + 2 > RTP_PORT_MAX) ? RTP_PORT_BASE : next_udp_port + 2;
 407                         break;
 408                 }
 409                 /* reopen rtp socket and try again with next udp port */
 410                 unregister_fd(&p_s_rtp_fd);
 411                 close(p_s_rtp_fd.fd);
 412                 p_s_rtp_fd.fd = 0;
 413                 rc2 = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
 414                 if (rc2 < 0) {
 415                         rtp_close();
 416                         return -EIO;
 417                 }
 418                 p_s_rtp_fd.fd = rc2;
 419                 register_fd(&p_s_rtp_fd, LCR_FD_READ, rtp_sock_callback, this, 0);
 420
 421 try_next_port:
 422                 next_udp_port = (next_udp_port + 2 > RTP_PORT_MAX) ? RTP_PORT_BASE : next_udp_port + 2;
 423                 if (next_udp_port == start_port)
 424                         break;
 425                 /* we must use rc2, in order to preserve rc */
 426         }
 427         if (rc < 0) {
 428                 PDEBUG(DEBUG_SIP, "failed to find port\n");
 429                 rtp_close();
 430                 return rc;
 431         }
 432         p_s_rtp_ip_local = ntohl(p_s_rtp_sin_local.sin_addr.s_addr);
 433         PDEBUG(DEBUG_SIP, "local ip %08x port %d\n", p_s_rtp_ip_local, p_s_rtp_port_local);
 434         PDEBUG(DEBUG_SIP, "remote ip %08x port %d\n", p_s_rtp_ip_remote, p_s_rtp_port_remote);
 435
 436         return p_s_rtp_port_local;
 437 }
 438
 439 int Psip::rtp_connect(void)
 440 {
 441         int rc;
 442         struct in_addr ia;
 443
 444         ia.s_addr = htonl(p_s_rtp_ip_remote);
 445         PDEBUG(DEBUG_SIP, "rtp_connect(ip=%s, port=%u)\n", inet_ntoa(ia), p_s_rtp_port_remote);
 446
 447         rc = rtp_sub_socket_connect(p_s_rtp_fd.fd, &p_s_rtp_sin_local, &p_s_rtp_sin_remote, p_s_rtp_ip_remote, p_s_rtp_port_remote);
 448         if (rc < 0)
 449                 return rc;
 450
 451         rc = rtp_sub_socket_connect(p_s_rtcp_fd.fd, &p_s_rtcp_sin_local, &p_s_rtcp_sin_remote, p_s_rtp_ip_remote, p_s_rtp_port_remote + 1);
 452         if (rc < 0)
 453                 return rc;
 454
 455         p_s_rtp_ip_local = ntohl(p_s_rtp_sin_local.sin_addr.s_addr);
 456         PDEBUG(DEBUG_SIP, "local ip %08x port %d\n", p_s_rtp_ip_local, p_s_rtp_port_local);
 457         PDEBUG(DEBUG_SIP, "remote ip %08x port %d\n", p_s_rtp_ip_remote, p_s_rtp_port_remote);
 458         p_s_rtp_is_connected = 1;
 459
 460         return 0;
 461 }
 462 void Psip::rtp_close(void)
 463 {
 464         if (p_s_rtp_fd.fd > 0) {
 465                 unregister_fd(&p_s_rtp_fd);
 466                 close(p_s_rtp_fd.fd);
 467                 p_s_rtp_fd.fd = 0;
 468         }
 469         if (p_s_rtcp_fd.fd > 0) {
 470                 unregister_fd(&p_s_rtcp_fd);
 471                 close(p_s_rtcp_fd.fd);
 472                 p_s_rtcp_fd.fd = 0;
 473         }
 474         if (p_s_rtp_is_connected) {
 475                 PDEBUG(DEBUG_SIP, "rtp closed\n");
 476                 p_s_rtp_is_connected = 0;
 477         }
 478 }
 479
 480 /* "to - from" */
 481 void tv_difference(struct timeval *diff, const struct timeval *from,
 482                           const struct timeval *__to)
 483 {
 484         struct timeval _to = *__to, *to = &_to;
 485
 486         if (to->tv_usec < from->tv_usec) {
 487                 to->tv_sec -= 1;
 488                 to->tv_usec += 1000000;
 489         }
 490
 491         diff->tv_usec = to->tv_usec - from->tv_usec;
 492         diff->tv_sec = to->tv_sec - from->tv_sec;
 493 }
 494
 495 /* encode and send a rtp frame */
 496 int Psip::rtp_send_frame(unsigned char *data, unsigned int len, uint8_t payload_type)
 497 {
 498         struct rtp_hdr *rtph;
 499         int payload_len;
 500         int duration; /* in samples */
 501         unsigned char buffer[256];
 502
 503         /* record audio */
 504         if (p_record)
 505                 record(data, len, 1); // from up
 506         if (p_tap)
 507                 tap(data, len, 1); // from up
 508
 509         if (!p_s_rtp_is_connected) {
 510                 /* drop silently */
 511                 return 0;
 512         }
 513
 514         if (!p_s_rtp_tx_action) {
 515                 /* initialize sequences */
 516                 p_s_rtp_tx_action = 1;
 517                 p_s_rtp_tx_ssrc = rand();
 518                 p_s_rtp_tx_sequence = random();
 519                 p_s_rtp_tx_timestamp = random();
 520                 memset(&p_s_rtp_tx_last_tv, 0, sizeof(p_s_rtp_tx_last_tv));
 521         }
 522
 523         switch (payload_type) {
 524 #if 0
 525 we only support alaw and ulaw!
 526         case RTP_PT_GSM_FULL:
 527                 payload_len = 33;
 528                 duration = 160;
 529                 break;
 530         case RTP_PT_GSM_EFR:
 531                 payload_len = 31;
 532                 duration = 160;
 533                 break;
 534         case RTP_PT_GSM_HALF:
 535                 payload_len = 14;
 536                 duration = 160;
 537                 break;
 538 #endif
 539         case PAYLOAD_TYPE_ALAW:
 540         case PAYLOAD_TYPE_ULAW:
 541                 payload_len = len;
 542                 duration = len;
 543                 break;
 544         default:
 545                 PERROR("unsupported message type %d\n", payload_type);
 546                 return -EINVAL;
 547         }
 548
 549 #if 0
 550         {
 551                 struct timeval tv, tv_diff;
 552                 long int usec_diff, frame_diff;
 553
 554                 gettimeofday(&tv, NULL);
 555                 tv_difference(&tv_diff, &p_s_rtp_tx_last_tv, &tv);
 556                 p_s_rtp_tx_last_tv = tv;
 557
 558                 usec_diff = tv_diff.tv_sec * 1000000 + tv_diff.tv_usec;
 559                 frame_diff = (usec_diff / 20000);
 560
 561                 if (abs(frame_diff) > 1) {
 562                         long int frame_diff_excess = frame_diff - 1;
 563
 564                         PDEBUG(DEBUG_SIP, "Correcting frame difference of %ld frames\n", frame_diff_excess);
 565                         p_s_rtp_tx_sequence += frame_diff_excess;
 566                         p_s_rtp_tx_timestamp += frame_diff_excess * duration;
 567                 }
 568         }
 569 #endif
 570
 571         rtph = (struct rtp_hdr *) buffer;
 572         rtph->version = RTP_VERSION;
 573         rtph->padding = 0;
 574         rtph->extension = 0;
 575         rtph->csrc_count = 0;
 576         rtph->marker = 0;
 577         rtph->payload_type = payload_type;
 578         rtph->sequence = htons(p_s_rtp_tx_sequence++);
 579         rtph->timestamp = htonl(p_s_rtp_tx_timestamp);
 580         p_s_rtp_tx_timestamp += duration;
 581         rtph->ssrc = htonl(p_s_rtp_tx_ssrc);
 582         memcpy(buffer + sizeof(struct rtp_hdr), data, payload_len);
 583
 584         if (p_s_rtp_fd.fd > 0) {
 585                 len = write(p_s_rtp_fd.fd, &buffer, sizeof(struct rtp_hdr) + payload_len);
 586                 if (len != sizeof(struct rtp_hdr) + payload_len) {
 587                         PDEBUG(DEBUG_SIP, "write result=%d\n", len);
 588 //                      rtp_close();
 589 //                      rtp_shutdown();
 590                         return -EIO;
 591                 }
 592         }
 593
 594         return 0;
 595 }
 596
 597 /* receive from remote */
 598 int Psip::bridge_rx(unsigned char *data, int len)
 599 {
 600         /* don't bridge, if tones are provided */
 601         if (p_tone_name[0])
 602                 return -EBUSY;
 603
 604         /* write to rx buffer */
 605         while(len--) {
 606                 p_s_rxdata[p_s_rxpos++] = flip[*data++];
 607                 if (p_s_rxpos == 160) {
 608                         p_s_rxpos = 0;
 609
 610                         /* transmit data via rtp */
 611                         rtp_send_frame(p_s_rxdata, 160, (options.law=='a')?PAYLOAD_TYPE_ALAW:PAYLOAD_TYPE_ULAW);
 612                 }
 613         }
 614
 615         return 0;
 616 }
 617
 618 /* taken from freeswitch */
 619 /* map sip responses to QSIG cause codes ala RFC4497 section 8.4.4 */
 620 static int status2cause(int status)
 621 {
 622         switch (status) {
 623         case 200:
 624                 return 16; //SWITCH_CAUSE_NORMAL_CLEARING;
 625         case 401:
 626         case 402:
 627         case 403:
 628         case 407:
 629         case 603:
 630                 return 21; //SWITCH_CAUSE_CALL_REJECTED;
 631         case 404:
 632                 return 1; //SWITCH_CAUSE_UNALLOCATED_NUMBER;
 633         case 485:
 634         case 604:
 635                 return 3; //SWITCH_CAUSE_NO_ROUTE_DESTINATION;
 636         case 408:
 637         case 504:
 638                 return 102; //SWITCH_CAUSE_RECOVERY_ON_TIMER_EXPIRE;
 639         case 410:
 640                 return 22; //SWITCH_CAUSE_NUMBER_CHANGED;
 641         case 413:
 642         case 414:
 643         case 416:
 644         case 420:
 645         case 421:
 646         case 423:
 647         case 505:
 648         case 513:
 649                 return 127; //SWITCH_CAUSE_INTERWORKING;
 650         case 480:
 651                 return 180; //SWITCH_CAUSE_NO_USER_RESPONSE;
 652         case 400:
 653         case 481:
 654         case 500:
 655         case 503:
 656                 return 41; //SWITCH_CAUSE_NORMAL_TEMPORARY_FAILURE;
 657         case 486:
 658         case 600:
 659                 return 17; //SWITCH_CAUSE_USER_BUSY;
 660         case 484:
 661                 return 28; //SWITCH_CAUSE_INVALID_NUMBER_FORMAT;
 662         case 488:
 663         case 606:
 664                 return 88; //SWITCH_CAUSE_INCOMPATIBLE_DESTINATION;
 665         case 502:
 666                 return 38; //SWITCH_CAUSE_NETWORK_OUT_OF_ORDER;
 667         case 405:
 668                 return 63; //SWITCH_CAUSE_SERVICE_UNAVAILABLE;
 669         case 406:
 670         case 415:
 671         case 501:
 672                 return 79; //SWITCH_CAUSE_SERVICE_NOT_IMPLEMENTED;
 673         case 482:
 674         case 483:
 675                 return 25; //SWITCH_CAUSE_EXCHANGE_ROUTING_ERROR;
 676         case 487:
 677                 return 31; //??? SWITCH_CAUSE_ORIGINATOR_CANCEL;
 678         default:
 679                 return 31; //SWITCH_CAUSE_NORMAL_UNSPECIFIED;
 680         }
 681 }
 682
 683 static int cause2status(int cause, int location, const char **st)
 684 {
 685         int s;
 686
 687         switch (cause) {
 688         case 1:
 689                 s = 404; *st = sip_404_Not_found;
 690                 break;
 691         case 2:
 692                 s = 404; *st = sip_404_Not_found;
 693                 break;
 694         case 3:
 695                 s = 404; *st = sip_404_Not_found;
 696                 break;
 697         case 17:
 698                 s = 486; *st = sip_486_Busy_here;
 699                 break;
 700         case 18:
 701                 s = 408; *st = sip_408_Request_timeout;
 702                 break;
 703         case 19:
 704                 s = 480; *st = sip_480_Temporarily_unavailable;
 705                 break;
 706         case 20:
 707                 s = 480; *st = sip_480_Temporarily_unavailable;
 708                 break;
 709         case 21:
 710                 if (location == LOCATION_USER) {
 711                         s = 603; *st = sip_603_Decline;
 712                 } else {
 713                         s = 403; *st = sip_403_Forbidden;
 714                 }
 715                 break;
 716         case 22:
 717                 //s = 301; *st = sip_301_Moved_permanently;
 718                 s = 410; *st = sip_410_Gone;
 719                 break;
 720         case 23:
 721                 s = 410; *st = sip_410_Gone;
 722                 break;
 723         case 27:
 724                 s = 502; *st = sip_502_Bad_gateway;
 725                 break;
 726         case 28:
 727                 s = 484; *st = sip_484_Address_incomplete;
 728                 break;
 729         case 29:
 730                 s = 501; *st = sip_501_Not_implemented;
 731                 break;
 732         case 31:
 733                 s = 480; *st = sip_480_Temporarily_unavailable;
 734                 break;
 735         case 34:
 736                 s = 503; *st = sip_503_Service_unavailable;
 737                 break;
 738         case 38:
 739                 s = 503; *st = sip_503_Service_unavailable;
 740                 break;
 741         case 41:
 742                 s = 503; *st = sip_503_Service_unavailable;
 743                 break;
 744         case 42:
 745                 s = 503; *st = sip_503_Service_unavailable;
 746                 break;
 747         case 47:
 748                 s = 503; *st = sip_503_Service_unavailable;
 749                 break;
 750         case 55:
 751                 s = 403; *st = sip_403_Forbidden;
 752                 break;
 753         case 57:
 754                 s = 403; *st = sip_403_Forbidden;
 755                 break;
 756         case 58:
 757                 s = 503; *st = sip_503_Service_unavailable;
 758                 break;
 759         case 65:
 760                 s = 488; *st = sip_488_Not_acceptable;
 761                 break;
 762         case 69:
 763                 s = 501; *st = sip_501_Not_implemented;
 764                 break;
 765         case 70:
 766                 s = 488; *st = sip_488_Not_acceptable;
 767                 break;
 768         case 79:
 769                 s = 501; *st = sip_501_Not_implemented;
 770                 break;
 771         case 87:
 772                 s = 403; *st = sip_403_Forbidden;
 773                 break;
 774         case 88:
 775                 s = 503; *st = sip_503_Service_unavailable;
 776                 break;
 777         case 102:
 778                 s = 504; *st = sip_504_Gateway_time_out;
 779                 break;
 780         default:
 781                 s = 468; *st = sip_486_Busy_here;
 782         }
 783
 784         return s;
 785 }
 786
 787 /*
 788  * endpoint sends messages to the SIP port
 789  */
 790
 791 int Psip::message_connect(unsigned int epoint_id, int message_id, union parameter *param)
 792 {
 793         char sdp_str[256];
 794         struct in_addr ia;
 795         struct lcr_msg *message;
 796         int media_type;
 797         unsigned char payload_type;
 798
 799         if (param->connectinfo.rtpinfo.port) {
 800                 PDEBUG(DEBUG_SIP, "RTP info given by remote, forward that\n");
 801                 p_s_rtp_bridge = 1;
 802                 media_type = param->connectinfo.rtpinfo.media_types[0];
 803                 payload_type = param->connectinfo.rtpinfo.payload_types[0];
 804                 p_s_rtp_ip_local = param->connectinfo.rtpinfo.ip;
 805                 p_s_rtp_port_local = param->connectinfo.rtpinfo.port;
 806                 PDEBUG(DEBUG_SIP, "payload type %d\n", payload_type);
 807                 PDEBUG(DEBUG_SIP, "local ip %08x port %d\n", p_s_rtp_ip_local, p_s_rtp_port_local);
 808                 PDEBUG(DEBUG_SIP, "remote ip %08x port %d\n", p_s_rtp_ip_remote, p_s_rtp_port_remote);
 809         } else {
 810                 PDEBUG(DEBUG_SIP, "RTP info not given by remote, so we do our own RTP\n");
 811                 media_type = (options.law=='a') ? MEDIA_TYPE_ALAW : MEDIA_TYPE_ULAW;
 812                 payload_type = (options.law=='a') ? PAYLOAD_TYPE_ALAW : PAYLOAD_TYPE_ULAW;
 813                 /* open local RTP peer (if not bridging) */
 814                 if (!p_s_rtp_is_connected && rtp_connect() < 0) {
 815                         nua_cancel(p_s_handle, TAG_END());
 816                         nua_handle_destroy(p_s_handle);
 817                         p_s_handle = NULL;
 818                         sip_trace_header(this, "CANCEL", DIRECTION_OUT);
 819                         add_trace("reason", NULL, "failed to connect RTP/RTCP sockts");
 820                         end_trace();
 821                         message = message_create(p_serial, epoint_id, PORT_TO_EPOINT, MESSAGE_RELEASE);
 822                         message->param.disconnectinfo.cause = 41;
 823                         message->param.disconnectinfo.location = LOCATION_PRIVATE_LOCAL;
 824                         message_put(message);
 825                         new_state(PORT_STATE_RELEASE);
 826                         trigger_work(&p_s_delete);
 827                         return 0;
 828                 }
 829         }
 830
 831         ia.s_addr = htonl(p_s_rtp_ip_local);
 832
 833         SPRINT(sdp_str,
 834                 "v=0\n"
 835                 "o=LCR-Sofia-SIP 0 0 IN IP4 %s\n"
 836                 "s=SIP Call\n"
 837                 "c=IN IP4 %s\n"
 838                 "t=0 0\n"
 839                 "m=audio %d RTP/AVP %d\n"
 840                 "a=rtpmap:%d %s/8000\n"
 841                 , inet_ntoa(ia), inet_ntoa(ia), p_s_rtp_port_local, payload_type, payload_type, media_type2name(media_type));
 842         PDEBUG(DEBUG_SIP, "Using SDP response: %s\n", sdp_str);
 843
 844         nua_respond(p_s_handle, SIP_200_OK,
 845                 NUTAG_MEDIA_ENABLE(0),
 846                 SIPTAG_CONTENT_TYPE_STR("application/sdp"),
 847                 SIPTAG_PAYLOAD_STR(sdp_str), TAG_END());
 848         new_state(PORT_STATE_CONNECT);
 849         sip_trace_header(this, "RESPOND", DIRECTION_OUT);
 850         add_trace("respond", "value", "200 OK");
 851         add_trace("reason", NULL, "call connected");
 852         add_trace("rtp", "ip", "%s", inet_ntoa(ia));
 853         add_trace("rtp", "port", "%d,%d", p_s_rtp_port_local, p_s_rtp_port_local + 1);
 854         add_trace("rtp", "payload", "%s:%d", media_type2name(media_type), payload_type);
 855         end_trace();
 856
 857         return 0;
 858 }
 859
 860 int Psip::message_release(unsigned int epoint_id, int message_id, union parameter *param)
 861 {
 862         struct lcr_msg *message;
 863         char cause_str[128] = "";
 864         int cause = param->disconnectinfo.cause;
 865         int location = param->disconnectinfo.cause;
 866         int status;
 867         const char *status_text;
 868
 869         if (cause > 0 && cause <= 127) {
 870                 SPRINT(cause_str, "Q.850;cause=%d;text=\"%s\"", cause, isdn_cause[cause].english);
 871         }
 872
 873         switch (p_state) {
 874         case PORT_STATE_OUT_SETUP:
 875         case PORT_STATE_OUT_PROCEEDING:
 876         case PORT_STATE_OUT_ALERTING:
 877                 PDEBUG(DEBUG_SIP, "RELEASE/DISCONNECT will cancel\n");
 878                 sip_trace_header(this, "CANCEL", DIRECTION_OUT);
 879                 if (cause_str[0])
 880                         add_trace("cause", "value", "%d", cause);
 881                 end_trace();
 882                 nua_cancel(p_s_handle, TAG_IF(cause_str[0], SIPTAG_REASON_STR(cause_str)), TAG_END());
 883                 break;
 884         case PORT_STATE_IN_SETUP:
 885         case PORT_STATE_IN_PROCEEDING:
 886         case PORT_STATE_IN_ALERTING:
 887                 PDEBUG(DEBUG_SIP, "RELEASE/DISCONNECT will respond\n");
 888                 status = cause2status(cause, location, &status_text);
 889                 sip_trace_header(this, "RESPOND", DIRECTION_OUT);
 890                 if (cause_str[0])
 891                         add_trace("cause", "value", "%d", cause);
 892                 add_trace("respond", "value", "%d %s", status, status_text);
 893                 end_trace();
 894                 nua_respond(p_s_handle, status, status_text, TAG_IF(cause_str[0], SIPTAG_REASON_STR(cause_str)), TAG_END());
 895                 nua_handle_destroy(p_s_handle);
 896                 p_s_handle = NULL;
 897                 trigger_work(&p_s_delete);
 898                 break;
 899         default:
 900                 PDEBUG(DEBUG_SIP, "RELEASE/DISCONNECT will perform nua_bye\n");
 901                 sip_trace_header(this, "BYE", DIRECTION_OUT);
 902                 if (cause_str[0])
 903                         add_trace("cause", "value", "%d", cause);
 904                 end_trace();
 905                 nua_bye(p_s_handle, TAG_IF(cause_str[0], SIPTAG_REASON_STR(cause_str)), TAG_END());
 906         }
 907
 908         if (message_id == MESSAGE_DISCONNECT) {
 909                 while(p_epointlist) {
 910                         message = message_create(p_serial, p_epointlist->epoint_id, PORT_TO_EPOINT, MESSAGE_RELEASE);
 911                         message->param.disconnectinfo.cause = CAUSE_NORMAL;
 912                         message->param.disconnectinfo.location = LOCATION_BEYOND;
 913                         message_put(message);
 914                         /* remove epoint */
 915                         free_epointlist(p_epointlist);
 916                 }
 917         }
 918
 919         new_state(PORT_STATE_RELEASE);
 920
 921         return(0);
 922 }
 923
 924 int Psip::message_setup(unsigned int epoint_id, int message_id, union parameter *param)
 925 {
 926         struct sip_inst *inst = (struct sip_inst *) p_s_sip_inst;
 927         char from[128];
 928         char to[128];
 929         const char *local = inst->local_peer;
 930         char local_ip[16];
 931         const char *remote = inst->remote_peer;
 932         char sdp_str[512], pt_str[32];
 933         struct in_addr ia;
 934         struct epoint_list *epointlist;
 935         sip_cseq_t *cseq = NULL;
 936         struct lcr_msg *message;
 937         int lcr_media = { (options.law=='a') ? MEDIA_TYPE_ALAW : MEDIA_TYPE_ULAW };
 938         unsigned char lcr_payload = { (options.law=='a') ? PAYLOAD_TYPE_ALAW : PAYLOAD_TYPE_ULAW };
 939         int *media_types;
 940         unsigned char *payload_types;
 941         int payloads = 0;
 942         int i;
 943
 944         PDEBUG(DEBUG_SIP, "Doing Setup (inst %p)\n", inst);
 945
 946         memcpy(&p_dialinginfo, &param->setup.dialinginfo, sizeof(p_dialinginfo));
 947         memcpy(&p_callerinfo, &param->setup.callerinfo, sizeof(p_callerinfo));
 948         memcpy(&p_redirinfo, &param->setup.redirinfo, sizeof(p_redirinfo));
 949
 950         if (param->setup.rtpinfo.port) {
 951                 PDEBUG(DEBUG_SIP, "RTP info given by remote, forward that\n");
 952                 p_s_rtp_bridge = 1;
 953                 media_types = param->setup.rtpinfo.media_types;
 954                 payload_types = param->setup.rtpinfo.payload_types;
 955                 payloads = param->setup.rtpinfo.payloads;
 956                 p_s_rtp_ip_local = param->setup.rtpinfo.ip;
 957                 p_s_rtp_port_local = param->setup.rtpinfo.port;
 958                 PDEBUG(DEBUG_SIP, "local ip %08x port %d\n", p_s_rtp_ip_local, p_s_rtp_port_local);
 959                 PDEBUG(DEBUG_SIP, "remote ip %08x port %d\n", p_s_rtp_ip_remote, p_s_rtp_port_remote);
 960         } else {
 961                 PDEBUG(DEBUG_SIP, "RTP info not given by remote, so we do our own RTP\n");
 962                 p_s_rtp_bridge = 0;
 963                 media_types = &lcr_media;
 964                 payload_types = &lcr_payload;
 965                 payloads = 1;
 966
 967                 /* open local RTP peer (if not bridging) */
 968                 if (rtp_open() < 0) {
 969                         PERROR("Failed to open RTP sockets\n");
 970                         /* send release message to endpoit */
 971                         message = message_create(p_serial, epoint_id, PORT_TO_EPOINT, MESSAGE_RELEASE);
 972                         message->param.disconnectinfo.cause = 41;
 973                         message->param.disconnectinfo.location = LOCATION_PRIVATE_LOCAL;
 974                         message_put(message);
 975                         new_state(PORT_STATE_RELEASE);
 976                         trigger_work(&p_s_delete);
 977                         return 0;
 978                 }
 979         }
 980
 981         p_s_handle = nua_handle(inst->nua, NULL, TAG_END());
 982         if (!p_s_handle) {
 983                 PERROR("Failed to create handle\n");
 984                 /* send release message to endpoit */
 985                 message = message_create(p_serial, epoint_id, PORT_TO_EPOINT, MESSAGE_RELEASE);
 986                 message->param.disconnectinfo.cause = 41;
 987                 message->param.disconnectinfo.location = LOCATION_PRIVATE_LOCAL;
 988                 message_put(message);
 989                 new_state(PORT_STATE_RELEASE);
 990                 trigger_work(&p_s_delete);
 991                 return 0;
 992         }
 993         /* apply handle */
 994         sip_trace_header(this, "NEW handle", DIRECTION_IN);
 995         add_trace("handle", "new", "0x%x", p_s_handle);
 996         end_trace();
 997
 998         if (!p_s_rtp_ip_local) {
 999                 char *p;
1000
1001                 /* extract IP from local peer */
1002                 SCPY(local_ip, local);
1003                 p = strchr(local_ip, ':');
1004                 if (p)
1005                         *p = '\0';
1006                 PDEBUG(DEBUG_SIP, "RTP local IP not known, so we use our local SIP ip %s\n", local_ip);
1007                 inet_pton(AF_INET, local_ip, &p_s_rtp_ip_local);
1008                 p_s_rtp_ip_local = ntohl(p_s_rtp_ip_local);
1009         }
1010         ia.s_addr = htonl(p_s_rtp_ip_local);
1011         SPRINT(sdp_str,
1012                 "v=0\n"
1013                 "o=LCR-Sofia-SIP 0 0 IN IP4 %s\n"
1014                 "s=SIP Call\n"
1015                 "c=IN IP4 %s\n"
1016                 "t=0 0\n"
1017                 "m=audio %d RTP/AVP"
1018                 , inet_ntoa(ia), inet_ntoa(ia), p_s_rtp_port_local);
1019         for (i = 0; i < payloads; i++) {
1020                 SPRINT(pt_str, " %d", payload_types[i]);
1021                 SCAT(sdp_str, pt_str);
1022         }
1023         SCAT(sdp_str, "\n");
1024         for (i = 0; i < payloads; i++) {
1025                 SPRINT(pt_str, "a=rtpmap:%d %s/8000\n", payload_types[i], media_type2name(media_types[i]));
1026                 SCAT(sdp_str, pt_str);
1027         }
1028         PDEBUG(DEBUG_SIP, "Using SDP for invite: %s\n", sdp_str);
1029
1030         SPRINT(from, "sip:%s@%s", param->setup.callerinfo.id, local);
1031         SPRINT(to, "sip:%s@%s", param->setup.dialinginfo.id, remote);
1032
1033         sip_trace_header(this, "INVITE", DIRECTION_OUT);
1034         add_trace("from", "uri", "%s", from);
1035         add_trace("to", "uri", "%s", to);
1036         add_trace("rtp", "ip", "%s", inet_ntoa(ia));
1037         add_trace("rtp", "port", "%d,%d", p_s_rtp_port_local, p_s_rtp_port_local + 1);
1038         for (i = 0; i < payloads; i++)
1039                 add_trace("rtp", "payload", "%s:%d", media_type2name(media_types[i]), payload_types[i]);
1040         end_trace();
1041
1042 //      cseq = sip_cseq_create(sip_home, 123, SIP_METHOD_INVITE);
1043
1044         nua_invite(p_s_handle,
1045                 TAG_IF(from[0], SIPTAG_FROM_STR(from)),
1046                 TAG_IF(to[0], SIPTAG_TO_STR(to)),
1047                 TAG_IF(cseq, SIPTAG_CSEQ(cseq)),
1048                 NUTAG_MEDIA_ENABLE(0),
1049                 SIPTAG_CONTENT_TYPE_STR("application/sdp"),
1050                 SIPTAG_PAYLOAD_STR(sdp_str), TAG_END());
1051         new_state(PORT_STATE_OUT_SETUP);
1052
1053 #if 0
1054         PDEBUG(DEBUG_SIP, "do overlap\n");
1055         new_state(PORT_STATE_OUT_OVERLAP);
1056         message = message_create(p_serial, epoint_id, PORT_TO_EPOINT, MESSAGE_OVERLAP);
1057         message_put(message);
1058 #else
1059         PDEBUG(DEBUG_SIP, "do proceeding\n");
1060         new_state(PORT_STATE_OUT_PROCEEDING);
1061         message = message_create(p_serial, epoint_id, PORT_TO_EPOINT, MESSAGE_PROCEEDING);
1062         message_put(message);
1063 #endif
1064
1065         /* attach only if not already */
1066         epointlist = p_epointlist;
1067         while(epointlist) {
1068                 if (epointlist->epoint_id == epoint_id)
1069                         break;
1070                 epointlist = epointlist->next;
1071         }
1072         if (!epointlist)
1073                 epointlist_new(epoint_id);
1074
1075         return 0;
1076 }
1077
1078 int Psip::message_notify(unsigned int epoint_id, int message_id, union parameter *param)
1079 {
1080 //      char sdp_str[256];
1081 //      struct in_addr ia;
1082
1083         switch (param->notifyinfo.notify) {
1084         case INFO_NOTIFY_REMOTE_HOLD:
1085 #if 0
1086                 SPRINT(sdp_str,
1087                         "v=0\n"
1088                         "o=LCR-Sofia-SIP 0 0 IN IP4 0.0.0.0\n"
1089                         "s=SIP Call\n"
1090                         "c=IN IP4 0.0.0.0\n"
1091                         "t=0 0\n"
1092                         );
1093                 PDEBUG(DEBUG_SIP, "Using SDP for hold: %s\n", sdp_str);
1094                 nua_info(p_s_handle,
1095 //                      TAG_IF(from[0], SIPTAG_FROM_STR(from)),
1096 //                      TAG_IF(to[0], SIPTAG_TO_STR(to)),
1097 //                      TAG_IF(cseq, SIPTAG_CSEQ(cseq)),
1098                         NUTAG_MEDIA_ENABLE(0),
1099                         SIPTAG_CONTENT_TYPE_STR("application/sdp"),
1100                         SIPTAG_PAYLOAD_STR(sdp_str), TAG_END());
1101 #endif
1102                 break;
1103         case INFO_NOTIFY_REMOTE_RETRIEVAL:
1104 #if 0
1105                 ia.s_addr = htonl(p_s_rtp_ip_local);
1106                 SPRINT(sdp_str,
1107                         "v=0\n"
1108                         "o=LCR-Sofia-SIP 0 0 IN IP4 %s\n"
1109                         "s=SIP Call\n"
1110                         "c=IN IP4 %s\n"
1111                         "t=0 0\n"
1112                         "m=audio %d RTP/AVP %d\n"
1113                         "a=rtpmap:%d %s/8000\n"
1114                         , inet_ntoa(ia), inet_ntoa(ia), p_s_rtp_port_local, p_s_rtp_payload_type, p_s_rtp_payload_type, media_type2name(p_s_rtp_media_type));
1115                 PDEBUG(DEBUG_SIP, "Using SDP for rertieve: %s\n", sdp_str);
1116                 nua_info(p_s_handle,
1117 //                      TAG_IF(from[0], SIPTAG_FROM_STR(from)),
1118 //                      TAG_IF(to[0], SIPTAG_TO_STR(to)),
1119 //                      TAG_IF(cseq, SIPTAG_CSEQ(cseq)),
1120                         NUTAG_MEDIA_ENABLE(0),
1121                         SIPTAG_CONTENT_TYPE_STR("application/sdp"),
1122                         SIPTAG_PAYLOAD_STR(sdp_str), TAG_END());
1123 #endif
1124                 break;
1125         }
1126
1127         return 0;
1128 }
1129
1130 int Psip::message_dtmf(unsigned int epoint_id, int message_id, union parameter *param)
1131 {
1132         char dtmf_str[64];
1133
1134         /* prepare DTMF info payload */
1135         SPRINT(dtmf_str,
1136                 "Signal=%c\n"
1137                 "Duration=160\n"
1138                 , param->dtmf);
1139
1140         /* start invite to handle DTMF */
1141         nua_info(p_s_handle,
1142                 NUTAG_MEDIA_ENABLE(0),
1143                 SIPTAG_CONTENT_TYPE_STR("application/dtmf-relay"),
1144                 SIPTAG_PAYLOAD_STR(dtmf_str), TAG_END());
1145
1146         return 0;
1147 }
1148
1149 /* NOTE: incomplete and not working */
1150 int Psip::message_information(unsigned int epoint_id, int message_id, union parameter *param)
1151 {
1152         char dtmf_str[64];
1153
1154         /* prepare DTMF info payload */
1155         SPRINT(dtmf_str,
1156                 "Signal=%s\n"
1157                 "Duration=160\n"
1158                 , param->information.id);
1159
1160         /* start invite to handle DTMF */
1161         nua_info(p_s_handle,
1162                 NUTAG_MEDIA_ENABLE(0),
1163                 SIPTAG_CONTENT_TYPE_STR("application/dtmf-relay"),
1164                 SIPTAG_PAYLOAD_STR(dtmf_str), TAG_END());
1165
1166         return 0;
1167 }
1168
1169 int Psip::message_epoint(unsigned int epoint_id, int message_id, union parameter *param)
1170 {
1171         if (Port::message_epoint(epoint_id, message_id, param))
1172                 return 1;
1173
1174         switch(message_id) {
1175                 case MESSAGE_ALERTING: /* call is ringing on LCR side */
1176                 if (p_state != PORT_STATE_IN_SETUP
1177                  && p_state != PORT_STATE_IN_PROCEEDING)
1178                         return 0;
1179                 nua_respond(p_s_handle, SIP_180_RINGING, TAG_END());
1180                 sip_trace_header(this, "RESPOND", DIRECTION_OUT);
1181                 add_trace("respond", "value", "180 Ringing");
1182                 end_trace();
1183                 new_state(PORT_STATE_IN_ALERTING);
1184                 return 1;
1185
1186                 case MESSAGE_CONNECT: /* call is connected on LCR side */
1187                 if (p_state != PORT_STATE_IN_SETUP
1188                  && p_state != PORT_STATE_IN_PROCEEDING
1189                  && p_state != PORT_STATE_IN_ALERTING)
1190                         return 0;
1191                 message_connect(epoint_id, message_id, param);
1192                 return 1;
1193
1194                 case MESSAGE_DISCONNECT: /* call has been disconnected */
1195                 case MESSAGE_RELEASE: /* call has been released */
1196                 message_release(epoint_id, message_id, param);
1197                 return 1;
1198
1199                 case MESSAGE_SETUP: /* dial-out command received from epoint */
1200                 message_setup(epoint_id, message_id, param);
1201                 return 1;
1202
1203                 case MESSAGE_INFORMATION: /* overlap dialing */
1204                 if (p_state != PORT_STATE_OUT_OVERLAP)
1205                         return 0;
1206                 message_information(epoint_id, message_id, param);
1207                 return 1;
1208
1209                 case MESSAGE_DTMF: /* DTMF info to be transmitted via INFO transaction */
1210                 if (p_state == PORT_STATE_CONNECT)
1211                         message_dtmf(epoint_id, message_id, param);
1212                 case MESSAGE_NOTIFY: /* notification about remote hold/retrieve */
1213                 if (p_state == PORT_STATE_CONNECT)
1214                         message_notify(epoint_id, message_id, param);
1215                 return(1);
1216
1217                 default:
1218                 PDEBUG(DEBUG_SIP, "PORT(%s) SP port with (caller id %s) received an unsupported message: %d\n", p_name, p_callerinfo.id, message_id);
1219         }
1220
1221         return 0;
1222 }
1223
1224 int Psip::parse_sdp(sip_t const *sip, unsigned int *ip, unsigned short *port, uint8_t *payload_types, int *media_types, int *payloads, int max_payloads)
1225 {
1226         *payloads = 0;
1227
1228         if (!sip->sip_payload) {
1229                 PDEBUG(DEBUG_SIP, "no payload given\n");
1230                 return 0;
1231         }
1232
1233         sdp_parser_t *parser;
1234         sdp_session_t *sdp;
1235         sdp_media_t *m;
1236         sdp_attribute_t *attr;
1237         sdp_rtpmap_t *map;
1238         sdp_connection_t *conn;
1239
1240         PDEBUG(DEBUG_SIP, "payload given: %s\n", sip->sip_payload->pl_data);
1241
1242         parser = sdp_parse(NULL, sip->sip_payload->pl_data, (int) strlen(sip->sip_payload->pl_data), 0);
1243         if (!parser) {
1244                 return 400;
1245         }
1246         if (!(sdp = sdp_session(parser))) {
1247                 sdp_parser_free(parser);
1248                 return 400;
1249         }
1250         for (m = sdp->sdp_media; m; m = m->m_next) {
1251                 if (m->m_proto != sdp_proto_rtp)
1252                         continue;
1253                 if (m->m_type != sdp_media_audio)
1254                         continue;
1255                 PDEBUG(DEBUG_SIP, "RTP port:'%u'\n", m->m_port);
1256                 *port = m->m_port;
1257                 for (attr = m->m_attributes; attr; attr = attr->a_next) {
1258                         PDEBUG(DEBUG_SIP, "ATTR: name:'%s' value='%s'\n", attr->a_name, attr->a_value);
1259                 }
1260                 if (m->m_connections) {
1261                         conn = m->m_connections;
1262                         PDEBUG(DEBUG_SIP, "CONN: address:'%s'\n", conn->c_address);
1263                         inet_pton(AF_INET, conn->c_address, ip);
1264                         *ip = ntohl(p_s_rtp_ip_remote);
1265                 } else {
1266                         char *p = sip->sip_payload->pl_data;
1267                         char addr[16];
1268
1269                         PDEBUG(DEBUG_SIP, "sofia cannot find connection tag, so we try ourself\n");
1270                         p = strstr(p, "c=IN IP4 ");
1271                         if (!p) {
1272                                 PDEBUG(DEBUG_SIP, "missing c-tag with internet address\n");
1273                                 sdp_parser_free(parser);
1274                                 return 400;
1275                         }
1276                         SCPY(addr, p + 9);
1277                         if ((p = strchr(addr, '\n'))) *p = '\0';
1278                         if ((p = strchr(addr, '\r'))) *p = '\0';
1279                         PDEBUG(DEBUG_SIP, "CONN: address:'%s'\n", addr);
1280                         inet_pton(AF_INET, addr, ip);
1281                         *ip = ntohl(p_s_rtp_ip_remote);
1282                 }
1283                 for (map = m->m_rtpmaps; map; map = map->rm_next) {
1284                         int media_type = 0;
1285
1286                         PDEBUG(DEBUG_SIP, "RTPMAP: coding:'%s' rate='%d' pt='%d'\n", map->rm_encoding, map->rm_rate, map->rm_pt);
1287                         /* append to payload list, if there is space */
1288                         add_trace("rtp", "payload", "%s:%d", map->rm_encoding, map->rm_pt);
1289                         if (map->rm_pt == PAYLOAD_TYPE_ALAW)
1290                                 media_type = MEDIA_TYPE_ALAW;
1291                         else if (map->rm_pt == PAYLOAD_TYPE_ULAW)
1292                                 media_type = MEDIA_TYPE_ULAW;
1293                         else if (map->rm_pt == PAYLOAD_TYPE_GSM)
1294                                 media_type = MEDIA_TYPE_GSM;
1295                         else if (!strcmp(map->rm_encoding, "GSM-EFR"))
1296                                 media_type = MEDIA_TYPE_GSM_EFR;
1297                         else if (!strcmp(map->rm_encoding, "AMR"))
1298                                 media_type = MEDIA_TYPE_AMR;
1299                         else if (!strcmp(map->rm_encoding, "GSM-HR"))
1300                                 media_type = MEDIA_TYPE_GSM_HR;
1301                         if (media_type && *payloads <= max_payloads) {
1302                                 *payload_types++ = map->rm_pt;
1303                                 *media_types++ = media_type;
1304                                 (*payloads)++;
1305                         }
1306                 }
1307         }
1308
1309         sdp_parser_free(parser);
1310
1311         return 0;
1312 }
1313
1314 void Psip::i_invite(int status, char const *phrase, nua_t *nua, nua_magic_t *magic, nua_handle_t *nh, nua_hmagic_t *hmagic, sip_t const *sip, tagi_t tagss[])
1315 {
1316         struct sip_inst *inst = (struct sip_inst *) p_s_sip_inst;
1317         const char *from = "", *to = "", *name = "";
1318         char imsi[16] = "";
1319         int ret;
1320         class Endpoint *epoint;
1321         struct lcr_msg *message;
1322         struct interface *interface;
1323         int media_types[32];
1324         uint8_t payload_types[32];
1325         int payloads = 0;
1326         int media_type;
1327
1328         interface = getinterfacebyname(inst->interface_name);
1329         if (!interface) {
1330                 PERROR("Cannot find interface %s.\n", inst->interface_name);
1331                 return;
1332         }
1333
1334         if (sip->sip_from) {
1335                 if (sip->sip_from->a_url)
1336                         from = sip->sip_from->a_url->url_user;
1337                 if (sip->sip_from->a_display) {
1338                         name = sip->sip_from->a_display;
1339                         if (!strncmp(name, "\"IMSI", 5)) {
1340                                 strncpy(imsi, name + 5, 15);
1341                                 imsi[15] = '\0';
1342                                 name = "";
1343                         }
1344                 }
1345         }
1346         if (sip->sip_to) {
1347                 if (sip->sip_to->a_url)
1348                         to = sip->sip_to->a_url->url_user;
1349         }
1350         PDEBUG(DEBUG_SIP, "invite received (%s->%s)\n", from, to);
1351
1352         sip_trace_header(this, "Payload received", DIRECTION_NONE);
1353         ret = parse_sdp(sip, &p_s_rtp_ip_remote, &p_s_rtp_port_remote, payload_types, media_types, &payloads, sizeof(payload_types));
1354         if (!ret) {
1355                 /* if no RTP bridge, we must support LAW codec, otherwise we forward what we have */
1356                 if (!p_s_rtp_bridge) {
1357                         int i;
1358
1359                         /* check if supported payload type exists */
1360                         for (i = 0; i < payloads; i++) {
1361                                 if (media_types[i] == ((options.law=='a') ? MEDIA_TYPE_ALAW : MEDIA_TYPE_ULAW))
1362                                         break;
1363                         }
1364                         if (i == payloads) {
1365                                 add_trace("error", NULL, "Expected LAW payload type (not bridged)");
1366                                 ret = 415;
1367                         }
1368                 }
1369         }
1370         end_trace();
1371         if (ret) {
1372                 if (ret == 400)
1373                         nua_respond(nh, SIP_400_BAD_REQUEST, TAG_END());
1374                 else
1375                         nua_respond(nh, SIP_415_UNSUPPORTED_MEDIA, TAG_END());
1376                 nua_handle_destroy(nh);
1377                 p_s_handle = NULL;
1378                 sip_trace_header(this, "RESPOND", DIRECTION_OUT);
1379                 if (ret == 400)
1380                         add_trace("respond", "value", "415 Unsupported Media");
1381                 else
1382                         add_trace("respond", "value", "400 Bad Request");
1383                 add_trace("reason", NULL, "offered codec does not match");
1384                 end_trace();
1385                 new_state(PORT_STATE_RELEASE);
1386                 trigger_work(&p_s_delete);
1387                 return;
1388         }
1389
1390         /* open local RTP peer (if not bridging) */
1391         if (!p_s_rtp_bridge && rtp_open() < 0) {
1392                 nua_respond(nh, SIP_500_INTERNAL_SERVER_ERROR, TAG_END());
1393                 nua_handle_destroy(nh);
1394                 p_s_handle = NULL;
1395                 sip_trace_header(this, "RESPOND", DIRECTION_OUT);
1396                 add_trace("respond", "value", "500 Internal Server Error");
1397                 add_trace("reason", NULL, "failed to open RTP/RTCP sockts");
1398                 end_trace();
1399                 new_state(PORT_STATE_RELEASE);
1400                 trigger_work(&p_s_delete);
1401                 return;
1402         }
1403
1404         /* apply handle */
1405         sip_trace_header(this, "NEW handle", DIRECTION_IN);
1406         add_trace("handle", "new", "0x%x", nh);
1407         p_s_handle = nh;
1408         end_trace();
1409
1410         sip_trace_header(this, "INVITE", DIRECTION_IN);
1411         add_trace("rtp", "port", "%d", p_s_rtp_port_remote);
1412         /* caller information */
1413         if (!from[0]) {
1414                 p_callerinfo.present = INFO_PRESENT_NOTAVAIL;
1415                 p_callerinfo.ntype = INFO_NTYPE_NOTPRESENT;
1416                 add_trace("calling", "present", "unavailable");
1417         } else {
1418                 p_callerinfo.present = INFO_PRESENT_ALLOWED;
1419                 add_trace("calling", "present", "allowed");
1420                 p_callerinfo.screen = INFO_SCREEN_NETWORK;
1421                 p_callerinfo.ntype = INFO_NTYPE_UNKNOWN;
1422                 SCPY(p_callerinfo.id, from);
1423                 add_trace("calling", "number", "%s", from);
1424                 SCPY(p_callerinfo.name, name);
1425                 if (name[0])
1426                         add_trace("calling", "name", "%s", name);
1427                 SCPY(p_callerinfo.imsi, imsi);
1428                 if (imsi[0])
1429                         add_trace("calling", "imsi", "%s", imsi);
1430         }
1431         SCPY(p_callerinfo.interface, inst->interface_name);
1432         /* dialing information */
1433         if (to[0]) {
1434                 p_dialinginfo.ntype = INFO_NTYPE_UNKNOWN;
1435                 SCAT(p_dialinginfo.id, to);
1436                 add_trace("dialing", "number", "%s", to);
1437         }
1438         /* redir info */
1439         /* bearer capability */
1440         p_capainfo.bearer_capa = INFO_BC_SPEECH;
1441         p_capainfo.bearer_info1 = (options.law=='a')?3:2;
1442         p_capainfo.bearer_mode = INFO_BMODE_CIRCUIT;
1443         add_trace("bearer", "capa", "speech");
1444         add_trace("bearer", "mode", "circuit");
1445         /* if packet mode works some day, see dss1.cpp for conditions */
1446         p_capainfo.source_mode = B_MODE_TRANSPARENT;
1447
1448         end_trace();
1449
1450         /* create endpoint */
1451         if (p_epointlist)
1452                 FATAL("Incoming call but already got an endpoint.\n");
1453         if (!(epoint = new Endpoint(p_serial, 0)))
1454                 FATAL("No memory for Endpoint instance\n");
1455         epoint->ep_app = new_endpointapp(epoint, 0, interface->app); //incoming
1456         epointlist_new(epoint->ep_serial);
1457
1458 #ifdef NUTAG_AUTO100
1459         /* send trying (proceeding) */
1460         nua_respond(nh, SIP_100_TRYING, TAG_END());
1461         sip_trace_header(this, "RESPOND", DIRECTION_OUT);
1462         add_trace("respond", "value", "100 Trying");
1463         end_trace();
1464 #endif
1465
1466         new_state(PORT_STATE_IN_PROCEEDING);
1467
1468         /* send setup message to endpoit */
1469         message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_SETUP);
1470         message->param.setup.port_type = p_type;
1471 //      message->param.setup.dtmf = 0;
1472         memcpy(&message->param.setup.dialinginfo, &p_dialinginfo, sizeof(struct dialing_info));
1473         memcpy(&message->param.setup.callerinfo, &p_callerinfo, sizeof(struct caller_info));
1474         memcpy(&message->param.setup.capainfo, &p_capainfo, sizeof(struct capa_info));
1475 //      SCPY((char *)message->param.setup.useruser.data, useruser.info);
1476 //      message->param.setup.useruser.len = strlen(mncc->useruser.info);
1477 //      message->param.setup.useruser.protocol = mncc->useruser.proto;
1478         if (p_s_rtp_bridge) {
1479                 int i;
1480
1481                 PDEBUG(DEBUG_SIP, "sending setup with RTP info\n");
1482                 message->param.setup.rtpinfo.ip = p_s_rtp_ip_remote;
1483                 message->param.setup.rtpinfo.port = p_s_rtp_port_remote;
1484                 /* add codecs to setup message */
1485                 for (i = 0; i < payloads; i++) {
1486                         message->param.setup.rtpinfo.media_types[i] = media_types[i];
1487                         message->param.setup.rtpinfo.payload_types[i] = payload_types[i];
1488                         if (i == sizeof(message->param.setup.rtpinfo.payload_types))
1489                                 break;
1490                 }
1491                 message->param.setup.rtpinfo.payloads = i;
1492         }
1493         message_put(message);
1494
1495         /* send progress, if tones are available and if we don't bridge */
1496         if (!p_s_rtp_bridge && interface->is_tones == IS_YES) {
1497                 char sdp_str[256];
1498                 struct in_addr ia;
1499                 unsigned char payload_type;
1500
1501                 PDEBUG(DEBUG_SIP, "Connecting audio, since we have tones available\n");
1502                 media_type = (options.law=='a') ? MEDIA_TYPE_ALAW : MEDIA_TYPE_ULAW;
1503                 payload_type = (options.law=='a') ? PAYLOAD_TYPE_ALAW : PAYLOAD_TYPE_ULAW;
1504                 /* open local RTP peer (if not bridging) */
1505                 if (rtp_connect() < 0) {
1506                         nua_respond(nh, SIP_500_INTERNAL_SERVER_ERROR, TAG_END());
1507                         nua_handle_destroy(nh);
1508                         p_s_handle = NULL;
1509                         sip_trace_header(this, "RESPOND", DIRECTION_OUT);
1510                         add_trace("respond", "value", "500 Internal Server Error");
1511                         add_trace("reason", NULL, "failed to connect RTP/RTCP sockts");
1512                         end_trace();
1513                         new_state(PORT_STATE_RELEASE);
1514                         trigger_work(&p_s_delete);
1515                         message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_RELEASE);
1516                         message->param.disconnectinfo.cause = 41;
1517                         message->param.disconnectinfo.location = LOCATION_PRIVATE_LOCAL;
1518                         message_put(message);
1519                         new_state(PORT_STATE_RELEASE);
1520                         trigger_work(&p_s_delete);
1521                         return;
1522                 }
1523
1524                 ia.s_addr = htonl(p_s_rtp_ip_local);
1525
1526                 SPRINT(sdp_str,
1527                         "v=0\n"
1528                         "o=LCR-Sofia-SIP 0 0 IN IP4 %s\n"
1529                         "s=SIP Call\n"
1530                         "c=IN IP4 %s\n"
1531                         "t=0 0\n"
1532                         "m=audio %d RTP/AVP %d\n"
1533                         "a=rtpmap:%d %s/8000\n"
1534                         , inet_ntoa(ia), inet_ntoa(ia), p_s_rtp_port_local, payload_type, payload_type, media_type2name(media_type));
1535                 PDEBUG(DEBUG_SIP, "Using SDP response: %s\n", sdp_str);
1536
1537                 nua_respond(p_s_handle, SIP_183_SESSION_PROGRESS,
1538                         NUTAG_MEDIA_ENABLE(0),
1539                         SIPTAG_CONTENT_TYPE_STR("application/sdp"),
1540                         SIPTAG_PAYLOAD_STR(sdp_str), TAG_END());
1541                 sip_trace_header(this, "RESPOND", DIRECTION_OUT);
1542                 add_trace("respond", "value", "183 SESSION PROGRESS");
1543                 add_trace("reason", NULL, "audio available");
1544                 add_trace("rtp", "ip", "%s", inet_ntoa(ia));
1545                 add_trace("rtp", "port", "%d,%d", p_s_rtp_port_local, p_s_rtp_port_local + 1);
1546                 add_trace("rtp", "payload", "%s:%d", media_type2name(media_type), payload_type);
1547                 end_trace();
1548         }
1549 }
1550
1551 void Psip::i_bye(int status, char const *phrase, nua_t *nua, nua_magic_t *magic, nua_handle_t *nh, nua_hmagic_t *hmagic, sip_t const *sip, tagi_t tagss[])
1552 {
1553         struct lcr_msg *message;
1554         int cause = 0;
1555
1556         PDEBUG(DEBUG_SIP, "bye received\n");
1557
1558         sip_trace_header(this, "BYE", DIRECTION_IN);
1559         if (sip->sip_reason && sip->sip_reason->re_protocol && !strcasecmp(sip->sip_reason->re_protocol, "Q.850") && sip->sip_reason->re_cause) {
1560                 cause = atoi(sip->sip_reason->re_cause);
1561                 add_trace("cause", "value", "%d", cause);
1562         }
1563         end_trace();
1564
1565 // let stack do bye automaticall, since it will not accept our response for some reason
1566 //      nua_respond(nh, SIP_200_OK, TAG_END());
1567         sip_trace_header(this, "RESPOND", DIRECTION_OUT);
1568         add_trace("respond", "value", "200 OK");
1569         end_trace();
1570 //      nua_handle_destroy(nh);
1571         p_s_handle = NULL;
1572
1573         rtp_close();
1574
1575         while(p_epointlist) {
1576                 /* send setup message to endpoit */
1577                 message = message_create(p_serial, p_epointlist->epoint_id, PORT_TO_EPOINT, MESSAGE_RELEASE);
1578                 message->param.disconnectinfo.cause = cause ? : 16;
1579                 message->param.disconnectinfo.location = LOCATION_BEYOND;
1580                 message_put(message);
1581                 /* remove epoint */
1582                 free_epointlist(p_epointlist);
1583         }
1584         new_state(PORT_STATE_RELEASE);
1585         trigger_work(&p_s_delete);
1586 }
1587
1588 void Psip::i_cancel(int status, char const *phrase, nua_t *nua, nua_magic_t *magic, nua_handle_t *nh, nua_hmagic_t *hmagic, sip_t const *sip, tagi_t tagss[])
1589 {
1590         struct lcr_msg *message;
1591
1592         PDEBUG(DEBUG_SIP, "cancel received\n");
1593
1594         sip_trace_header(this, "CANCEL", DIRECTION_IN);
1595         end_trace();
1596
1597         nua_handle_destroy(nh);
1598         p_s_handle = NULL;
1599
1600         rtp_close();
1601
1602         while(p_epointlist) {
1603                 /* send setup message to endpoit */
1604                 message = message_create(p_serial, p_epointlist->epoint_id, PORT_TO_EPOINT, MESSAGE_RELEASE);
1605                 message->param.disconnectinfo.cause = 16;
1606                 message->param.disconnectinfo.location = LOCATION_BEYOND;
1607                 message_put(message);
1608                 /* remove epoint */
1609                 free_epointlist(p_epointlist);
1610         }
1611         new_state(PORT_STATE_RELEASE);
1612         trigger_work(&p_s_delete);
1613 }
1614
1615 void Psip::r_bye(int status, char const *phrase, nua_t *nua, nua_magic_t *magic, nua_handle_t *nh, nua_hmagic_t *hmagic, sip_t const *sip, tagi_t tagss[])
1616 {
1617         PDEBUG(DEBUG_SIP, "bye response received\n");
1618
1619         nua_handle_destroy(nh);
1620         p_s_handle = NULL;
1621
1622         rtp_close();
1623
1624         trigger_work(&p_s_delete);
1625 }
1626
1627 void Psip::r_cancel(int status, char const *phrase, nua_t *nua, nua_magic_t *magic, nua_handle_t *nh, nua_hmagic_t *hmagic, sip_t const *sip, tagi_t tagss[])
1628 {
1629         PDEBUG(DEBUG_SIP, "cancel response received\n");
1630
1631         nua_handle_destroy(nh);
1632         p_s_handle = NULL;
1633
1634         rtp_close();
1635
1636         trigger_work(&p_s_delete);
1637 }
1638
1639 void Psip::r_invite(int status, char const *phrase, nua_t *nua, nua_magic_t *magic, nua_handle_t *nh, nua_hmagic_t *hmagic, sip_t const *sip, tagi_t tagss[])
1640 {
1641         struct lcr_msg *message;
1642         int cause = 0, location = 0;
1643         int media_types[32];
1644         uint8_t payload_types[32];
1645         int payloads = 0;
1646
1647         PDEBUG(DEBUG_SIP, "response to invite received (status = %d)\n", status);
1648
1649         sip_trace_header(this, "RESPOND", DIRECTION_OUT);
1650         add_trace("respond", "value", "%d", status);
1651         end_trace();
1652
1653         /* connect audio */
1654         if (status == 183 || (status >= 200 && status <= 299)) {
1655                 int ret;
1656
1657                 sip_trace_header(this, "Payload received", DIRECTION_NONE);
1658                 ret = parse_sdp(sip, &p_s_rtp_ip_remote, &p_s_rtp_port_remote, payload_types, media_types, &payloads, sizeof(payload_types));
1659                 if (!ret) {
1660                         if (payloads != 1)
1661                                 ret = 415;
1662                         else if (!p_s_rtp_bridge) {
1663                                 if (media_types[0] != ((options.law=='a') ? MEDIA_TYPE_ALAW : MEDIA_TYPE_ULAW)) {
1664                                         add_trace("error", NULL, "Expected LAW payload type (not bridged)");
1665                                         ret = 415;
1666                                 }
1667                         }
1668                 }
1669                 end_trace();
1670                 if (ret) {
1671                         nua_cancel(nh, TAG_END());
1672                         sip_trace_header(this, "CANCEL", DIRECTION_OUT);
1673                         add_trace("reason", NULL, "accepted codec does not match");
1674                         end_trace();
1675                         cause = 88;
1676                         location = LOCATION_PRIVATE_LOCAL;
1677                         goto release_with_cause;
1678                 }
1679
1680                 /* connect to remote RTP (if not bridging) */
1681                 if (!p_s_rtp_bridge && rtp_connect() < 0) {
1682                         nua_cancel(nh, TAG_END());
1683                         sip_trace_header(this, "CANCEL", DIRECTION_OUT);
1684                         add_trace("reason", NULL, "failed to open RTP/RTCP sockts");
1685                         end_trace();
1686                         cause = 31;
1687                         location = LOCATION_PRIVATE_LOCAL;
1688                         goto release_with_cause;
1689                 }
1690         }
1691
1692         /* process 1xx */
1693         switch (status) {
1694         case 100:
1695 #if 0
1696                 PDEBUG(DEBUG_SIP, "do proceeding\n");
1697                 new_state(PORT_STATE_OUT_PROCEEDING);
1698                 message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_PROCEEDING);
1699                 message_put(message);
1700 #endif
1701                 return;
1702         case 180:
1703                 PDEBUG(DEBUG_SIP, "do alerting\n");
1704                 new_state(PORT_STATE_OUT_ALERTING);
1705                 message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_ALERTING);
1706                 message_put(message);
1707                 return;
1708         case 183:
1709                 PDEBUG(DEBUG_SIP, "do progress\n");
1710                 message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_PROGRESS);
1711                 message->param.progressinfo.progress = 8;
1712                 message->param.progressinfo.location = 10;
1713                 if (p_s_rtp_bridge) {
1714                         message->param.progressinfo.rtpinfo.ip = p_s_rtp_ip_remote;
1715                         message->param.progressinfo.rtpinfo.port = p_s_rtp_port_remote;
1716                         message->param.progressinfo.rtpinfo.media_types[0] = media_types[0];
1717                         message->param.progressinfo.rtpinfo.payload_types[0] = payload_types[0];
1718                         message->param.progressinfo.rtpinfo.payloads = 1;
1719                 }
1720                 message_put(message);
1721                 return;
1722         default:
1723                 if (status < 100 || status > 199)
1724                         break;
1725                 PDEBUG(DEBUG_SIP, "skipping 1xx message\n");
1726
1727                 return;
1728         }
1729
1730         /* process 2xx */
1731         if (status >= 200 && status <= 299) {
1732                 PDEBUG(DEBUG_SIP, "do connect\n");
1733                 nua_ack(nh, TAG_END());
1734                 new_state(PORT_STATE_CONNECT);
1735                 message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_CONNECT);
1736                 if (p_s_rtp_bridge) {
1737                         message->param.connectinfo.rtpinfo.ip = p_s_rtp_ip_remote;
1738                         message->param.connectinfo.rtpinfo.port = p_s_rtp_port_remote;
1739                         message->param.connectinfo.rtpinfo.media_types[0] = media_types[0];
1740                         message->param.connectinfo.rtpinfo.payload_types[0] = payload_types[0];
1741                         message->param.connectinfo.rtpinfo.payloads = 1;
1742                 }
1743                 message_put(message);
1744                 return;
1745         }
1746         cause = status2cause(status);
1747         location = LOCATION_BEYOND;
1748
1749 release_with_cause:
1750         PDEBUG(DEBUG_SIP, "do release (cause %d)\n", cause);
1751
1752         while(p_epointlist) {
1753                 /* send setup message to endpoit */
1754                 message = message_create(p_serial, p_epointlist->epoint_id, PORT_TO_EPOINT, MESSAGE_RELEASE);
1755                 message->param.disconnectinfo.cause = cause;
1756                 message->param.disconnectinfo.location = location;
1757                 message_put(message);
1758                 /* remove epoint */
1759                 free_epointlist(p_epointlist);
1760         }
1761
1762         new_state(PORT_STATE_RELEASE);
1763
1764         rtp_close();
1765
1766         trigger_work(&p_s_delete);
1767 }
1768
1769 static void sip_callback(nua_event_t event, int status, char const *phrase, nua_t *nua, nua_magic_t *magic, nua_handle_t *nh, nua_hmagic_t *hmagic, sip_t const *sip, tagi_t tags[])
1770 {
1771         struct sip_inst *inst = (struct sip_inst *) magic;
1772         class Port *port;
1773         class Psip *psip = NULL;
1774
1775         PDEBUG(DEBUG_SIP, "Event %d from stack received (handle=%p)\n", event, nh);
1776         if (!nh)
1777                 return;
1778
1779         /* create or find port instance */
1780         if (event == nua_i_invite)
1781         {
1782                 char name[64];
1783                 struct interface *interface = interface_first;
1784
1785                 /* create call instance */
1786                 SPRINT(name, "%s-%d-in", inst->interface_name, 0);
1787                 while (interface) {
1788                         if (!strcmp(interface->name, inst->interface_name))
1789                                 break;
1790                         interface = interface->next;
1791                 }
1792                 if (!interface) {
1793                         PERROR("Cannot find interface %s.\n", inst->interface_name);
1794                         return;
1795                 }
1796                 if (!(psip = new Psip(PORT_TYPE_SIP_IN, name, NULL, interface)))
1797                         FATAL("Cannot create Port instance.\n");
1798         } else {
1799                 port = port_first;
1800                 while(port) {
1801                         if ((port->p_type & PORT_CLASS_mISDN_MASK) == PORT_CLASS_SIP) {
1802                                 psip = (class Psip *)port;
1803                                 if (psip->p_s_handle == nh) {
1804                                         break;
1805                                 }
1806                         }
1807                         port = port->next;
1808                 }
1809         }
1810         if (!psip) {
1811                 PERROR("no SIP Port found for handel %p\n", nh);
1812                 nua_respond(nh, SIP_500_INTERNAL_SERVER_ERROR, TAG_END());
1813                 nua_handle_destroy(nh);
1814                 return;
1815         }
1816
1817         switch (event) {
1818         case nua_r_set_params:
1819                 PDEBUG(DEBUG_SIP, "setparam response\n");
1820                 break;
1821         case nua_i_error:
1822                 PDEBUG(DEBUG_SIP, "error received\n");
1823                 break;
1824         case nua_i_state:
1825                 PDEBUG(DEBUG_SIP, "state change received\n");
1826                 break;
1827         case nua_i_register:
1828                 PDEBUG(DEBUG_SIP, "register received\n");
1829                 break;
1830         case nua_i_invite:
1831                 psip->i_invite(status, phrase, nua, magic, nh, hmagic, sip, tags);
1832                 break;
1833         case nua_i_ack:
1834                 PDEBUG(DEBUG_SIP, "ack received\n");
1835                 break;
1836         case nua_i_active:
1837                 PDEBUG(DEBUG_SIP, "active received\n");
1838                 break;
1839         case nua_i_bye:
1840                 psip->i_bye(status, phrase, nua, magic, nh, hmagic, sip, tags);
1841                 break;
1842         case nua_i_cancel:
1843                 psip->i_cancel(status, phrase, nua, magic, nh, hmagic, sip, tags);
1844                 break;
1845         case nua_r_bye:
1846                 psip->r_bye(status, phrase, nua, magic, nh, hmagic, sip, tags);
1847                 break;
1848         case nua_r_cancel:
1849                 psip->r_cancel(status, phrase, nua, magic, nh, hmagic, sip, tags);
1850                 break;
1851         case nua_r_invite:
1852                 psip->r_invite(status, phrase, nua, magic, nh, hmagic, sip, tags);
1853                 break;
1854         case nua_i_terminated:
1855                 PDEBUG(DEBUG_SIP, "terminated received\n");
1856                 break;
1857         default:
1858                 PDEBUG(DEBUG_SIP, "Event %d not handled\n", event);
1859         }
1860 }
1861
1862 /* received shutdown due to termination of RTP */
1863 void Psip::rtp_shutdown(void)
1864 {
1865         struct lcr_msg *message;
1866
1867         PDEBUG(DEBUG_SIP, "RTP stream terminated\n");
1868
1869         sip_trace_header(this, "RTP terminated", DIRECTION_IN);
1870         end_trace();
1871
1872         nua_handle_destroy(p_s_handle);
1873         p_s_handle = NULL;
1874
1875         while(p_epointlist) {
1876                 /* send setup message to endpoit */
1877                 message = message_create(p_serial, p_epointlist->epoint_id, PORT_TO_EPOINT, MESSAGE_RELEASE);
1878                 message->param.disconnectinfo.cause = 16;
1879                 message->param.disconnectinfo.location = LOCATION_BEYOND;
1880                 message_put(message);
1881                 /* remove epoint */
1882                 free_epointlist(p_epointlist);
1883         }
1884         new_state(PORT_STATE_RELEASE);
1885         trigger_work(&p_s_delete);
1886 }
1887
1888 int sip_init_inst(struct interface *interface)
1889 {
1890         struct sip_inst *inst = (struct sip_inst *) MALLOC(sizeof(*inst));
1891         char local[64];
1892
1893         interface->sip_inst = inst;
1894         SCPY(inst->interface_name, interface->name);
1895         SCPY(inst->local_peer, interface->sip_local_peer);
1896         SCPY(inst->remote_peer, interface->sip_remote_peer);
1897
1898         /* init root object */
1899         inst->root = su_root_create(inst);
1900         if (!inst->root) {
1901                 PERROR("Failed to create SIP root\n");
1902                 sip_exit_inst(interface);
1903                 return -EINVAL;
1904         }
1905
1906         SPRINT(local, "sip:%s",inst->local_peer);
1907         if (!strchr(inst->local_peer, ':'))
1908                 SCAT(local, ":5060");
1909         inst->nua = nua_create(inst->root, sip_callback, inst, NUTAG_URL(local), TAG_END());
1910         if (!inst->nua) {
1911                 PERROR("Failed to create SIP stack object\n");
1912                 sip_exit_inst(interface);
1913                 return -EINVAL;
1914         }
1915         nua_set_params(inst->nua,
1916                 SIPTAG_ALLOW_STR("INVITE,ACK,BYE,CANCEL,OPTIONS,NOTIFY,INFO"),
1917                 NUTAG_APPL_METHOD("INVITE"),
1918                 NUTAG_APPL_METHOD("ACK"),
1919 //              NUTAG_APPL_METHOD("BYE"), /* we must reply to BYE */
1920                 NUTAG_APPL_METHOD("CANCEL"),
1921                 NUTAG_APPL_METHOD("OPTIONS"),
1922                 NUTAG_APPL_METHOD("NOTIFY"),
1923                 NUTAG_APPL_METHOD("INFO"),
1924                 NUTAG_AUTOACK(0),
1925 #ifdef NUTAG_AUTO100
1926                 NUTAG_AUTO100(0),
1927 #endif
1928                 NUTAG_AUTOALERT(0),
1929                 NUTAG_AUTOANSWER(0),
1930                 TAG_NULL());
1931
1932         PDEBUG(DEBUG_SIP, "SIP interface created (inst=%p)\n", inst);
1933
1934         any_sip_interface = 1;
1935
1936         return 0;
1937 }
1938
1939 void sip_exit_inst(struct interface *interface)
1940 {
1941         struct sip_inst *inst = (struct sip_inst *) interface->sip_inst;
1942
1943         if (!inst)
1944                 return;
1945         if (inst->root)
1946                 su_root_destroy(inst->root);
1947         if (inst->nua) {
1948                 nua_destroy(inst->nua);
1949         }
1950         FREE(inst, sizeof(*inst));
1951         interface->sip_inst = NULL;
1952
1953         PDEBUG(DEBUG_SIP, "SIP interface removed\n");
1954
1955         /* check if there is any other SIP interface left */
1956         interface = interface_first;
1957         while (interface) {
1958                 if (interface->sip_inst)
1959                         break;
1960                 interface = interface->next;
1961         }
1962         if (!interface)
1963                 any_sip_interface = 0;
1964 }
1965
1966 extern su_log_t su_log_default[];
1967 extern su_log_t nua_log[];
1968 //extern su_log_t soa_log[];
1969
1970 int sip_init(void)
1971 {
1972         int i;
1973
1974         /* init SOFIA lib */
1975         su_init();
1976         su_home_init(sip_home);
1977
1978         if (options.deb & DEBUG_SIP) {
1979                 su_log_set_level(su_log_default, 9);
1980                 su_log_set_level(nua_log, 9);
1981                 //su_log_set_level(soa_log, 9);
1982         }
1983
1984         for (i = 0; i < 256; i++)
1985                 flip[i] = ((i & 1) << 7) + ((i & 2) << 5) + ((i & 4) << 3) + ((i & 8) << 1) + ((i & 16) >> 1) + ((i & 32) >> 3) + ((i & 64) >> 5) + ((i & 128) >> 7);
1986
1987         PDEBUG(DEBUG_SIP, "SIP globals initialized\n");
1988
1989         return 0;
1990 }
1991
1992 void sip_exit(void)
1993 {
1994         su_home_deinit(sip_home);
1995         su_deinit();
1996
1997         PDEBUG(DEBUG_SIP, "SIP globals de-initialized\n");
1998 }
1999
2000 void sip_handle(void)
2001 {
2002         struct interface *interface = interface_first;
2003         struct sip_inst *inst;
2004
2005         while (interface) {
2006                 if (interface->sip_inst) {
2007                         inst = (struct sip_inst *) interface->sip_inst;
2008                         su_root_step(inst->root, 0);
2009                 }
2010                 interface = interface->next;
2011         }
2012 }
2013
2014 /* deletes when back in event loop */
2015 static int delete_event(struct lcr_work *work, void *instance, int index)
2016 {
2017         class Psip *psip = (class Psip *)instance;
2018
2019         delete psip;
2020
2021         return 0;
2022 }
2023
2024
2025 /*
2026  * generate audio, if no data is received from bridge
2027  */
2028
2029 void Psip::set_tone(const char *dir, const char *tone)
2030 {
2031         Port::set_tone(dir, tone);
2032
2033         update_load();
2034 }
2035
2036 void Psip::update_load(void)
2037 {
2038         /* don't trigger load event if event already active */
2039         if (p_s_loadtimer.active)
2040                 return;
2041
2042         /* don't start timer if ... */
2043         if (!p_tone_name[0])
2044                 return;
2045
2046         p_s_next_tv_sec = 0;
2047         schedule_timer(&p_s_loadtimer, 0, 0); /* no delay the first time */
2048 }
2049
2050 static int load_timer(struct lcr_timer *timer, void *instance, int index)
2051 {
2052         class Psip *psip = (class Psip *)instance;
2053
2054         /* stop timer if ... */
2055         if (!psip->p_tone_name[0])
2056                 return 0;
2057
2058         psip->load_tx();
2059
2060         return 0;
2061 }
2062
2063 #define SEND_SIP_LEN 160
2064
2065 void Psip::load_tx(void)
2066 {
2067         int diff;
2068         struct timeval current_time;
2069         int tosend = SEND_SIP_LEN, i;
2070         unsigned char buf[SEND_SIP_LEN], *p = buf;
2071
2072         /* get elapsed */
2073         gettimeofday(&current_time, NULL);
2074         if (!p_s_next_tv_sec) {
2075                 /* if timer expired the first time, set next expected timeout 160 samples in advance */
2076                 p_s_next_tv_sec = current_time.tv_sec;
2077                 p_s_next_tv_usec = current_time.tv_usec + SEND_SIP_LEN * 125;
2078                 if (p_s_next_tv_usec >= 1000000) {
2079                         p_s_next_tv_usec -= 1000000;
2080                         p_s_next_tv_sec++;
2081                 }
2082                 schedule_timer(&p_s_loadtimer, 0, SEND_SIP_LEN * 125);
2083         } else {
2084                 diff = 1000000 * (current_time.tv_sec - p_s_next_tv_sec)
2085                         + (current_time.tv_usec - p_s_next_tv_usec);
2086                 if (diff < -SEND_SIP_LEN * 125 || diff > SEND_SIP_LEN * 125) {
2087                         /* if clock drifts too much, set next timeout event to current timer + 160 */
2088                         diff = 0;
2089                         p_s_next_tv_sec = current_time.tv_sec;
2090                         p_s_next_tv_usec = current_time.tv_usec + SEND_SIP_LEN * 125;
2091                         if (p_s_next_tv_usec >= 1000000) {
2092                                 p_s_next_tv_usec -= 1000000;
2093                                 p_s_next_tv_sec++;
2094                         }
2095                 } else {
2096                         /* if diff is positive, it took too long, so next timeout will be earlier */
2097                         p_s_next_tv_usec += SEND_SIP_LEN * 125;
2098                         if (p_s_next_tv_usec >= 1000000) {
2099                                 p_s_next_tv_usec -= 1000000;
2100                                 p_s_next_tv_sec++;
2101                         }
2102                 }
2103                 schedule_timer(&p_s_loadtimer, 0, SEND_SIP_LEN * 125 - diff);
2104         }
2105
2106         /* copy tones */
2107         if (p_tone_name[0]) {
2108                 tosend -= read_audio(p, tosend);
2109         }
2110         if (tosend) {
2111                 PERROR("buffer is not completely filled\n");
2112                 return;
2113         }
2114
2115         p = buf;
2116         for (i = 0; i < SEND_SIP_LEN; i++) {
2117                 *p = flip[*p];
2118                 p++;
2119         }
2120         /* transmit data via rtp */
2121         rtp_send_frame(buf, SEND_SIP_LEN, (options.law=='a')?PAYLOAD_TYPE_ALAW:PAYLOAD_TYPE_ULAW);
2122 }
2123