bchannel.c

   1 /*****************************************************************************\
   2 **                                                                           **
   3 ** Linux Call Router                                                         **
   4 **                                                                           **
   5 **---------------------------------------------------------------------------**
   6 ** Copyright: Andreas Eversberg                                              **
   7 **                                                                           **
   8 ** mISDN channel handlin for remote application                              **
   9 **                                                                           **
  10 \*****************************************************************************/
  11
  12 #include <stdio.h>
  13 #include <stdlib.h>
  14 #include <unistd.h>
  15 #include <string.h>
  16 #include <poll.h>
  17 #include <errno.h>
  18 #include <sys/ioctl.h>
  19 #include <sys/types.h>
  20 #include <sys/stat.h>
  21 #include <fcntl.h>
  22 #include <netinet/udp.h>
  23 #include <netinet/in.h>
  24 #include <netdb.h>
  25 #include <sys/socket.h>
  26 #include <mISDNif.h>
  27
  28 #include <asterisk/frame.h>
  29
  30
  31 #include "extension.h"
  32 #include "message.h"
  33 #include "lcrsocket.h"
  34 #include "cause.h"
  35 #include "bchannel.h"
  36 #include "chan_lcr.h"
  37 #include "callerid.h"
  38
  39
  40 #ifndef ISDN_PID_L4_B_USER
  41 #define ISDN_PID_L4_B_USER 0x440000ff
  42 #endif
  43
  44 pid_t   bchannel_pid;
  45
  46 enum {
  47         BSTATE_IDLE,
  48         BSTATE_ACTIVATING,
  49         BSTATE_ACTIVE,
  50         BSTATE_DEACTIVATING,
  51 };
  52
  53
  54 int bchannel_initialize(void)
  55 {
  56         return(0);
  57 }
  58
  59 void bchannel_deinitialize(void)
  60 {
  61 }
  62
  63 /*
  64  * send control information to the channel (dsp-module)
  65  */
  66 static void ph_control(unsigned long handle, unsigned long c1, unsigned long c2, char *trace_name, int trace_value)
  67 {
  68         unsigned char buffer[MISDN_HEADER_LEN+sizeof(int)+sizeof(int)];
  69         struct mISDNhead *ctrl = (struct mISDNhead *)buffer;
  70         unsigned long *d = (unsigned long *)(buffer+MISDN_HEADER_LEN);
  71         int ret;
  72
  73         CDEBUG(NULL, NULL, "Sending PH_CONTROL %d,%d\n", c1, c2);
  74         ctrl->prim = PH_CONTROL_REQ;
  75         ctrl->id = 0;
  76         *d++ = c1;
  77         *d++ = c2;
  78         ret = sendto(handle, buffer, MISDN_HEADER_LEN+sizeof(int)*2, 0, NULL, 0);
  79         if (ret < 0)
  80                 CERROR(NULL, NULL, "Failed to send to socket %d\n", handle);
  81 #if 0
  82         chan_trace_header(mISDNport, isdnport, "BCHANNEL control", DIRECTION_OUT);
  83         if (c1 == CMX_CONF_JOIN)
  84                 add_trace(trace_name, NULL, "0x%08x", trace_value);
  85         else
  86                 add_trace(trace_name, NULL, "%d", trace_value);
  87         end_trace();
  88 #endif
  89 }
  90
  91 static void ph_control_block(unsigned long handle, unsigned long c1, void *c2, int c2_len, char *trace_name, int trace_value)
  92 {
  93         unsigned char buffer[MISDN_HEADER_LEN+sizeof(int)+c2_len];
  94         struct mISDNhead *ctrl = (struct mISDNhead *)buffer;
  95         unsigned long *d = (unsigned long *)(buffer+MISDN_HEADER_LEN);
  96         int ret;
  97
  98         CDEBUG(NULL, NULL, "Sending PH_CONTROL (block) %d\n", c1);
  99         ctrl->prim = PH_CONTROL_REQ;
 100         ctrl->id = 0;
 101         *d++ = c1;
 102         memcpy(d, c2, c2_len);
 103         ret = sendto(handle, buffer, MISDN_HEADER_LEN+sizeof(int)+c2_len, 0, NULL, 0);
 104         if (ret < 0)
 105                 CERROR(NULL, NULL, "Failed to send to socket %d\n", handle);
 106 #if 0
 107         chan_trace_header(mISDNport, isdnport, "BCHANNEL control", DIRECTION_OUT);
 108         add_trace(trace_name, NULL, "%d", trace_value);
 109         end_trace();
 110 #endif
 111 }
 112
 113
 114 /*
 115  * create stack
 116  */
 117 int bchannel_create(struct bchannel *bchannel)
 118 {
 119         int ret;
 120         unsigned long on = 1;
 121         struct sockaddr_mISDN addr;
 122
 123         if (bchannel->b_sock)
 124         {
 125                 CERROR(NULL, NULL, "Socket already created for handle 0x%x\n", bchannel->handle);
 126                 return(0);
 127         }
 128
 129         /* open socket */
 130         bchannel->b_sock = socket(PF_ISDN, SOCK_DGRAM, ISDN_P_B_L2DSP);
 131         if (bchannel->b_sock < 0)
 132         {
 133                 CERROR(NULL, NULL, "Failed to open bchannel-socket for handle 0x%x with mISDN-DSP layer. Did you load mISDNdsp.ko?\n", bchannel->handle);
 134                 return(0);
 135         }
 136
 137         /* set nonblocking io */
 138         ret = ioctl(bchannel->b_sock, FIONBIO, &on);
 139         if (ret < 0)
 140         {
 141                 CERROR(NULL, NULL, "Failed to set bchannel-socket handle 0x%x into nonblocking IO\n", bchannel->handle);
 142                 close(bchannel->b_sock);
 143                 bchannel->b_sock = -1;
 144                 bchannel->handle = 0;
 145                 return(0);
 146         }
 147
 148         /* bind socket to bchannel */
 149         addr.family = AF_ISDN;
 150         addr.dev = (bchannel->handle>>8)-1;
 151         addr.channel = bchannel->handle && 0xff;
 152         ret = bind(bchannel->b_sock, (struct sockaddr *)&addr, sizeof(addr));
 153         if (ret < 0)
 154         {
 155                 CERROR(NULL, NULL, "Failed to bind bchannel-socket for handle 0x%x with mISDN-DSP layer. Did you load mISDNdsp.ko?\n", bchannel->handle);
 156                 close(bchannel->b_sock);
 157                 bchannel->b_sock = -1;
 158                 return(0);
 159         }
 160
 161 #if 0
 162         chan_trace_header(mISDNport, mISDNport->b_port[i], "BCHANNEL create socket", DIRECTION_OUT);
 163         add_trace("channel", NULL, "%d", i+1+(i>=15));
 164         add_trace("socket", NULL, "%d", mISDNport->b_socket[i]);
 165         end_trace();
 166 #endif
 167         return(1);
 168 }
 169
 170
 171 /*
 172  * activate / deactivate request
 173  */
 174 void bchannel_activate(struct bchannel *bchannel, int activate)
 175 {
 176         struct mISDNhead act;
 177         int ret;
 178
 179         /* activate bchannel */
 180         CDEBUG(NULL, NULL, "%sActivating B-channel.\n", activate?"":"De-");
 181         act.prim = (activate)?DL_ESTABLISH_REQ:DL_RELEASE_REQ;
 182         act.id = 0;
 183         ret = sendto(bchannel->b_sock, &act, MISDN_HEADER_LEN, 0, NULL, 0);
 184         if (ret < 0)
 185                 CERROR(NULL, NULL, "Failed to send to socket %d\n", bchannel->b_sock);
 186
 187         bchannel->b_state = (activate)?BSTATE_ACTIVATING:BSTATE_DEACTIVATING;
 188 #if 0
 189         /* trace */
 190         chan_trace_header(mISDNport, mISDNport->b_port[i], activate?(char*)"BCHANNEL activate":(char*)"BCHANNEL deactivate", DIRECTION_OUT);
 191         add_trace("channel", NULL, "%d", i+1+(i>=15));
 192         end_trace();
 193 #endif
 194 }
 195
 196
 197 /*
 198  * set features
 199  */
 200 static void bchannel_activated(struct bchannel *bchannel)
 201 {
 202         int handle;
 203
 204         handle = bchannel->b_sock;
 205
 206         /* set dsp features */
 207         if (bchannel->b_txdata)
 208                 ph_control(handle, (bchannel->b_txdata)?DSP_TXDATA_ON:DSP_TXDATA_OFF, 0, "DSP-TXDATA", bchannel->b_txdata);
 209         if (bchannel->b_delay)
 210                 ph_control(handle, DSP_DELAY, bchannel->b_delay, "DSP-DELAY", bchannel->b_delay);
 211         if (bchannel->b_tx_dejitter)
 212                 ph_control(handle, (bchannel->b_tx_dejitter)?DSP_TX_DEJITTER:DSP_TX_DEJ_OFF, 0, "DSP-TX_DEJITTER", bchannel->b_tx_dejitter);
 213         if (bchannel->b_tx_gain)
 214                 ph_control(handle, DSP_VOL_CHANGE_TX, bchannel->b_tx_gain, "DSP-TX_GAIN", bchannel->b_tx_gain);
 215         if (bchannel->b_rx_gain)
 216                 ph_control(handle, DSP_VOL_CHANGE_RX, bchannel->b_rx_gain, "DSP-RX_GAIN", bchannel->b_rx_gain);
 217         if (bchannel->b_pipeline[0])
 218                 ph_control_block(handle, DSP_PIPELINE_CFG, bchannel->b_pipeline, strlen(bchannel->b_pipeline)+1, "DSP-PIPELINE", 0);
 219         if (bchannel->b_conf)
 220                 ph_control(handle, DSP_CONF_JOIN, bchannel->b_conf, "DSP-CONF", bchannel->b_conf);
 221         if (bchannel->b_echo)
 222                 ph_control(handle, DSP_ECHO_ON, 0, "DSP-ECHO", 1);
 223         if (bchannel->b_tone)
 224                 ph_control(handle, DSP_TONE_PATT_ON, bchannel->b_tone, "DSP-TONE", bchannel->b_tone);
 225         if (bchannel->b_rxoff)
 226                 ph_control(handle, DSP_RECEIVE_OFF, 0, "DSP-RXOFF", 1);
 227 //      if (bchannel->b_txmix)
 228 //              ph_control(handle, DSP_MIX_ON, 0, "DSP-MIX", 1);
 229         if (bchannel->b_dtmf)
 230                 ph_control(handle, DTMF_TONE_START, 0, "DSP-DTMF", 1);
 231         if (bchannel->b_crypt_len)
 232                 ph_control_block(handle, DSP_BF_ENABLE_KEY, bchannel->b_crypt_key, bchannel->b_crypt_len, "DSP-CRYPT", bchannel->b_crypt_len);
 233         if (bchannel->b_conf)
 234                 ph_control(handle, DSP_CONF_JOIN, bchannel->b_conf, "DSP-CONF", bchannel->b_conf);
 235
 236         bchannel->b_state = BSTATE_ACTIVE;
 237 }
 238
 239 /*
 240  * destroy stack
 241  */
 242 static void bchannel_destroy(struct bchannel *bchannel)
 243 {
 244 #if 0
 245         chan_trace_header(mISDNport, mISDNport->b_port[i], "BCHANNEL remove socket", DIRECTION_OUT);
 246         add_trace("channel", NULL, "%d", i+1+(i>=15));
 247         add_trace("socket", NULL, "%d", mISDNport->b_socket[i]);
 248         end_trace();
 249 #endif
 250         if (bchannel->b_sock > -1)
 251         {
 252                 close(bchannel->b_sock);
 253                 bchannel->b_sock = -1;
 254         }
 255         bchannel->b_state = BSTATE_IDLE;
 256 }
 257
 258
 259 /*
 260  * whenever we get audio data from bchannel, we process it here
 261  */
 262 static void bchannel_receive(struct bchannel *bchannel, unsigned long prim, unsigned long dinfo, unsigned char *data, int len)
 263 {
 264         unsigned long cont = *((unsigned long *)data);
 265 //      unsigned char *data_temp;
 266 //      unsigned long length_temp;
 267 //      unsigned char *p;
 268 //      int l;
 269
 270         if (prim == PH_CONTROL_IND)
 271         {
 272                 if (len < 4)
 273                 {
 274                         CERROR(NULL, NULL, "SHORT READ OF PH_CONTROL INDICATION\n");
 275                         return;
 276                 }
 277                 if ((cont&(~DTMF_TONE_MASK)) == DTMF_TONE_VAL)
 278                 {
 279 #if 0
 280                         chan_trace_header(p_m_mISDNport, this, "BCHANNEL control", DIRECTION_IN);
 281                         add_trace("DTMF", NULL, "%c", cont & DTMF_TONE_MASK);
 282                         end_trace();
 283 #endif
 284                         if (bchannel->rx_dtmf)
 285                                 bchannel->rx_dtmf(bchannel, cont & DTMF_TONE_MASK);
 286                         return;
 287                 }
 288                 switch(cont)
 289                 {
 290                         case DSP_BF_REJECT:
 291 #if 0
 292                         chan_trace_header(p_m_mISDNport, this, "BCHANNEL control", DIRECTION_IN);
 293                         add_trace("DSP-CRYPT", NULL, "error");
 294                         end_trace();
 295 #endif
 296                         break;
 297
 298                         case DSP_BF_ACCEPT:
 299 #if 0
 300                         chan_trace_header(p_m_mISDNport, this, "BCHANNEL control", DIRECTION_IN);
 301                         add_trace("DSP-CRYPT", NULL, "ok");
 302                         end_trace();
 303 #endif
 304                         break;
 305
 306                         default:
 307 #if 0
 308                         chan_trace_header(p_m_mISDNport, this, "BCHANNEL control", DIRECTION_IN);
 309                         add_trace("unknown", NULL, "0x%x", cont);
 310                         end_trace();
 311 #else
 312                         ;
 313 #endif
 314                 }
 315                 return;
 316         }
 317         if (prim == PH_DATA_REQ)
 318         {
 319                 if (!bchannel->b_txdata)
 320                 {
 321                         /* if tx is off, it may happen that fifos send us pending informations, we just ignore them */
 322                         CDEBUG(NULL, NULL, "ignoring tx data, because 'txdata' is turned off\n");
 323                         return;
 324                 }
 325                 return;
 326         }
 327         if (prim != PH_DATA_IND && prim != DL_DATA_IND)
 328         {
 329                 CERROR(NULL, NULL, "Bchannel received unknown primitve: 0x%lx\n", prim);
 330                 return;
 331         }
 332         /* calls will not process any audio data unless
 333          * the call is connected OR interface features audio during call setup.
 334          */
 335
 336         /* if rx is off, it may happen that fifos send us pending informations, we just ignore them */
 337         if (bchannel->b_rxoff)
 338         {
 339                 CDEBUG(NULL, NULL, "ignoring data, because rx is turned off\n");
 340                 return;
 341         }
 342
 343         if (!bchannel->call)
 344         {
 345                 CDEBUG(NULL, NULL, "ignoring data, because no call associated with bchannel\n");
 346                 return;
 347         }
 348         if (!bchannel->call->audiopath)
 349         {
 350                 /* return, because we have no audio from port */
 351                 return;
 352         }
 353         if (bchannel->call->pipe[1] > -1)
 354         {
 355                 len = write(bchannel->call->pipe[1], data, len);
 356                 if (len < 0)
 357                 {
 358                         close(bchannel->call->pipe[1]);
 359                         bchannel->call->pipe[1] = -1;
 360                         CDEBUG(NULL, NULL, "broken pipe on bchannel pipe\n");
 361                         return;
 362                 }
 363         }
 364 }
 365
 366
 367 /*
 368  * transmit data to bchannel
 369  */
 370 void bchannel_transmit(struct bchannel *bchannel, unsigned char *data, int len)
 371 {
 372         unsigned char buff[1024 + MISDN_HEADER_LEN], *p = buff + MISDN_HEADER_LEN;
 373         struct mISDNhead *frm = (struct mISDNhead *)buff;
 374         int ret;
 375         int i;
 376
 377         if (bchannel->b_state != BSTATE_ACTIVE)
 378                 return;
 379         if (len > 1024 || len < 1)
 380                 return;
 381         for (i = 0; i < len; i++)
 382                 *p++ = flip_bits[*data++];
 383         frm->prim = DL_DATA_REQ;
 384         frm->id = 0;
 385         ret = sendto(bchannel->b_sock, buff, MISDN_HEADER_LEN+len, 0, NULL, 0);
 386         if (ret < 0)
 387                 CERROR(NULL, NULL, "Failed to send to socket %d\n", bchannel->b_sock);
 388 }
 389
 390
 391 /*
 392  * join bchannel
 393  */
 394 void bchannel_join(struct bchannel *bchannel, unsigned short id)
 395 {
 396         int handle;
 397
 398         handle = bchannel->b_sock;
 399         if (id) {
 400                 bchannel->b_conf = (id<<16) + bchannel_pid;
 401                 bchannel->b_rxoff = 1;
 402         } else {
 403                 bchannel->b_conf = 0;
 404                 bchannel->b_rxoff = 0;
 405         }
 406         if (bchannel->b_state == BSTATE_ACTIVE)
 407         {
 408                 ph_control(handle, DSP_RECEIVE_OFF, bchannel->b_rxoff, "DSP-RX_OFF", bchannel->b_conf);
 409                 ph_control(handle, DSP_CONF_JOIN, bchannel->b_conf, "DSP-CONF", bchannel->b_conf);
 410         }
 411 }
 412
 413
 414 /*
 415  * main loop for processing messages from mISDN
 416  */
 417 int bchannel_handle(void)
 418 {
 419         int ret, work = 0;
 420         struct bchannel *bchannel;
 421         char buffer[2048+MISDN_HEADER_LEN];
 422         struct mISDNhead *hh = (struct mISDNhead *)buffer;
 423
 424         /* process all bchannels */
 425         bchannel = bchannel_first;
 426         while(bchannel)
 427         {
 428                 /* handle message from bchannel */
 429                 if (bchannel->b_sock > -1)
 430                 {
 431                         ret = recv(bchannel->b_sock, buffer, sizeof(buffer), 0);
 432                         if (ret >= (int)MISDN_HEADER_LEN)
 433                         {
 434                                 work = 1;
 435                                 switch(hh->prim)
 436                                 {
 437                                         /* we don't care about confirms, we use rx data to sync tx */
 438                                         case PH_DATA_CNF:
 439                                         break;
 440
 441                                         /* we receive audio data, we respond to it AND we send tones */
 442                                         case PH_DATA_IND:
 443                                         case PH_DATA_REQ:
 444                                         case DL_DATA_IND:
 445                                         case PH_CONTROL_IND:
 446                                         bchannel_receive(bchannel, hh->prim, hh->id, buffer+MISDN_HEADER_LEN, ret-MISDN_HEADER_LEN);
 447                                         break;
 448
 449                                         case PH_ACTIVATE_IND:
 450                                         case DL_ESTABLISH_IND:
 451                                         case PH_ACTIVATE_CNF:
 452                                         case DL_ESTABLISH_CNF:
 453                                         CDEBUG(NULL, NULL, "DL_ESTABLISH confirm: bchannel is now activated (socket %d).\n", bchannel->b_sock);
 454                                         bchannel_activated(bchannel);
 455                                         break;
 456
 457                                         case PH_DEACTIVATE_IND:
 458                                         case DL_RELEASE_IND:
 459                                         case PH_DEACTIVATE_CNF:
 460                                         case DL_RELEASE_CNF:
 461                                         CDEBUG(NULL, NULL, "DL_RELEASE confirm: bchannel is now de-activated (socket %d).\n", bchannel->b_sock);
 462 //                                      bchannel_deactivated(bchannel);
 463                                         break;
 464
 465                                         default:
 466                                         CERROR(NULL, NULL, "child message not handled: prim(0x%x) socket(%d) data len(%d)\n", hh->prim, bchannel->b_sock, ret - MISDN_HEADER_LEN);
 467                                 }
 468                         } else
 469                         {
 470                                 if (ret < 0 && errno != EWOULDBLOCK)
 471                                         CERROR(NULL, NULL, "Read from socket %d failed with return code %d\n", bchannel->b_sock, ret);
 472                         }
 473                 }
 474                 bchannel = bchannel->next;
 475         }
 476
 477         /* if we received at least one b-frame, we will return 1 */
 478         return(work);
 479 }
 480
 481
 482 /*
 483  * bchannel channel handling
 484  */
 485 struct bchannel *bchannel_first = NULL;
 486 struct bchannel *find_bchannel_handle(unsigned long handle)
 487 {
 488         struct bchannel *bchannel = bchannel_first;
 489
 490         while(bchannel)
 491         {
 492                 if (bchannel->handle == handle)
 493                         break;
 494                 bchannel = bchannel->next;
 495         }
 496         return(bchannel);
 497 }
 498
 499 #if 0
 500 struct bchannel *find_bchannel_ref(unsigned long ref)
 501 {
 502         struct bchannel *bchannel = bchannel_first;
 503
 504         while(bchannel)
 505         {
 506                 if (bchannel->ref == ref)
 507                         break;
 508                 bchannel = bchannel->next;
 509         }
 510         return(bchannel);
 511 }
 512 #endif
 513
 514 struct bchannel *alloc_bchannel(unsigned long handle)
 515 {
 516         struct bchannel **bchannelp = &bchannel_first;
 517
 518         while(*bchannelp)
 519                 bchannelp = &((*bchannelp)->next);
 520
 521         *bchannelp = (struct bchannel *)calloc(1, sizeof(struct bchannel));
 522         if (!*bchannelp)
 523                 return(NULL);
 524         (*bchannelp)->handle = handle;
 525         (*bchannelp)->b_state = BSTATE_IDLE;
 526
 527         return(*bchannelp);
 528 }
 529
 530 void free_bchannel(struct bchannel *bchannel)
 531 {
 532         struct bchannel **temp = &bchannel_first;
 533
 534         while(*temp)
 535         {
 536                 if (*temp == bchannel)
 537                 {
 538                         *temp = (*temp)->next;
 539                         if (bchannel->b_sock > -1)
 540                                 bchannel_destroy(bchannel);
 541                         if (bchannel->call)
 542                         {
 543                                 if (bchannel->call->bchannel)
 544                                         bchannel->call->bchannel = NULL;
 545                         }
 546                         free(bchannel);
 547                         return;
 548                 }
 549                 temp = &((*temp)->next);
 550         }
 551 }
 552
 553