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