Linus Torvalds | 1da177e | 2005-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) |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 6 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 | #include <linux/proc_fs.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 13 | #include <linux/slab.h> |
Al Viro | d7fe0f2 | 2006-12-03 23:15:30 -0500 | [diff] [blame] | 14 | #include <linux/timer.h> |
| 15 | #include <linux/jiffies.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | |
| 17 | #include "isdn_divert.h" |
| 18 | |
| 19 | /**********************************/ |
| 20 | /* structure keeping calling info */ |
| 21 | /**********************************/ |
| 22 | struct call_struc |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 32 | |
| 33 | |
| 34 | /********************************************/ |
| 35 | /* structure keeping deflection table entry */ |
| 36 | /********************************************/ |
| 37 | struct deflect_struc |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 38 | { struct deflect_struc *next, *prev; |
| 39 | divert_rule rule; /* used rule */ |
| 40 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 */ |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 48 | static ulong next_id = 1; /* next info id */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 49 | static struct deflect_struc *table_head = NULL; |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 50 | static struct deflect_struc *table_tail = NULL; |
| 51 | static unsigned char extern_wait_max = 4; /* maximum wait in s for external process */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 52 | |
| 53 | DEFINE_SPINLOCK(divert_lock); |
| 54 | |
| 55 | /***************************/ |
| 56 | /* timer callback function */ |
| 57 | /***************************/ |
| 58 | static void deflect_timer_expire(ulong arg) |
| 59 | { |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 60 | unsigned long flags; |
| 61 | struct call_struc *cs = (struct call_struc *) arg; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 63 | spin_lock_irqsave(&divert_lock, flags); |
| 64 | del_timer(&cs->timer); /* delete active timer */ |
| 65 | spin_unlock_irqrestore(&divert_lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 66 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 78 | case DEFLECT_ALERT: |
| 79 | cs->ics.command = ISDN_CMD_REDIR; /* protocol */ |
| 80 | strlcpy(cs->ics.parm.setup.phone, cs->deflect_dest, sizeof(cs->ics.parm.setup.phone)); |
| 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 102 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 103 | } /* switch */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 | } /* deflect_timer_func */ |
| 105 | |
| 106 | |
| 107 | /*****************************************/ |
| 108 | /* handle call forwarding de/activations */ |
| 109 | /* 0 = deact, 1 = act, 2 = interrogate */ |
| 110 | /*****************************************/ |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 111 | int cf_command(int drvid, int mode, |
| 112 | u_char proc, char *msn, |
| 113 | u_char service, char *fwd_nr, ulong *procid) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 114 | { unsigned long flags; |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 115 | int retval, msnlen; |
| 116 | int fwd_len; |
| 117 | char *p, *ielenp, tmp[60]; |
| 118 | struct call_struc *cs; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 119 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 132 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 144 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 153 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 154 | *ielenp = p - ielenp - 1; /* set total IE length */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 170 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 175 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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; |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 207 | isdn_ctrl ic; |
| 208 | unsigned long flags; |
| 209 | int i; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 210 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 218 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 234 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 251 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 252 | case 2: /* redir */ |
| 253 | del_timer(&cs->timer); |
| 254 | strlcpy(cs->ics.parm.setup.phone, to_nr, sizeof(cs->ics.parm.setup.phone)); |
| 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 268 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 269 | } /* switch */ |
| 270 | return (i); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 271 | } /* deflect_extern_action */ |
| 272 | |
| 273 | /********************************/ |
| 274 | /* insert a new rule before idx */ |
| 275 | /********************************/ |
| 276 | int insertrule(int idx, divert_rule *newrule) |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 277 | { struct deflect_struc *ds, *ds1 = NULL; |
| 278 | unsigned long flags; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 279 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 280 | if (!(ds = kmalloc(sizeof(struct deflect_struc), |
| 281 | GFP_KERNEL))) |
| 282 | return (-ENOMEM); /* no memory */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 283 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 284 | ds->rule = *newrule; /* set rule */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 285 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 286 | spin_lock_irqsave(&divert_lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 287 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 296 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 313 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 314 | spin_unlock_irqrestore(&divert_lock, flags); |
| 315 | return (0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 316 | } /* insertrule */ |
| 317 | |
| 318 | /***********************************/ |
| 319 | /* delete the rule at position idx */ |
| 320 | /***********************************/ |
| 321 | int deleterule(int idx) |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 322 | { struct deflect_struc *ds, *ds1; |
| 323 | unsigned long flags; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 324 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 338 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 339 | spin_lock_irqsave(&divert_lock, flags); |
| 340 | ds = table_head; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 341 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 342 | while ((ds) && (idx > 0)) |
| 343 | { idx--; |
| 344 | ds = ds->next; |
| 345 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 346 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 347 | if (!ds) |
| 348 | { |
| 349 | spin_unlock_irqrestore(&divert_lock, flags); |
| 350 | return (-EINVAL); |
| 351 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 352 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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; |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 383 | } /* getruleptr */ |
| 384 | |
| 385 | /*************************************************/ |
| 386 | /* called from common module on an incoming call */ |
| 387 | /*************************************************/ |
Adrian Bunk | 408b664 | 2005-05-01 08:59:29 -0700 | [diff] [blame] | 388 | static int isdn_divert_icall(isdn_ctrl *ic) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 389 | { int retval = 0; |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 390 | unsigned long flags; |
| 391 | struct call_struc *cs = NULL; |
| 392 | struct deflect_struc *dv; |
| 393 | char *p, *p1; |
| 394 | u_char accept; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 395 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 408 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 424 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 442 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 443 | switch (dv->rule.action) |
| 444 | { case DEFLECT_IGNORE: |
| 445 | return (0); |
| 446 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 447 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 461 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 | strlcpy(ic->parm.setup.phone, dv->rule.to_nr, sizeof(ic->parm.setup.phone)); |
| 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 535 | } /* isdn_divert_icall */ |
| 536 | |
| 537 | |
| 538 | void deleteprocs(void) |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 539 | { struct call_struc *cs, *cs1; |
| 540 | unsigned long flags; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 541 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 552 | } /* deleteprocs */ |
| 553 | |
| 554 | /****************************************************/ |
| 555 | /* put a address including address type into buffer */ |
| 556 | /****************************************************/ |
Adrian Bunk | 408b664 | 2005-05-01 08:59:29 -0700 | [diff] [blame] | 557 | static int put_address(char *st, u_char *p, int len) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 558 | { u_char retval = 0; |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 559 | u_char adr_typ = 0; /* network standard */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 560 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 585 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 595 | } /* put_address */ |
| 596 | |
| 597 | /*************************************/ |
Andreas Mohr | d6e05ed | 2006-06-26 18:35:02 +0200 | [diff] [blame] | 598 | /* report a successful interrogation */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 599 | /*************************************/ |
Adrian Bunk | 408b664 | 2005-05-01 08:59:29 -0700 | [diff] [blame] | 600 | static int interrogate_success(isdn_ctrl *ic, struct call_struc *cs) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 601 | { char *src = ic->parm.dss1_io.data; |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 602 | int restlen = ic->parm.dss1_io.datalen; |
| 603 | int cnt = 1; |
| 604 | u_char n, n1; |
| 605 | char st[90], *p, *stp; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 606 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 652 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 689 | } /* interrogate_success */ |
| 690 | |
| 691 | /*********************************************/ |
| 692 | /* callback for protocol specific extensions */ |
| 693 | /*********************************************/ |
Adrian Bunk | 408b664 | 2005-05-01 08:59:29 -0700 | [diff] [blame] | 694 | static int prot_stat_callback(isdn_ctrl *ic) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 695 | { struct call_struc *cs, *cs1; |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 696 | int i; |
| 697 | unsigned long flags; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 698 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 734 | |
| 735 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 736 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 737 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 747 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 780 | } /* prot_stat_callback */ |
| 781 | |
| 782 | |
| 783 | /***************************/ |
| 784 | /* status callback from HL */ |
| 785 | /***************************/ |
Adrian Bunk | 408b664 | 2005-05-01 08:59:29 -0700 | [diff] [blame] | 786 | static int isdn_divert_stat_callback(isdn_ctrl *ic) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 787 | { struct call_struc *cs, *cs1; |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 788 | unsigned long flags; |
| 789 | int retval; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 790 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 801 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 802 | case ISDN_STAT_CAUSE: |
| 803 | sprintf(cs->info, "130 0x%lx %s\n", cs->divert_id, ic->parm.num); |
| 804 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 805 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 811 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 836 | |
| 837 | |
| 838 | /********************/ |
| 839 | /* callback from ll */ |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 840 | /********************/ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 841 | int ll_callback(isdn_ctrl *ic) |
| 842 | { |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 843 | switch (ic->command) |
| 844 | { case ISDN_STAT_ICALL: |
| 845 | case ISDN_STAT_ICALLW: |
| 846 | return (isdn_divert_icall(ic)); |
| 847 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 848 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 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 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 858 | |
Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame^] | 859 | default: |
| 860 | return (isdn_divert_stat_callback(ic)); |
| 861 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 862 | } /* ll_callback */ |