Commit | Line | Data |
---|---|---|
1da177e4 LT |
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 | ||
1da177e4 | 12 | #include <linux/proc_fs.h> |
5a0e3ad6 | 13 | #include <linux/slab.h> |
d7fe0f24 AV |
14 | #include <linux/timer.h> |
15 | #include <linux/jiffies.h> | |
1da177e4 LT |
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 */ | |
5cbded58 | 157 | if (!(cs = kmalloc(sizeof(struct call_struc), GFP_ATOMIC))) |
1da177e4 LT |
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 | ||
98a1708d | 187 | retval = divert_if.ll_cmd(&cs->ics); /* execute command */ |
1da177e4 LT |
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 | ||
5cbded58 | 280 | if (!(ds = kmalloc(sizeof(struct deflect_struc), |
1da177e4 LT |
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 | /*************************************************/ | |
408b664a | 388 | static int isdn_divert_icall(isdn_ctrl *ic) |
1da177e4 LT |
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 */ | |
5cbded58 | 455 | if (!(cs = kmalloc(sizeof(struct call_struc), GFP_ATOMIC))) |
1da177e4 LT |
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 | /****************************************************/ | |
408b664a | 557 | static int put_address(char *st, u_char *p, int len) |
1da177e4 LT |
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 | /*************************************/ | |
d6e05edc | 598 | /* report a successful interrogation */ |
1da177e4 | 599 | /*************************************/ |
408b664a | 600 | static int interrogate_success(isdn_ctrl *ic, struct call_struc *cs) |
1da177e4 LT |
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 | /*********************************************/ | |
408b664a | 694 | static int prot_stat_callback(isdn_ctrl *ic) |
1da177e4 LT |
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 | /***************************/ | |
408b664a | 786 | static int isdn_divert_stat_callback(isdn_ctrl *ic) |
1da177e4 LT |
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 |