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