SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/isdn/divert/isdn_divert.c

   1 /* $Id: isdn_divert.c,v 1.6.6.3 2001/09/23 22:24:36 kai Exp $
   2  *
   3  * DSS1 main diversion supplementary handling for i4l.
   4  *
   5  * Copyright 1999       by Werner Cornelius (werner@isdn4linux.de)
   6  *
   7  * This software may be used and distributed according to the terms
   8  * of the GNU General Public License, incorporated herein by reference.
   9  *
  10  */
  11
  12 #include <linux/proc_fs.h>
  13 #include <linux/slab.h>
  14 #include <linux/timer.h>
  15 #include <linux/jiffies.h>
  16
  17 #include "isdn_divert.h"
  18
  19 /**********************************/
  20 /* structure keeping calling info */
  21 /**********************************/
  22 struct call_struc
  23   { isdn_ctrl ics; /* delivered setup + driver parameters */
  24     ulong divert_id; /* Id delivered to user */
  25     unsigned char akt_state; /* actual state */
  26     char deflect_dest[35]; /* deflection destination */
  27     struct timer_list timer; /* timer control structure */
  28     char info[90]; /* device info output */
  29     struct call_struc *next; /* pointer to next entry */
  30     struct call_struc *prev;
  31   };
  32
  33
  34 /********************************************/
  35 /* structure keeping deflection table entry */
  36 /********************************************/
  37 struct deflect_struc
  38   { struct deflect_struc *next,*prev;
  39     divert_rule rule; /* used rule */
  40   };
  41
  42
  43 /*****************************************/
  44 /* variables for main diversion services */
  45 /*****************************************/
  46 /* diversion/deflection processes */
  47 static struct call_struc *divert_head = NULL; /* head of remembered entrys */
  48 static ulong next_id = 1; /* next info id */
  49 static struct deflect_struc *table_head = NULL;
  50 static struct deflect_struc *table_tail = NULL;
  51 static unsigned char extern_wait_max = 4; /* maximum wait in s for external process */
  52
  53 DEFINE_SPINLOCK(divert_lock);
  54
  55 /***************************/
  56 /* timer callback function */
  57 /***************************/
  58 static void deflect_timer_expire(ulong arg)
  59 {
  60   unsigned long flags;
  61   struct call_struc *cs = (struct call_struc *) arg;
  62
  63   spin_lock_irqsave(&divert_lock, flags);
  64   del_timer(&cs->timer); /* delete active timer */
  65   spin_unlock_irqrestore(&divert_lock, flags);
  66
  67   switch(cs->akt_state)
  68    { case DEFLECT_PROCEED:
  69        cs->ics.command = ISDN_CMD_HANGUP; /* cancel action */
  70        divert_if.ll_cmd(&cs->ics);
  71        spin_lock_irqsave(&divert_lock, flags);
  72        cs->akt_state = DEFLECT_AUTODEL; /* delete after timeout */
  73        cs->timer.expires = jiffies + (HZ * AUTODEL_TIME);
  74        add_timer(&cs->timer);
  75        spin_unlock_irqrestore(&divert_lock, flags);
  76        break;
  77
  78      case DEFLECT_ALERT:
  79        cs->ics.command = ISDN_CMD_REDIR; /* protocol */
  80        strcpy(cs->ics.parm.setup.phone,cs->deflect_dest);
  81        strcpy(cs->ics.parm.setup.eazmsn,"Testtext delayed");
  82        divert_if.ll_cmd(&cs->ics);
  83        spin_lock_irqsave(&divert_lock, flags);
  84        cs->akt_state = DEFLECT_AUTODEL; /* delete after timeout */
  85        cs->timer.expires = jiffies + (HZ * AUTODEL_TIME);
  86        add_timer(&cs->timer);
  87        spin_unlock_irqrestore(&divert_lock, flags);
  88        break;
  89
  90      case DEFLECT_AUTODEL:
  91      default:
  92        spin_lock_irqsave(&divert_lock, flags);
  93        if (cs->prev)
  94          cs->prev->next = cs->next; /* forward link */
  95         else
  96          divert_head = cs->next;
  97        if (cs->next)
  98          cs->next->prev = cs->prev; /* back link */
  99        spin_unlock_irqrestore(&divert_lock, flags);
 100        kfree(cs);
 101        return;
 102
 103    } /* switch */
 104 } /* deflect_timer_func */
 105
 106
 107 /*****************************************/
 108 /* handle call forwarding de/activations */
 109 /* 0 = deact, 1 = act, 2 = interrogate   */
 110 /*****************************************/
 111 int cf_command(int drvid, int mode,
 112                u_char proc, char *msn,
 113                u_char service, char *fwd_nr, ulong *procid)
 114 { unsigned long flags;
 115   int retval,msnlen;
 116   int fwd_len;
 117   char *p,*ielenp,tmp[60];
 118   struct call_struc *cs;
 119
 120   if (strchr(msn,'.')) return(-EINVAL); /* subaddress not allowed in msn */
 121   if ((proc & 0x7F) > 2) return(-EINVAL);
 122   proc &= 3;
 123   p = tmp;
 124   *p++ = 0x30; /* enumeration */
 125   ielenp = p++; /* remember total length position */
 126   *p++ = 0xa; /* proc tag */
 127   *p++ = 1;   /* length */
 128   *p++ = proc & 0x7F; /* procedure to de/activate/interrogate */
 129   *p++ = 0xa; /* service tag */
 130   *p++ = 1;   /* length */
 131   *p++ = service; /* service to handle */
 132
 133   if (mode == 1)
 134    { if (!*fwd_nr) return(-EINVAL); /* destination missing */
 135      if (strchr(fwd_nr,'.')) return(-EINVAL); /* subaddress not allowed */
 136      fwd_len = strlen(fwd_nr);
 137      *p++ = 0x30; /* number enumeration */
 138      *p++ = fwd_len + 2; /* complete forward to len */
 139      *p++ = 0x80; /* fwd to nr */
 140      *p++ = fwd_len; /* length of number */
 141      strcpy(p,fwd_nr); /* copy number */
 142      p += fwd_len; /* pointer beyond fwd */
 143    } /* activate */
 144
 145   msnlen = strlen(msn);
 146   *p++ = 0x80; /* msn number */
 147   if (msnlen > 1)
 148    { *p++ = msnlen; /* length */
 149      strcpy(p,msn);
 150      p += msnlen;
 151    }
 152   else *p++ = 0;
 153
 154   *ielenp = p - ielenp - 1; /* set total IE length */
 155
 156   /* allocate mem for information struct */
 157   if (!(cs = kmalloc(sizeof(struct call_struc), GFP_ATOMIC)))
 158              return(-ENOMEM); /* no memory */
 159   init_timer(&cs->timer);
 160   cs->info[0] = '\0';
 161   cs->timer.function = deflect_timer_expire;
 162   cs->timer.data = (ulong) cs; /* pointer to own structure */
 163   cs->ics.driver = drvid;
 164   cs->ics.command = ISDN_CMD_PROT_IO; /* protocol specific io */
 165   cs->ics.arg = DSS1_CMD_INVOKE; /* invoke supplementary service */
 166   cs->ics.parm.dss1_io.proc = (mode == 1) ? 7: (mode == 2) ? 11:8; /* operation */
 167   cs->ics.parm.dss1_io.timeout = 4000; /* from ETS 300 207-1 */
 168   cs->ics.parm.dss1_io.datalen = p - tmp; /* total len */
 169   cs->ics.parm.dss1_io.data = tmp; /* start of buffer */
 170
 171   spin_lock_irqsave(&divert_lock, flags);
 172   cs->ics.parm.dss1_io.ll_id = next_id++; /* id for callback */
 173   spin_unlock_irqrestore(&divert_lock, flags);
 174   *procid = cs->ics.parm.dss1_io.ll_id;
 175
 176   sprintf(cs->info,"%d 0x%lx %s%s 0 %s %02x %d%s%s\n",
 177           (!mode ) ? DIVERT_DEACTIVATE : (mode == 1) ? DIVERT_ACTIVATE : DIVERT_REPORT,
 178           cs->ics.parm.dss1_io.ll_id,
 179           (mode != 2) ? "" : "0 ",
 180           divert_if.drv_to_name(cs->ics.driver),
 181           msn,
 182           service & 0xFF,
 183           proc,
 184           (mode != 1) ? "" : " 0 ",
 185           (mode != 1) ? "" : fwd_nr);
 186
 187   retval = divert_if.ll_cmd(&cs->ics); /* execute command */
 188
 189   if (!retval)
 190    { cs->prev = NULL;
 191      spin_lock_irqsave(&divert_lock, flags);
 192      cs->next = divert_head;
 193      divert_head = cs;
 194      spin_unlock_irqrestore(&divert_lock, flags);
 195    }
 196   else
 197    kfree(cs);
 198   return(retval);
 199 } /* cf_command */
 200
 201
 202 /****************************************/
 203 /* handle a external deflection command */
 204 /****************************************/
 205 int deflect_extern_action(u_char cmd, ulong callid, char *to_nr)
 206 { struct call_struc *cs;
 207   isdn_ctrl ic;
 208   unsigned long flags;
 209   int i;
 210
 211   if ((cmd & 0x7F) > 2) return(-EINVAL); /* invalid command */
 212   cs = divert_head; /* start of parameter list */
 213   while (cs)
 214    { if (cs->divert_id == callid) break; /* found */
 215      cs = cs->next;
 216    } /* search entry */
 217   if (!cs) return(-EINVAL); /* invalid callid */
 218
 219   ic.driver = cs->ics.driver;
 220   ic.arg = cs->ics.arg;
 221   i = -EINVAL;
 222   if (cs->akt_state == DEFLECT_AUTODEL) return(i); /* no valid call */
 223   switch (cmd & 0x7F)
 224    { case 0: /* hangup */
 225        del_timer(&cs->timer);
 226        ic.command = ISDN_CMD_HANGUP;
 227        i = divert_if.ll_cmd(&ic);
 228        spin_lock_irqsave(&divert_lock, flags);
 229        cs->akt_state = DEFLECT_AUTODEL; /* delete after timeout */
 230        cs->timer.expires = jiffies + (HZ * AUTODEL_TIME);
 231        add_timer(&cs->timer);
 232        spin_unlock_irqrestore(&divert_lock, flags);
 233      break;
 234
 235      case 1: /* alert */
 236        if (cs->akt_state == DEFLECT_ALERT) return(0);
 237        cmd &= 0x7F; /* never wait */
 238        del_timer(&cs->timer);
 239        ic.command = ISDN_CMD_ALERT;
 240        if ((i = divert_if.ll_cmd(&ic)))
 241         {
 242           spin_lock_irqsave(&divert_lock, flags);
 243           cs->akt_state = DEFLECT_AUTODEL; /* delete after timeout */
 244           cs->timer.expires = jiffies + (HZ * AUTODEL_TIME);
 245           add_timer(&cs->timer);
 246           spin_unlock_irqrestore(&divert_lock, flags);
 247         }
 248        else
 249           cs->akt_state = DEFLECT_ALERT;
 250      break;
 251
 252      case 2: /* redir */
 253        del_timer(&cs->timer);
 254        strcpy(cs->ics.parm.setup.phone, to_nr);
 255        strcpy(cs->ics.parm.setup.eazmsn, "Testtext manual");
 256        ic.command = ISDN_CMD_REDIR;
 257        if ((i = divert_if.ll_cmd(&ic)))
 258         {
 259           spin_lock_irqsave(&divert_lock, flags);
 260           cs->akt_state = DEFLECT_AUTODEL; /* delete after timeout */
 261           cs->timer.expires = jiffies + (HZ * AUTODEL_TIME);
 262           add_timer(&cs->timer);
 263           spin_unlock_irqrestore(&divert_lock, flags);
 264         }
 265        else
 266           cs->akt_state = DEFLECT_ALERT;
 267      break;
 268
 269    } /* switch */
 270   return(i);
 271 } /* deflect_extern_action */
 272
 273 /********************************/
 274 /* insert a new rule before idx */
 275 /********************************/
 276 int insertrule(int idx, divert_rule *newrule)
 277 { struct deflect_struc *ds,*ds1=NULL;
 278   unsigned long flags;
 279
 280   if (!(ds = kmalloc(sizeof(struct deflect_struc),
 281                                               GFP_KERNEL)))
 282     return(-ENOMEM); /* no memory */
 283
 284   ds->rule = *newrule; /* set rule */
 285
 286   spin_lock_irqsave(&divert_lock, flags);
 287
 288   if (idx >= 0)
 289    { ds1 = table_head;
 290      while ((ds1) && (idx > 0))
 291       { idx--;
 292         ds1 = ds1->next;
 293       }
 294      if (!ds1) idx = -1;
 295    }
 296
 297   if (idx < 0)
 298    { ds->prev = table_tail; /* previous entry */
 299      ds->next = NULL; /* end of chain */
 300      if (ds->prev)
 301        ds->prev->next = ds; /* last forward */
 302       else
 303         table_head = ds; /* is first entry */
 304      table_tail = ds; /* end of queue */
 305    }
 306   else
 307     { ds->next = ds1; /* next entry */
 308       ds->prev = ds1->prev; /* prev entry */
 309       ds1->prev = ds; /* backward chain old element */
 310       if (!ds->prev)
 311         table_head = ds; /* first element */
 312    }
 313
 314   spin_unlock_irqrestore(&divert_lock, flags);
 315   return(0);
 316 } /* insertrule */
 317
 318 /***********************************/
 319 /* delete the rule at position idx */
 320 /***********************************/
 321 int deleterule(int idx)
 322 { struct deflect_struc *ds,*ds1;
 323   unsigned long flags;
 324
 325   if (idx < 0)
 326    { spin_lock_irqsave(&divert_lock, flags);
 327      ds = table_head;
 328      table_head = NULL;
 329      table_tail = NULL;
 330      spin_unlock_irqrestore(&divert_lock, flags);
 331      while (ds)
 332       { ds1 = ds;
 333         ds = ds->next;
 334         kfree(ds1);
 335       }
 336      return(0);
 337    }
 338
 339   spin_lock_irqsave(&divert_lock, flags);
 340   ds = table_head;
 341
 342   while ((ds) && (idx > 0))
 343    { idx--;
 344      ds = ds->next;
 345    }
 346
 347   if (!ds)
 348    {
 349      spin_unlock_irqrestore(&divert_lock, flags);
 350      return(-EINVAL);
 351    }
 352
 353   if (ds->next)
 354     ds->next->prev = ds->prev; /* backward chain */
 355    else
 356      table_tail = ds->prev; /* end of chain */
 357
 358   if (ds->prev)
 359     ds->prev->next = ds->next; /* forward chain */
 360    else
 361      table_head = ds->next; /* start of chain */
 362
 363   spin_unlock_irqrestore(&divert_lock, flags);
 364   kfree(ds);
 365   return(0);
 366 } /* deleterule */
 367
 368 /*******************************************/
 369 /* get a pointer to a specific rule number */
 370 /*******************************************/
 371 divert_rule *getruleptr(int idx)
 372 { struct deflect_struc *ds = table_head;
 373
 374   if (idx < 0) return(NULL);
 375   while ((ds) && (idx >= 0))
 376    { if (!(idx--))
 377       { return(&ds->rule);
 378         break;
 379       }
 380      ds = ds->next;
 381    }
 382   return(NULL);
 383 } /* getruleptr */
 384
 385 /*************************************************/
 386 /* called from common module on an incoming call */
 387 /*************************************************/
 388 static int isdn_divert_icall(isdn_ctrl *ic)
 389 { int retval = 0;
 390   unsigned long flags;
 391   struct call_struc *cs = NULL;
 392   struct deflect_struc *dv;
 393   char *p,*p1;
 394   u_char accept;
 395
 396   /* first check the internal deflection table */
 397   for (dv = table_head; dv ; dv = dv->next )
 398    { /* scan table */
 399      if (((dv->rule.callopt == 1) && (ic->command == ISDN_STAT_ICALLW)) ||
 400          ((dv->rule.callopt == 2) && (ic->command == ISDN_STAT_ICALL)))
 401        continue; /* call option check */
 402      if (!(dv->rule.drvid & (1L << ic->driver)))
 403        continue; /* driver not matching */
 404      if ((dv->rule.si1) && (dv->rule.si1 != ic->parm.setup.si1))
 405        continue; /* si1 not matching */
 406      if ((dv->rule.si2) && (dv->rule.si2 != ic->parm.setup.si2))
 407        continue; /* si2 not matching */
 408
 409      p = dv->rule.my_msn;
 410      p1 = ic->parm.setup.eazmsn;
 411      accept = 0;
 412      while (*p)
 413       { /* complete compare */
 414         if (*p == '-')
 415           { accept = 1; /* call accepted */
 416             break;
 417           }
 418         if (*p++ != *p1++)
 419           break; /* not accepted */
 420         if ((!*p) && (!*p1))
 421           accept = 1;
 422       } /* complete compare */
 423      if (!accept) continue; /* not accepted */
 424
 425      if ((strcmp(dv->rule.caller,"0")) || (ic->parm.setup.phone[0]))
 426       { p = dv->rule.caller;
 427         p1 = ic->parm.setup.phone;
 428         accept = 0;
 429         while (*p)
 430          { /* complete compare */
 431            if (*p == '-')
 432             { accept = 1; /* call accepted */
 433               break;
 434             }
 435            if (*p++ != *p1++)
 436              break; /* not accepted */
 437            if ((!*p) && (!*p1))
 438              accept = 1;
 439          } /* complete compare */
 440         if (!accept) continue; /* not accepted */
 441       }
 442
 443      switch (dv->rule.action)
 444        { case DEFLECT_IGNORE:
 445            return(0);
 446            break;
 447
 448          case DEFLECT_ALERT:
 449          case DEFLECT_PROCEED:
 450          case DEFLECT_REPORT:
 451          case DEFLECT_REJECT:
 452            if (dv->rule.action == DEFLECT_PROCEED)
 453             if ((!if_used) || ((!extern_wait_max) && (!dv->rule.waittime)))
 454               return(0); /* no external deflection needed */
 455            if (!(cs = kmalloc(sizeof(struct call_struc), GFP_ATOMIC)))
 456              return(0); /* no memory */
 457            init_timer(&cs->timer);
 458            cs->info[0] = '\0';
 459            cs->timer.function = deflect_timer_expire;
 460            cs->timer.data = (ulong) cs; /* pointer to own structure */
 461
 462            cs->ics = *ic; /* copy incoming data */
 463            if (!cs->ics.parm.setup.phone[0]) strcpy(cs->ics.parm.setup.phone,"0");
 464            if (!cs->ics.parm.setup.eazmsn[0]) strcpy(cs->ics.parm.setup.eazmsn,"0");
 465            cs->ics.parm.setup.screen = dv->rule.screen;
 466            if (dv->rule.waittime)
 467              cs->timer.expires = jiffies + (HZ * dv->rule.waittime);
 468            else
 469             if (dv->rule.action == DEFLECT_PROCEED)
 470               cs->timer.expires = jiffies + (HZ * extern_wait_max);
 471             else
 472               cs->timer.expires = 0;
 473            cs->akt_state = dv->rule.action;
 474            spin_lock_irqsave(&divert_lock, flags);
 475            cs->divert_id = next_id++; /* new sequence number */
 476            spin_unlock_irqrestore(&divert_lock, flags);
 477            cs->prev = NULL;
 478            if (cs->akt_state == DEFLECT_ALERT)
 479              { strcpy(cs->deflect_dest,dv->rule.to_nr);
 480                if (!cs->timer.expires)
 481                  { strcpy(ic->parm.setup.eazmsn,"Testtext direct");
 482                    ic->parm.setup.screen = dv->rule.screen;
 483                    strcpy(ic->parm.setup.phone,dv->rule.to_nr);
 484                    cs->akt_state = DEFLECT_AUTODEL; /* delete after timeout */
 485                    cs->timer.expires = jiffies + (HZ * AUTODEL_TIME);
 486                    retval = 5;
 487                  }
 488                else
 489                  retval = 1; /* alerting */
 490              }
 491            else
 492              { cs->deflect_dest[0] = '\0';
 493                retval = 4; /* only proceed */
 494              }
 495            sprintf(cs->info,"%d 0x%lx %s %s %s %s 0x%x 0x%x %d %d %s\n",
 496                    cs->akt_state,
 497                    cs->divert_id,
 498                    divert_if.drv_to_name(cs->ics.driver),
 499                    (ic->command == ISDN_STAT_ICALLW) ? "1":"0",
 500                    cs->ics.parm.setup.phone,
 501                    cs->ics.parm.setup.eazmsn,
 502                    cs->ics.parm.setup.si1,
 503                    cs->ics.parm.setup.si2,
 504                    cs->ics.parm.setup.screen,
 505                    dv->rule.waittime,
 506                    cs->deflect_dest);
 507            if ((dv->rule.action == DEFLECT_REPORT) ||
 508                (dv->rule.action == DEFLECT_REJECT))
 509             { put_info_buffer(cs->info);
 510               kfree(cs); /* remove */
 511               return((dv->rule.action == DEFLECT_REPORT) ? 0:2); /* nothing to do */
 512             }
 513            break;
 514
 515          default:
 516            return(0); /* ignore call */
 517            break;
 518        } /* switch action */
 519      break;
 520    } /* scan_table */
 521
 522   if (cs)
 523    { cs->prev = NULL;
 524      spin_lock_irqsave(&divert_lock, flags);
 525      cs->next = divert_head;
 526      divert_head = cs;
 527      if (cs->timer.expires) add_timer(&cs->timer);
 528      spin_unlock_irqrestore(&divert_lock, flags);
 529
 530      put_info_buffer(cs->info);
 531      return(retval);
 532    }
 533   else
 534      return(0);
 535 } /* isdn_divert_icall */
 536
 537
 538 void deleteprocs(void)
 539 { struct call_struc *cs, *cs1;
 540   unsigned long flags;
 541
 542   spin_lock_irqsave(&divert_lock, flags);
 543   cs = divert_head;
 544   divert_head = NULL;
 545   while (cs)
 546    { del_timer(&cs->timer);
 547      cs1 = cs;
 548      cs = cs->next;
 549      kfree(cs1);
 550    }
 551   spin_unlock_irqrestore(&divert_lock, flags);
 552 } /* deleteprocs */
 553
 554 /****************************************************/
 555 /* put a address including address type into buffer */
 556 /****************************************************/
 557 static int put_address(char *st, u_char *p, int len)
 558 { u_char retval = 0;
 559   u_char adr_typ = 0; /* network standard */
 560
 561   if (len < 2) return(retval);
 562   if (*p == 0xA1)
 563    { retval = *(++p) + 2; /* total length */
 564      if (retval > len) return(0); /* too short */
 565      len = retval - 2; /* remaining length */
 566      if (len < 3) return(0);
 567      if ((*(++p) != 0x0A) || (*(++p) != 1)) return(0);
 568      adr_typ = *(++p);
 569      len -= 3;
 570      p++;
 571      if (len < 2) return(0);
 572      if (*p++ != 0x12) return(0);
 573      if (*p > len) return(0); /* check number length */
 574      len = *p++;
 575    }
 576   else
 577    if (*p == 0x80)
 578     { retval = *(++p) + 2; /* total length */
 579       if (retval > len) return(0);
 580       len = retval - 2;
 581       p++;
 582     }
 583    else
 584     return(0); /* invalid address information */
 585
 586   sprintf(st,"%d ",adr_typ);
 587   st += strlen(st);
 588   if (!len)
 589     *st++ = '-';
 590   else
 591    while (len--)
 592      *st++ = *p++;
 593   *st = '\0';
 594   return(retval);
 595 } /* put_address */
 596
 597 /*************************************/
 598 /* report a successful interrogation */
 599 /*************************************/
 600 static int interrogate_success(isdn_ctrl *ic, struct call_struc *cs)
 601 { char *src = ic->parm.dss1_io.data;
 602   int restlen = ic->parm.dss1_io.datalen;
 603   int cnt = 1;
 604   u_char n,n1;
 605   char st[90], *p, *stp;
 606
 607   if (restlen < 2) return(-100); /* frame too short */
 608   if (*src++ != 0x30) return(-101);
 609   if ((n = *src++) > 0x81) return(-102); /* invalid length field */
 610   restlen -= 2; /* remaining bytes */
 611   if (n == 0x80)
 612    { if (restlen < 2) return(-103);
 613      if ((*(src+restlen-1)) || (*(src+restlen-2))) return(-104);
 614      restlen -= 2;
 615    }
 616   else
 617    if ( n == 0x81)
 618     { n = *src++;
 619       restlen--;
 620       if (n > restlen) return(-105);
 621       restlen = n;
 622     }
 623    else
 624     if (n > restlen) return(-106);
 625      else
 626       restlen = n; /* standard format */
 627   if (restlen < 3) return(-107); /* no procedure */
 628   if ((*src++ != 2) || (*src++ != 1) || (*src++ != 0x0B)) return(-108);
 629   restlen -= 3;
 630   if (restlen < 2) return(-109); /* list missing */
 631   if (*src == 0x31)
 632    { src++;
 633      if ((n = *src++) > 0x81) return(-110); /* invalid length field */
 634      restlen -= 2; /* remaining bytes */
 635      if (n == 0x80)
 636       { if (restlen < 2) return(-111);
 637         if ((*(src+restlen-1)) || (*(src+restlen-2))) return(-112);
 638         restlen -= 2;
 639       }
 640      else
 641       if ( n == 0x81)
 642        { n = *src++;
 643          restlen--;
 644          if (n > restlen) return(-113);
 645          restlen = n;
 646        }
 647       else
 648        if (n > restlen) return(-114);
 649         else
 650          restlen = n; /* standard format */
 651    } /* result list header */
 652
 653   while (restlen >= 2)
 654    { stp = st;
 655      sprintf(stp,"%d 0x%lx %d %s ",DIVERT_REPORT, ic->parm.dss1_io.ll_id,
 656                  cnt++,divert_if.drv_to_name(ic->driver));
 657      stp += strlen(stp);
 658      if (*src++ != 0x30) return(-115); /* invalid enum */
 659      n = *src++;
 660      restlen -= 2;
 661      if (n > restlen) return(-116); /* enum length wrong */
 662      restlen -= n;
 663      p = src; /* one entry */
 664      src += n;
 665      if (!(n1 = put_address(stp,p,n & 0xFF))) continue;
 666      stp += strlen(stp);
 667      p += n1;
 668      n -= n1;
 669      if (n < 6) continue; /* no service and proc */
 670      if ((*p++ != 0x0A) || (*p++ != 1)) continue;
 671      sprintf(stp," 0x%02x ",(*p++) & 0xFF);
 672      stp += strlen(stp);
 673      if ((*p++ != 0x0A) || (*p++ != 1)) continue;
 674      sprintf(stp,"%d ",(*p++) & 0xFF);
 675      stp += strlen(stp);
 676      n -= 6;
 677      if (n > 2)
 678       { if (*p++ != 0x30) continue;
 679         if (*p > (n-2)) continue;
 680         n = *p++;
 681         if (!(n1 = put_address(stp,p,n & 0xFF))) continue;
 682         stp += strlen(stp);
 683       }
 684      sprintf(stp,"\n");
 685      put_info_buffer(st);
 686    } /* while restlen */
 687   if (restlen) return(-117);
 688   return(0);
 689 } /* interrogate_success */
 690
 691 /*********************************************/
 692 /* callback for protocol specific extensions */
 693 /*********************************************/
 694 static int prot_stat_callback(isdn_ctrl *ic)
 695 { struct call_struc *cs, *cs1;
 696   int i;
 697   unsigned long flags;
 698
 699   cs = divert_head; /* start of list */
 700   cs1 = NULL;
 701   while (cs)
 702    { if (ic->driver == cs->ics.driver)
 703       { switch (cs->ics.arg)
 704          { case DSS1_CMD_INVOKE:
 705              if ((cs->ics.parm.dss1_io.ll_id == ic->parm.dss1_io.ll_id) &&
 706                  (cs->ics.parm.dss1_io.hl_id == ic->parm.dss1_io.hl_id))
 707               { switch (ic->arg)
 708                 {  case DSS1_STAT_INVOKE_ERR:
 709                      sprintf(cs->info,"128 0x%lx 0x%x\n",
 710                              ic->parm.dss1_io.ll_id,
 711                              ic->parm.dss1_io.timeout);
 712                      put_info_buffer(cs->info);
 713                    break;
 714
 715                    case DSS1_STAT_INVOKE_RES:
 716                      switch (cs->ics.parm.dss1_io.proc)
 717                       {  case  7:
 718                          case  8:
 719                             put_info_buffer(cs->info);
 720                            break;
 721
 722                          case  11:
 723                            i = interrogate_success(ic,cs);
 724                            if (i)
 725                              sprintf(cs->info,"%d 0x%lx %d\n",DIVERT_REPORT,
 726                                      ic->parm.dss1_io.ll_id,i);
 727                            put_info_buffer(cs->info);
 728                            break;
 729
 730                          default:
 731                            printk(KERN_WARNING "dss1_divert: unknown proc %d\n",cs->ics.parm.dss1_io.proc);
 732                            break;
 733                       }
 734
 735
 736                    break;
 737
 738                    default:
 739                      printk(KERN_WARNING "dss1_divert unknown invoke answer %lx\n",ic->arg);
 740                    break;
 741                  }
 742                 cs1 = cs; /* remember structure */
 743                 cs = NULL;
 744                 continue; /* abort search */
 745               } /* id found */
 746            break;
 747
 748            case DSS1_CMD_INVOKE_ABORT:
 749              printk(KERN_WARNING "dss1_divert unhandled invoke abort\n");
 750            break;
 751
 752            default:
 753              printk(KERN_WARNING "dss1_divert unknown cmd 0x%lx\n",cs->ics.arg);
 754            break;
 755          } /* switch ics.arg */
 756         cs = cs->next;
 757       } /* driver ok */
 758    }
 759
 760   if (!cs1)
 761    { printk(KERN_WARNING "dss1_divert unhandled process\n");
 762      return(0);
 763    }
 764
 765   if (cs1->ics.driver == -1)
 766    {
 767      spin_lock_irqsave(&divert_lock, flags);
 768      del_timer(&cs1->timer);
 769      if (cs1->prev)
 770        cs1->prev->next = cs1->next; /* forward link */
 771      else
 772        divert_head = cs1->next;
 773      if (cs1->next)
 774        cs1->next->prev = cs1->prev; /* back link */
 775      spin_unlock_irqrestore(&divert_lock, flags);
 776      kfree(cs1);
 777    }
 778
 779   return(0);
 780 } /* prot_stat_callback */
 781
 782
 783 /***************************/
 784 /* status callback from HL */
 785 /***************************/
 786 static int isdn_divert_stat_callback(isdn_ctrl *ic)
 787 { struct call_struc *cs, *cs1;
 788   unsigned long flags;
 789   int retval;
 790
 791   retval = -1;
 792   cs = divert_head; /* start of list */
 793      while (cs)
 794       { if ((ic->driver == cs->ics.driver) && (ic->arg == cs->ics.arg))
 795          { switch (ic->command)
 796             { case ISDN_STAT_DHUP:
 797                 sprintf(cs->info,"129 0x%lx\n",cs->divert_id);
 798                 del_timer(&cs->timer);
 799                 cs->ics.driver = -1;
 800                 break;
 801
 802               case ISDN_STAT_CAUSE:
 803                 sprintf(cs->info,"130 0x%lx %s\n",cs->divert_id,ic->parm.num);
 804                 break;
 805
 806               case ISDN_STAT_REDIR:
 807                 sprintf(cs->info,"131 0x%lx\n",cs->divert_id);
 808                 del_timer(&cs->timer);
 809                 cs->ics.driver = -1;
 810                 break;
 811
 812               default:
 813                 sprintf(cs->info,"999 0x%lx 0x%x\n",cs->divert_id,(int)(ic->command));
 814                 break;
 815             }
 816           put_info_buffer(cs->info);
 817           retval = 0;
 818          }
 819         cs1 = cs;
 820         cs = cs->next;
 821         if (cs1->ics.driver == -1)
 822           {
 823             spin_lock_irqsave(&divert_lock, flags);
 824             if (cs1->prev)
 825               cs1->prev->next = cs1->next; /* forward link */
 826             else
 827               divert_head = cs1->next;
 828             if (cs1->next)
 829               cs1->next->prev = cs1->prev; /* back link */
 830             spin_unlock_irqrestore(&divert_lock, flags);
 831             kfree(cs1);
 832           }
 833       }
 834   return(retval); /* not found */
 835 } /* isdn_divert_stat_callback */
 836
 837
 838 /********************/
 839 /* callback from ll */
 840 /********************/
 841 int ll_callback(isdn_ctrl *ic)
 842 {
 843   switch (ic->command)
 844    { case ISDN_STAT_ICALL:
 845      case ISDN_STAT_ICALLW:
 846        return(isdn_divert_icall(ic));
 847      break;
 848
 849      case ISDN_STAT_PROT:
 850        if ((ic->arg & 0xFF) == ISDN_PTYPE_EURO)
 851         { if (ic->arg != DSS1_STAT_INVOKE_BRD)
 852             return(prot_stat_callback(ic));
 853           else
 854             return(0); /* DSS1 invoke broadcast */
 855         }
 856        else
 857          return(-1); /* protocol not euro */
 858
 859      default:
 860        return(isdn_divert_stat_callback(ic));
 861    }
 862 } /* ll_callback */
 863