| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* $Id: isdn_net.c,v 1.1.2.2 2004/01/12 22:37:19 keil Exp $ | 
 | 2 |  * | 
 | 3 |  * Linux ISDN subsystem, network interfaces and related functions (linklevel). | 
 | 4 |  * | 
 | 5 |  * Copyright 1994-1998  by Fritz Elfert (fritz@isdn4linux.de) | 
 | 6 |  * Copyright 1995,96    by Thinking Objects Software GmbH Wuerzburg | 
 | 7 |  * Copyright 1995,96    by Michael Hipp (Michael.Hipp@student.uni-tuebingen.de) | 
 | 8 |  * | 
 | 9 |  * This software may be used and distributed according to the terms | 
 | 10 |  * of the GNU General Public License, incorporated herein by reference. | 
 | 11 |  * | 
 | 12 |  * Data Over Voice (DOV) support added - Guy Ellis 23-Mar-02  | 
 | 13 |  *                                       guy@traverse.com.au | 
 | 14 |  * Outgoing calls - looks for a 'V' in first char of dialed number | 
 | 15 |  * Incoming calls - checks first character of eaz as follows: | 
 | 16 |  *   Numeric - accept DATA only - original functionality | 
 | 17 |  *   'V'     - accept VOICE (DOV) only | 
 | 18 |  *   'B'     - accept BOTH DATA and DOV types | 
 | 19 |  * | 
 | 20 |  * Jan 2001: fix CISCO HDLC      Bjoern A. Zeeb <i4l@zabbadoz.net> | 
 | 21 |  *           for info on the protocol, see  | 
 | 22 |  *           http://i4l.zabbadoz.net/i4l/cisco-hdlc.txt | 
 | 23 |  */ | 
 | 24 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 25 | #include <linux/isdn.h> | 
 | 26 | #include <net/arp.h> | 
 | 27 | #include <net/dst.h> | 
 | 28 | #include <net/pkt_sched.h> | 
 | 29 | #include <linux/inetdevice.h> | 
 | 30 | #include "isdn_common.h" | 
 | 31 | #include "isdn_net.h" | 
 | 32 | #ifdef CONFIG_ISDN_PPP | 
 | 33 | #include "isdn_ppp.h" | 
 | 34 | #endif | 
 | 35 | #ifdef CONFIG_ISDN_X25 | 
 | 36 | #include <linux/concap.h> | 
 | 37 | #include "isdn_concap.h" | 
 | 38 | #endif | 
 | 39 |  | 
 | 40 |  | 
 | 41 | /* | 
 | 42 |  * Outline of new tbusy handling:  | 
 | 43 |  * | 
 | 44 |  * Old method, roughly spoken, consisted of setting tbusy when entering | 
 | 45 |  * isdn_net_start_xmit() and at several other locations and clearing | 
 | 46 |  * it from isdn_net_start_xmit() thread when sending was successful. | 
 | 47 |  * | 
 | 48 |  * With 2.3.x multithreaded network core, to prevent problems, tbusy should | 
 | 49 |  * only be set by the isdn_net_start_xmit() thread and only when a tx-busy | 
 | 50 |  * condition is detected. Other threads (in particular isdn_net_stat_callb()) | 
 | 51 |  * are only allowed to clear tbusy. | 
 | 52 |  * | 
 | 53 |  * -HE | 
 | 54 |  */ | 
 | 55 |  | 
 | 56 | /* | 
 | 57 |  * About SOFTNET: | 
 | 58 |  * Most of the changes were pretty obvious and basically done by HE already. | 
 | 59 |  * | 
 | 60 |  * One problem of the isdn net device code is that is uses struct net_device | 
 | 61 |  * for masters and slaves. However, only master interface are registered to  | 
 | 62 |  * the network layer, and therefore, it only makes sense to call netif_*  | 
 | 63 |  * functions on them. | 
 | 64 |  * | 
 | 65 |  * --KG | 
 | 66 |  */ | 
 | 67 |  | 
 | 68 | /*  | 
 | 69 |  * Find out if the netdevice has been ifup-ed yet. | 
 | 70 |  * For slaves, look at the corresponding master. | 
 | 71 |  */ | 
 | 72 | static __inline__ int isdn_net_device_started(isdn_net_dev *n) | 
 | 73 | { | 
 | 74 | 	isdn_net_local *lp = n->local; | 
 | 75 | 	struct net_device *dev; | 
 | 76 | 	 | 
 | 77 | 	if (lp->master)  | 
 | 78 | 		dev = lp->master; | 
 | 79 | 	else | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 80 | 		dev = n->dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | 	return netif_running(dev); | 
 | 82 | } | 
 | 83 |  | 
 | 84 | /* | 
 | 85 |  * wake up the network -> net_device queue. | 
 | 86 |  * For slaves, wake the corresponding master interface. | 
 | 87 |  */ | 
 | 88 | static __inline__ void isdn_net_device_wake_queue(isdn_net_local *lp) | 
 | 89 | { | 
 | 90 | 	if (lp->master)  | 
 | 91 | 		netif_wake_queue(lp->master); | 
 | 92 | 	else | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 93 | 		netif_wake_queue(lp->netdev->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 94 | } | 
 | 95 |  | 
 | 96 | /* | 
 | 97 |  * stop the network -> net_device queue. | 
 | 98 |  * For slaves, stop the corresponding master interface. | 
 | 99 |  */ | 
 | 100 | static __inline__ void isdn_net_device_stop_queue(isdn_net_local *lp) | 
 | 101 | { | 
 | 102 | 	if (lp->master) | 
 | 103 | 		netif_stop_queue(lp->master); | 
 | 104 | 	else | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 105 | 		netif_stop_queue(lp->netdev->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 106 | } | 
 | 107 |  | 
 | 108 | /* | 
 | 109 |  * find out if the net_device which this lp belongs to (lp can be | 
 | 110 |  * master or slave) is busy. It's busy iff all (master and slave)  | 
 | 111 |  * queues are busy | 
 | 112 |  */ | 
 | 113 | static __inline__ int isdn_net_device_busy(isdn_net_local *lp) | 
 | 114 | { | 
 | 115 | 	isdn_net_local *nlp; | 
 | 116 | 	isdn_net_dev *nd; | 
 | 117 | 	unsigned long flags; | 
 | 118 |  | 
 | 119 | 	if (!isdn_net_lp_busy(lp)) | 
 | 120 | 		return 0; | 
 | 121 |  | 
 | 122 | 	if (lp->master) | 
 | 123 | 		nd = ((isdn_net_local *) lp->master->priv)->netdev; | 
 | 124 | 	else | 
 | 125 | 		nd = lp->netdev; | 
 | 126 | 	 | 
 | 127 | 	spin_lock_irqsave(&nd->queue_lock, flags); | 
 | 128 | 	nlp = lp->next; | 
 | 129 | 	while (nlp != lp) { | 
 | 130 | 		if (!isdn_net_lp_busy(nlp)) { | 
 | 131 | 			spin_unlock_irqrestore(&nd->queue_lock, flags); | 
 | 132 | 			return 0; | 
 | 133 | 		} | 
 | 134 | 		nlp = nlp->next; | 
 | 135 | 	} | 
 | 136 | 	spin_unlock_irqrestore(&nd->queue_lock, flags); | 
 | 137 | 	return 1; | 
 | 138 | } | 
 | 139 |  | 
 | 140 | static __inline__ void isdn_net_inc_frame_cnt(isdn_net_local *lp) | 
 | 141 | { | 
 | 142 | 	atomic_inc(&lp->frame_cnt); | 
 | 143 | 	if (isdn_net_device_busy(lp)) | 
 | 144 | 		isdn_net_device_stop_queue(lp); | 
 | 145 | } | 
 | 146 |  | 
 | 147 | static __inline__ void isdn_net_dec_frame_cnt(isdn_net_local *lp) | 
 | 148 | { | 
 | 149 | 	atomic_dec(&lp->frame_cnt); | 
 | 150 |  | 
 | 151 | 	if (!(isdn_net_device_busy(lp))) { | 
 | 152 | 		if (!skb_queue_empty(&lp->super_tx_queue)) { | 
 | 153 | 			schedule_work(&lp->tqueue); | 
 | 154 | 		} else { | 
 | 155 | 			isdn_net_device_wake_queue(lp); | 
 | 156 | 		} | 
 | 157 |        }                                                                       | 
 | 158 | } | 
 | 159 |  | 
 | 160 | static __inline__ void isdn_net_zero_frame_cnt(isdn_net_local *lp) | 
 | 161 | { | 
 | 162 | 	atomic_set(&lp->frame_cnt, 0); | 
 | 163 | } | 
 | 164 |  | 
 | 165 | /* For 2.2.x we leave the transmitter busy timeout at 2 secs, just  | 
 | 166 |  * to be safe. | 
 | 167 |  * For 2.3.x we push it up to 20 secs, because call establishment | 
 | 168 |  * (in particular callback) may take such a long time, and we  | 
 | 169 |  * don't want confusing messages in the log. However, there is a slight | 
 | 170 |  * possibility that this large timeout will break other things like MPPP, | 
 | 171 |  * which might rely on the tx timeout. If so, we'll find out this way... | 
 | 172 |  */ | 
 | 173 |  | 
 | 174 | #define ISDN_NET_TX_TIMEOUT (20*HZ)  | 
 | 175 |  | 
 | 176 | /* Prototypes */ | 
 | 177 |  | 
| Adrian Bunk | 3e206b0 | 2005-06-25 14:58:35 -0700 | [diff] [blame] | 178 | static int isdn_net_force_dial_lp(isdn_net_local *); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 179 | static int isdn_net_start_xmit(struct sk_buff *, struct net_device *); | 
 | 180 |  | 
 | 181 | static void isdn_net_ciscohdlck_connected(isdn_net_local *lp); | 
 | 182 | static void isdn_net_ciscohdlck_disconnected(isdn_net_local *lp); | 
 | 183 |  | 
 | 184 | char *isdn_net_revision = "$Revision: 1.1.2.2 $"; | 
 | 185 |  | 
 | 186 |  /* | 
 | 187 |   * Code for raw-networking over ISDN | 
 | 188 |   */ | 
 | 189 |  | 
 | 190 | static void | 
 | 191 | isdn_net_unreachable(struct net_device *dev, struct sk_buff *skb, char *reason) | 
 | 192 | { | 
 | 193 | 	if(skb) { | 
 | 194 |  | 
 | 195 | 		u_short proto = ntohs(skb->protocol); | 
 | 196 |  | 
 | 197 | 		printk(KERN_DEBUG "isdn_net: %s: %s, signalling dst_link_failure %s\n", | 
 | 198 | 		       dev->name, | 
 | 199 | 		       (reason != NULL) ? reason : "unknown", | 
 | 200 | 		       (proto != ETH_P_IP) ? "Protocol != ETH_P_IP" : ""); | 
 | 201 | 		 | 
 | 202 | 		dst_link_failure(skb); | 
 | 203 | 	} | 
 | 204 | 	else {  /* dial not triggered by rawIP packet */ | 
 | 205 | 		printk(KERN_DEBUG "isdn_net: %s: %s\n", | 
 | 206 | 			   dev->name, | 
 | 207 | 			   (reason != NULL) ? reason : "reason unknown"); | 
 | 208 | 	} | 
 | 209 | } | 
 | 210 |  | 
 | 211 | static void | 
 | 212 | isdn_net_reset(struct net_device *dev) | 
 | 213 | { | 
 | 214 | #ifdef CONFIG_ISDN_X25 | 
 | 215 | 	struct concap_device_ops * dops = | 
 | 216 | 		( (isdn_net_local *) dev->priv ) -> dops; | 
 | 217 | 	struct concap_proto * cprot = | 
 | 218 | 		( (isdn_net_local *) dev->priv ) -> netdev -> cprot; | 
 | 219 | #endif | 
 | 220 | #ifdef CONFIG_ISDN_X25 | 
 | 221 | 	if( cprot && cprot -> pops && dops ) | 
 | 222 | 		cprot -> pops -> restart ( cprot, dev, dops ); | 
 | 223 | #endif | 
 | 224 | } | 
 | 225 |  | 
 | 226 | /* Open/initialize the board. */ | 
 | 227 | static int | 
 | 228 | isdn_net_open(struct net_device *dev) | 
 | 229 | { | 
 | 230 | 	int i; | 
 | 231 | 	struct net_device *p; | 
 | 232 | 	struct in_device *in_dev; | 
 | 233 |  | 
 | 234 | 	/* moved here from isdn_net_reset, because only the master has an | 
 | 235 | 	   interface associated which is supposed to be started. BTW: | 
 | 236 | 	   we need to call netif_start_queue, not netif_wake_queue here */ | 
 | 237 | 	netif_start_queue(dev); | 
 | 238 |  | 
 | 239 | 	isdn_net_reset(dev); | 
 | 240 | 	/* Fill in the MAC-level header (not needed, but for compatibility... */ | 
 | 241 | 	for (i = 0; i < ETH_ALEN - sizeof(u32); i++) | 
 | 242 | 		dev->dev_addr[i] = 0xfc; | 
 | 243 | 	if ((in_dev = dev->ip_ptr) != NULL) { | 
 | 244 | 		/* | 
 | 245 | 		 *      Any address will do - we take the first | 
 | 246 | 		 */ | 
 | 247 | 		struct in_ifaddr *ifa = in_dev->ifa_list; | 
 | 248 | 		if (ifa != NULL) | 
 | 249 | 			memcpy(dev->dev_addr+2, &ifa->ifa_local, 4); | 
 | 250 | 	} | 
 | 251 |  | 
 | 252 | 	/* If this interface has slaves, start them also */ | 
 | 253 |  | 
 | 254 | 	if ((p = (((isdn_net_local *) dev->priv)->slave))) { | 
 | 255 | 		while (p) { | 
 | 256 | 			isdn_net_reset(p); | 
 | 257 | 			p = (((isdn_net_local *) p->priv)->slave); | 
 | 258 | 		} | 
 | 259 | 	} | 
 | 260 | 	isdn_lock_drivers(); | 
 | 261 | 	return 0; | 
 | 262 | } | 
 | 263 |  | 
 | 264 | /* | 
 | 265 |  * Assign an ISDN-channel to a net-interface | 
 | 266 |  */ | 
 | 267 | static void | 
 | 268 | isdn_net_bind_channel(isdn_net_local * lp, int idx) | 
 | 269 | { | 
 | 270 | 	lp->flags |= ISDN_NET_CONNECTED; | 
 | 271 | 	lp->isdn_device = dev->drvmap[idx]; | 
 | 272 | 	lp->isdn_channel = dev->chanmap[idx]; | 
 | 273 | 	dev->rx_netdev[idx] = lp->netdev; | 
 | 274 | 	dev->st_netdev[idx] = lp->netdev; | 
 | 275 | } | 
 | 276 |  | 
 | 277 | /* | 
 | 278 |  * unbind a net-interface (resets interface after an error) | 
 | 279 |  */ | 
 | 280 | static void | 
 | 281 | isdn_net_unbind_channel(isdn_net_local * lp) | 
 | 282 | { | 
 | 283 | 	skb_queue_purge(&lp->super_tx_queue); | 
 | 284 |  | 
 | 285 | 	if (!lp->master) {	/* reset only master device */ | 
 | 286 | 		/* Moral equivalent of dev_purge_queues(): | 
 | 287 | 		   BEWARE! This chunk of code cannot be called from hardware | 
 | 288 | 		   interrupt handler. I hope it is true. --ANK | 
 | 289 | 		 */ | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 290 | 		qdisc_reset(lp->netdev->dev->qdisc); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 291 | 	} | 
 | 292 | 	lp->dialstate = 0; | 
 | 293 | 	dev->rx_netdev[isdn_dc2minor(lp->isdn_device, lp->isdn_channel)] = NULL; | 
 | 294 | 	dev->st_netdev[isdn_dc2minor(lp->isdn_device, lp->isdn_channel)] = NULL; | 
 | 295 | 	isdn_free_channel(lp->isdn_device, lp->isdn_channel, ISDN_USAGE_NET); | 
 | 296 | 	lp->flags &= ~ISDN_NET_CONNECTED; | 
 | 297 | 	lp->isdn_device = -1; | 
 | 298 | 	lp->isdn_channel = -1; | 
 | 299 | } | 
 | 300 |  | 
 | 301 | /* | 
 | 302 |  * Perform auto-hangup and cps-calculation for net-interfaces. | 
 | 303 |  * | 
 | 304 |  * auto-hangup: | 
 | 305 |  * Increment idle-counter (this counter is reset on any incoming or | 
 | 306 |  * outgoing packet), if counter exceeds configured limit either do a | 
 | 307 |  * hangup immediately or - if configured - wait until just before the next | 
 | 308 |  * charge-info. | 
 | 309 |  * | 
 | 310 |  * cps-calculation (needed for dynamic channel-bundling): | 
 | 311 |  * Since this function is called every second, simply reset the | 
 | 312 |  * byte-counter of the interface after copying it to the cps-variable. | 
 | 313 |  */ | 
| Adrian Bunk | 3e206b0 | 2005-06-25 14:58:35 -0700 | [diff] [blame] | 314 | static unsigned long last_jiffies = -HZ; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 315 |  | 
 | 316 | void | 
 | 317 | isdn_net_autohup(void) | 
 | 318 | { | 
 | 319 | 	isdn_net_dev *p = dev->netdev; | 
 | 320 | 	int anymore; | 
 | 321 |  | 
 | 322 | 	anymore = 0; | 
 | 323 | 	while (p) { | 
 | 324 | 		isdn_net_local *l = p->local; | 
 | 325 | 		if (jiffies == last_jiffies) | 
 | 326 | 			l->cps = l->transcount; | 
 | 327 | 		else | 
 | 328 | 			l->cps = (l->transcount * HZ) / (jiffies - last_jiffies); | 
 | 329 | 		l->transcount = 0; | 
 | 330 | 		if (dev->net_verbose > 3) | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 331 | 			printk(KERN_DEBUG "%s: %d bogocps\n", p->dev->name, l->cps); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 332 | 		if ((l->flags & ISDN_NET_CONNECTED) && (!l->dialstate)) { | 
 | 333 | 			anymore = 1; | 
 | 334 | 			l->huptimer++; | 
 | 335 | 			/* | 
 | 336 | 			 * if there is some dialmode where timeout-hangup | 
 | 337 | 			 * should _not_ be done, check for that here | 
 | 338 | 			 */ | 
 | 339 | 			if ((l->onhtime) && | 
 | 340 | 			    (l->huptimer > l->onhtime)) | 
 | 341 | 			{ | 
 | 342 | 				if (l->hupflags & ISDN_MANCHARGE && | 
 | 343 | 				    l->hupflags & ISDN_CHARGEHUP) { | 
 | 344 | 					while (time_after(jiffies, l->chargetime + l->chargeint)) | 
 | 345 | 						l->chargetime += l->chargeint; | 
 | 346 | 					if (time_after(jiffies, l->chargetime + l->chargeint - 2 * HZ)) | 
 | 347 | 						if (l->outgoing || l->hupflags & ISDN_INHUP) | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 348 | 							isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 349 | 				} else if (l->outgoing) { | 
 | 350 | 					if (l->hupflags & ISDN_CHARGEHUP) { | 
 | 351 | 						if (l->hupflags & ISDN_WAITCHARGE) { | 
 | 352 | 							printk(KERN_DEBUG "isdn_net: Hupflags of %s are %X\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 353 | 							       p->dev->name, l->hupflags); | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 354 | 							isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 355 | 						} else if (time_after(jiffies, l->chargetime + l->chargeint)) { | 
 | 356 | 							printk(KERN_DEBUG | 
 | 357 | 							       "isdn_net: %s: chtime = %lu, chint = %d\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 358 | 							       p->dev->name, l->chargetime, l->chargeint); | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 359 | 							isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 360 | 						} | 
 | 361 | 					} else | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 362 | 						isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 363 | 				} else if (l->hupflags & ISDN_INHUP) | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 364 | 					isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 365 | 			} | 
 | 366 |  | 
 | 367 | 			if(dev->global_flags & ISDN_GLOBAL_STOPPED || (ISDN_NET_DIALMODE(*l) == ISDN_NET_DM_OFF)) { | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 368 | 				isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 369 | 				break; | 
 | 370 | 			} | 
 | 371 | 		} | 
 | 372 | 		p = (isdn_net_dev *) p->next; | 
 | 373 | 	} | 
 | 374 | 	last_jiffies = jiffies; | 
 | 375 | 	isdn_timer_ctrl(ISDN_TIMER_NETHANGUP, anymore); | 
 | 376 | } | 
 | 377 |  | 
 | 378 | static void isdn_net_lp_disconnected(isdn_net_local *lp) | 
 | 379 | { | 
 | 380 | 	isdn_net_rm_from_bundle(lp); | 
 | 381 | } | 
 | 382 |  | 
 | 383 | /* | 
 | 384 |  * Handle status-messages from ISDN-interfacecard. | 
 | 385 |  * This function is called from within the main-status-dispatcher | 
 | 386 |  * isdn_status_callback, which itself is called from the low-level driver. | 
 | 387 |  * Return: 1 = Event handled, 0 = not for us or unknown Event. | 
 | 388 |  */ | 
 | 389 | int | 
 | 390 | isdn_net_stat_callback(int idx, isdn_ctrl *c) | 
 | 391 | { | 
 | 392 | 	isdn_net_dev *p = dev->st_netdev[idx]; | 
 | 393 | 	int cmd = c->command; | 
 | 394 |  | 
 | 395 | 	if (p) { | 
 | 396 | 		isdn_net_local *lp = p->local; | 
 | 397 | #ifdef CONFIG_ISDN_X25 | 
 | 398 | 		struct concap_proto *cprot = lp->netdev->cprot; | 
 | 399 | 		struct concap_proto_ops *pops = cprot ? cprot->pops : NULL; | 
 | 400 | #endif | 
 | 401 | 		switch (cmd) { | 
 | 402 | 			case ISDN_STAT_BSENT: | 
 | 403 | 				/* A packet has successfully been sent out */ | 
 | 404 | 				if ((lp->flags & ISDN_NET_CONNECTED) && | 
 | 405 | 				    (!lp->dialstate)) { | 
 | 406 | 					isdn_net_dec_frame_cnt(lp); | 
 | 407 | 					lp->stats.tx_packets++; | 
 | 408 | 					lp->stats.tx_bytes += c->parm.length; | 
 | 409 | 				} | 
 | 410 | 				return 1; | 
 | 411 | 			case ISDN_STAT_DCONN: | 
 | 412 | 				/* D-Channel is up */ | 
 | 413 | 				switch (lp->dialstate) { | 
 | 414 | 					case 4: | 
 | 415 | 					case 7: | 
 | 416 | 					case 8: | 
 | 417 | 						lp->dialstate++; | 
 | 418 | 						return 1; | 
 | 419 | 					case 12: | 
 | 420 | 						lp->dialstate = 5; | 
 | 421 | 						return 1; | 
 | 422 | 				} | 
 | 423 | 				break; | 
 | 424 | 			case ISDN_STAT_DHUP: | 
 | 425 | 				/* Either D-Channel-hangup or error during dialout */ | 
 | 426 | #ifdef CONFIG_ISDN_X25 | 
 | 427 | 				/* If we are not connencted then dialing had | 
 | 428 | 				   failed. If there are generic encap protocol | 
 | 429 | 				   receiver routines signal the closure of | 
 | 430 | 				   the link*/ | 
 | 431 |  | 
 | 432 | 				if( !(lp->flags & ISDN_NET_CONNECTED) | 
 | 433 | 				    && pops && pops -> disconn_ind ) | 
 | 434 | 					pops -> disconn_ind(cprot); | 
 | 435 | #endif /* CONFIG_ISDN_X25 */ | 
 | 436 | 				if ((!lp->dialstate) && (lp->flags & ISDN_NET_CONNECTED)) { | 
 | 437 | 					if (lp->p_encap == ISDN_NET_ENCAP_CISCOHDLCK) | 
 | 438 | 						isdn_net_ciscohdlck_disconnected(lp); | 
 | 439 | #ifdef CONFIG_ISDN_PPP | 
 | 440 | 					if (lp->p_encap == ISDN_NET_ENCAP_SYNCPPP) | 
 | 441 | 						isdn_ppp_free(lp); | 
 | 442 | #endif | 
 | 443 | 					isdn_net_lp_disconnected(lp); | 
 | 444 | 					isdn_all_eaz(lp->isdn_device, lp->isdn_channel); | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 445 | 					printk(KERN_INFO "%s: remote hangup\n", p->dev->name); | 
 | 446 | 					printk(KERN_INFO "%s: Chargesum is %d\n", p->dev->name, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 447 | 					       lp->charge); | 
 | 448 | 					isdn_net_unbind_channel(lp); | 
 | 449 | 					return 1; | 
 | 450 | 				} | 
 | 451 | 				break; | 
 | 452 | #ifdef CONFIG_ISDN_X25 | 
 | 453 | 			case ISDN_STAT_BHUP: | 
 | 454 | 				/* B-Channel-hangup */ | 
 | 455 | 				/* try if there are generic encap protocol | 
 | 456 | 				   receiver routines and signal the closure of | 
 | 457 | 				   the link */ | 
 | 458 | 				if( pops  &&  pops -> disconn_ind ){ | 
 | 459 | 						pops -> disconn_ind(cprot); | 
 | 460 | 						return 1; | 
 | 461 | 					} | 
 | 462 | 				break; | 
 | 463 | #endif /* CONFIG_ISDN_X25 */ | 
 | 464 | 			case ISDN_STAT_BCONN: | 
 | 465 | 				/* B-Channel is up */ | 
 | 466 | 				isdn_net_zero_frame_cnt(lp); | 
 | 467 | 				switch (lp->dialstate) { | 
 | 468 | 					case 5: | 
 | 469 | 					case 6: | 
 | 470 | 					case 7: | 
 | 471 | 					case 8: | 
 | 472 | 					case 9: | 
 | 473 | 					case 10: | 
 | 474 | 					case 12: | 
 | 475 | 						if (lp->dialstate <= 6) { | 
 | 476 | 							dev->usage[idx] |= ISDN_USAGE_OUTGOING; | 
 | 477 | 							isdn_info_update(); | 
 | 478 | 						} else | 
 | 479 | 							dev->rx_netdev[idx] = p; | 
 | 480 | 						lp->dialstate = 0; | 
 | 481 | 						isdn_timer_ctrl(ISDN_TIMER_NETHANGUP, 1); | 
 | 482 | 						if (lp->p_encap == ISDN_NET_ENCAP_CISCOHDLCK) | 
 | 483 | 							isdn_net_ciscohdlck_connected(lp); | 
 | 484 | 						if (lp->p_encap != ISDN_NET_ENCAP_SYNCPPP) { | 
 | 485 | 							if (lp->master) { /* is lp a slave? */ | 
 | 486 | 								isdn_net_dev *nd = ((isdn_net_local *)lp->master->priv)->netdev; | 
 | 487 | 								isdn_net_add_to_bundle(nd, lp); | 
 | 488 | 							} | 
 | 489 | 						} | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 490 | 						printk(KERN_INFO "isdn_net: %s connected\n", p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 491 | 						/* If first Chargeinfo comes before B-Channel connect, | 
 | 492 | 						 * we correct the timestamp here. | 
 | 493 | 						 */ | 
 | 494 | 						lp->chargetime = jiffies; | 
 | 495 |  | 
 | 496 | 						/* reset dial-timeout */ | 
 | 497 | 						lp->dialstarted = 0; | 
 | 498 | 						lp->dialwait_timer = 0; | 
 | 499 |  | 
 | 500 | #ifdef CONFIG_ISDN_PPP | 
 | 501 | 						if (lp->p_encap == ISDN_NET_ENCAP_SYNCPPP) | 
 | 502 | 							isdn_ppp_wakeup_daemon(lp); | 
 | 503 | #endif | 
 | 504 | #ifdef CONFIG_ISDN_X25 | 
 | 505 | 						/* try if there are generic concap receiver routines */ | 
 | 506 | 						if( pops ) | 
 | 507 | 							if( pops->connect_ind) | 
 | 508 | 								pops->connect_ind(cprot); | 
 | 509 | #endif /* CONFIG_ISDN_X25 */ | 
 | 510 | 						/* ppp needs to do negotiations first */ | 
 | 511 | 						if (lp->p_encap != ISDN_NET_ENCAP_SYNCPPP) | 
 | 512 | 							isdn_net_device_wake_queue(lp); | 
 | 513 | 						return 1; | 
 | 514 | 				} | 
 | 515 | 				break; | 
 | 516 | 			case ISDN_STAT_NODCH: | 
 | 517 | 				/* No D-Channel avail. */ | 
 | 518 | 				if (lp->dialstate == 4) { | 
 | 519 | 					lp->dialstate--; | 
 | 520 | 					return 1; | 
 | 521 | 				} | 
 | 522 | 				break; | 
 | 523 | 			case ISDN_STAT_CINF: | 
 | 524 | 				/* Charge-info from TelCo. Calculate interval between | 
 | 525 | 				 * charge-infos and set timestamp for last info for | 
 | 526 | 				 * usage by isdn_net_autohup() | 
 | 527 | 				 */ | 
 | 528 | 				lp->charge++; | 
 | 529 | 				if (lp->hupflags & ISDN_HAVECHARGE) { | 
 | 530 | 					lp->hupflags &= ~ISDN_WAITCHARGE; | 
 | 531 | 					lp->chargeint = jiffies - lp->chargetime - (2 * HZ); | 
 | 532 | 				} | 
 | 533 | 				if (lp->hupflags & ISDN_WAITCHARGE) | 
 | 534 | 					lp->hupflags |= ISDN_HAVECHARGE; | 
 | 535 | 				lp->chargetime = jiffies; | 
 | 536 | 				printk(KERN_DEBUG "isdn_net: Got CINF chargetime of %s now %lu\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 537 | 				       p->dev->name, lp->chargetime); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 538 | 				return 1; | 
 | 539 | 		} | 
 | 540 | 	} | 
 | 541 | 	return 0; | 
 | 542 | } | 
 | 543 |  | 
 | 544 | /* | 
 | 545 |  * Perform dialout for net-interfaces and timeout-handling for | 
 | 546 |  * D-Channel-up and B-Channel-up Messages. | 
 | 547 |  * This function is initially called from within isdn_net_start_xmit() or | 
 | 548 |  * or isdn_net_find_icall() after initializing the dialstate for an | 
 | 549 |  * interface. If further calls are needed, the function schedules itself | 
 | 550 |  * for a timer-callback via isdn_timer_function(). | 
 | 551 |  * The dialstate is also affected by incoming status-messages from | 
 | 552 |  * the ISDN-Channel which are handled in isdn_net_stat_callback() above. | 
 | 553 |  */ | 
 | 554 | void | 
 | 555 | isdn_net_dial(void) | 
 | 556 | { | 
 | 557 | 	isdn_net_dev *p = dev->netdev; | 
 | 558 | 	int anymore = 0; | 
 | 559 | 	int i; | 
 | 560 | 	isdn_ctrl cmd; | 
 | 561 |         u_char *phone_number; | 
 | 562 |  | 
 | 563 | 	while (p) { | 
 | 564 | 		isdn_net_local *lp = p->local; | 
 | 565 |  | 
 | 566 | #ifdef ISDN_DEBUG_NET_DIAL | 
 | 567 | 		if (lp->dialstate) | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 568 | 			printk(KERN_DEBUG "%s: dialstate=%d\n", p->dev->name, lp->dialstate); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 569 | #endif | 
 | 570 | 		switch (lp->dialstate) { | 
 | 571 | 			case 0: | 
 | 572 | 				/* Nothing to do for this interface */ | 
 | 573 | 				break; | 
 | 574 | 			case 1: | 
 | 575 | 				/* Initiate dialout. Set phone-number-pointer to first number | 
 | 576 | 				 * of interface. | 
 | 577 | 				 */ | 
 | 578 | 				lp->dial = lp->phone[1]; | 
 | 579 | 				if (!lp->dial) { | 
 | 580 | 					printk(KERN_WARNING "%s: phone number deleted?\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 581 | 					       p->dev->name); | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 582 | 					isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 583 | 					break; | 
 | 584 | 				} | 
 | 585 | 				anymore = 1; | 
 | 586 |  | 
 | 587 | 				if(lp->dialtimeout > 0) | 
 | 588 | 					if(lp->dialstarted == 0 || time_after(jiffies, lp->dialstarted + lp->dialtimeout + lp->dialwait)) { | 
 | 589 | 						lp->dialstarted = jiffies; | 
 | 590 | 						lp->dialwait_timer = 0; | 
 | 591 | 					} | 
 | 592 |  | 
 | 593 | 				lp->dialstate++; | 
 | 594 | 				/* Fall through */ | 
 | 595 | 			case 2: | 
 | 596 | 				/* Prepare dialing. Clear EAZ, then set EAZ. */ | 
 | 597 | 				cmd.driver = lp->isdn_device; | 
 | 598 | 				cmd.arg = lp->isdn_channel; | 
 | 599 | 				cmd.command = ISDN_CMD_CLREAZ; | 
 | 600 | 				isdn_command(&cmd); | 
 | 601 | 				sprintf(cmd.parm.num, "%s", isdn_map_eaz2msn(lp->msn, cmd.driver)); | 
 | 602 | 				cmd.command = ISDN_CMD_SETEAZ; | 
 | 603 | 				isdn_command(&cmd); | 
 | 604 | 				lp->dialretry = 0; | 
 | 605 | 				anymore = 1; | 
 | 606 | 				lp->dialstate++; | 
 | 607 | 				/* Fall through */ | 
 | 608 | 			case 3: | 
 | 609 | 				/* Setup interface, dial current phone-number, switch to next number. | 
 | 610 | 				 * If list of phone-numbers is exhausted, increment | 
 | 611 | 				 * retry-counter. | 
 | 612 | 				 */ | 
 | 613 | 				if(dev->global_flags & ISDN_GLOBAL_STOPPED || (ISDN_NET_DIALMODE(*lp) == ISDN_NET_DM_OFF)) { | 
 | 614 | 					char *s; | 
 | 615 | 					if (dev->global_flags & ISDN_GLOBAL_STOPPED) | 
 | 616 | 						s = "dial suppressed: isdn system stopped"; | 
 | 617 | 					else | 
 | 618 | 						s = "dial suppressed: dialmode `off'"; | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 619 | 					isdn_net_unreachable(p->dev, NULL, s); | 
 | 620 | 					isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 621 | 					break; | 
 | 622 | 				} | 
 | 623 | 				cmd.driver = lp->isdn_device; | 
 | 624 | 				cmd.command = ISDN_CMD_SETL2; | 
 | 625 | 				cmd.arg = lp->isdn_channel + (lp->l2_proto << 8); | 
 | 626 | 				isdn_command(&cmd); | 
 | 627 | 				cmd.driver = lp->isdn_device; | 
 | 628 | 				cmd.command = ISDN_CMD_SETL3; | 
 | 629 | 				cmd.arg = lp->isdn_channel + (lp->l3_proto << 8); | 
 | 630 | 				isdn_command(&cmd); | 
 | 631 | 				cmd.driver = lp->isdn_device; | 
 | 632 | 				cmd.arg = lp->isdn_channel; | 
 | 633 | 				if (!lp->dial) { | 
 | 634 | 					printk(KERN_WARNING "%s: phone number deleted?\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 635 | 					       p->dev->name); | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 636 | 					isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 637 | 					break; | 
 | 638 | 				} | 
 | 639 | 				if (!strncmp(lp->dial->num, "LEASED", strlen("LEASED"))) { | 
 | 640 | 					lp->dialstate = 4; | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 641 | 					printk(KERN_INFO "%s: Open leased line ...\n", p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 642 | 				} else { | 
 | 643 | 					if(lp->dialtimeout > 0) | 
 | 644 | 						if (time_after(jiffies, lp->dialstarted + lp->dialtimeout)) { | 
 | 645 | 							lp->dialwait_timer = jiffies + lp->dialwait; | 
 | 646 | 							lp->dialstarted = 0; | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 647 | 							isdn_net_unreachable(p->dev, NULL, "dial: timed out"); | 
 | 648 | 							isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 649 | 							break; | 
 | 650 | 						} | 
 | 651 |  | 
 | 652 | 					cmd.driver = lp->isdn_device; | 
 | 653 | 					cmd.command = ISDN_CMD_DIAL; | 
 | 654 | 					cmd.parm.setup.si2 = 0; | 
 | 655 |  | 
 | 656 |                                         /* check for DOV */ | 
 | 657 |                                         phone_number = lp->dial->num; | 
 | 658 |                                         if ((*phone_number == 'v') || | 
 | 659 | 					    (*phone_number == 'V')) { /* DOV call */ | 
 | 660 |                                                 cmd.parm.setup.si1 = 1; | 
 | 661 |                                         } else { /* DATA call */ | 
 | 662 |                                                 cmd.parm.setup.si1 = 7; | 
 | 663 | 					} | 
 | 664 |  | 
 | 665 | 					strcpy(cmd.parm.setup.phone, phone_number); | 
 | 666 | 					/* | 
 | 667 | 					 * Switch to next number or back to start if at end of list. | 
 | 668 | 					 */ | 
 | 669 | 					if (!(lp->dial = (isdn_net_phone *) lp->dial->next)) { | 
 | 670 | 						lp->dial = lp->phone[1]; | 
 | 671 | 						lp->dialretry++; | 
 | 672 |  | 
 | 673 | 						if (lp->dialretry > lp->dialmax) { | 
 | 674 | 							if (lp->dialtimeout == 0) { | 
 | 675 | 								lp->dialwait_timer = jiffies + lp->dialwait; | 
 | 676 | 								lp->dialstarted = 0; | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 677 | 								isdn_net_unreachable(p->dev, NULL, "dial: tried all numbers dialmax times"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 678 | 							} | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 679 | 							isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 680 | 							break; | 
 | 681 | 						} | 
 | 682 | 					} | 
 | 683 | 					sprintf(cmd.parm.setup.eazmsn, "%s", | 
 | 684 | 						isdn_map_eaz2msn(lp->msn, cmd.driver)); | 
 | 685 | 					i = isdn_dc2minor(lp->isdn_device, lp->isdn_channel); | 
 | 686 | 					if (i >= 0) { | 
 | 687 | 						strcpy(dev->num[i], cmd.parm.setup.phone); | 
 | 688 | 						dev->usage[i] |= ISDN_USAGE_OUTGOING; | 
 | 689 | 						isdn_info_update(); | 
 | 690 | 					} | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 691 | 					printk(KERN_INFO "%s: dialing %d %s... %s\n", p->dev->name, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 692 | 					       lp->dialretry, cmd.parm.setup.phone, | 
 | 693 | 					       (cmd.parm.setup.si1 == 1) ? "DOV" : ""); | 
 | 694 | 					lp->dtimer = 0; | 
 | 695 | #ifdef ISDN_DEBUG_NET_DIAL | 
 | 696 | 					printk(KERN_DEBUG "dial: d=%d c=%d\n", lp->isdn_device, | 
 | 697 | 					       lp->isdn_channel); | 
 | 698 | #endif | 
 | 699 | 					isdn_command(&cmd); | 
 | 700 | 				} | 
 | 701 | 				lp->huptimer = 0; | 
 | 702 | 				lp->outgoing = 1; | 
 | 703 | 				if (lp->chargeint) { | 
 | 704 | 					lp->hupflags |= ISDN_HAVECHARGE; | 
 | 705 | 					lp->hupflags &= ~ISDN_WAITCHARGE; | 
 | 706 | 				} else { | 
 | 707 | 					lp->hupflags |= ISDN_WAITCHARGE; | 
 | 708 | 					lp->hupflags &= ~ISDN_HAVECHARGE; | 
 | 709 | 				} | 
 | 710 | 				anymore = 1; | 
 | 711 | 				lp->dialstate = | 
 | 712 | 				    (lp->cbdelay && | 
 | 713 | 				     (lp->flags & ISDN_NET_CBOUT)) ? 12 : 4; | 
 | 714 | 				break; | 
 | 715 | 			case 4: | 
 | 716 | 				/* Wait for D-Channel-connect. | 
 | 717 | 				 * If timeout, switch back to state 3. | 
 | 718 | 				 * Dialmax-handling moved to state 3. | 
 | 719 | 				 */ | 
 | 720 | 				if (lp->dtimer++ > ISDN_TIMER_DTIMEOUT10) | 
 | 721 | 					lp->dialstate = 3; | 
 | 722 | 				anymore = 1; | 
 | 723 | 				break; | 
 | 724 | 			case 5: | 
 | 725 | 				/* Got D-Channel-Connect, send B-Channel-request */ | 
 | 726 | 				cmd.driver = lp->isdn_device; | 
 | 727 | 				cmd.arg = lp->isdn_channel; | 
 | 728 | 				cmd.command = ISDN_CMD_ACCEPTB; | 
 | 729 | 				anymore = 1; | 
 | 730 | 				lp->dtimer = 0; | 
 | 731 | 				lp->dialstate++; | 
 | 732 | 				isdn_command(&cmd); | 
 | 733 | 				break; | 
 | 734 | 			case 6: | 
 | 735 | 				/* Wait for B- or D-Channel-connect. If timeout, | 
 | 736 | 				 * switch back to state 3. | 
 | 737 | 				 */ | 
 | 738 | #ifdef ISDN_DEBUG_NET_DIAL | 
 | 739 | 				printk(KERN_DEBUG "dialtimer2: %d\n", lp->dtimer); | 
 | 740 | #endif | 
 | 741 | 				if (lp->dtimer++ > ISDN_TIMER_DTIMEOUT10) | 
 | 742 | 					lp->dialstate = 3; | 
 | 743 | 				anymore = 1; | 
 | 744 | 				break; | 
 | 745 | 			case 7: | 
 | 746 | 				/* Got incoming Call, setup L2 and L3 protocols, | 
 | 747 | 				 * then wait for D-Channel-connect | 
 | 748 | 				 */ | 
 | 749 | #ifdef ISDN_DEBUG_NET_DIAL | 
 | 750 | 				printk(KERN_DEBUG "dialtimer4: %d\n", lp->dtimer); | 
 | 751 | #endif | 
 | 752 | 				cmd.driver = lp->isdn_device; | 
 | 753 | 				cmd.command = ISDN_CMD_SETL2; | 
 | 754 | 				cmd.arg = lp->isdn_channel + (lp->l2_proto << 8); | 
 | 755 | 				isdn_command(&cmd); | 
 | 756 | 				cmd.driver = lp->isdn_device; | 
 | 757 | 				cmd.command = ISDN_CMD_SETL3; | 
 | 758 | 				cmd.arg = lp->isdn_channel + (lp->l3_proto << 8); | 
 | 759 | 				isdn_command(&cmd); | 
 | 760 | 				if (lp->dtimer++ > ISDN_TIMER_DTIMEOUT15) | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 761 | 					isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 762 | 				else { | 
 | 763 | 					anymore = 1; | 
 | 764 | 					lp->dialstate++; | 
 | 765 | 				} | 
 | 766 | 				break; | 
 | 767 | 			case 9: | 
 | 768 | 				/* Got incoming D-Channel-Connect, send B-Channel-request */ | 
 | 769 | 				cmd.driver = lp->isdn_device; | 
 | 770 | 				cmd.arg = lp->isdn_channel; | 
 | 771 | 				cmd.command = ISDN_CMD_ACCEPTB; | 
 | 772 | 				isdn_command(&cmd); | 
 | 773 | 				anymore = 1; | 
 | 774 | 				lp->dtimer = 0; | 
 | 775 | 				lp->dialstate++; | 
 | 776 | 				break; | 
 | 777 | 			case 8: | 
 | 778 | 			case 10: | 
 | 779 | 				/*  Wait for B- or D-channel-connect */ | 
 | 780 | #ifdef ISDN_DEBUG_NET_DIAL | 
 | 781 | 				printk(KERN_DEBUG "dialtimer4: %d\n", lp->dtimer); | 
 | 782 | #endif | 
 | 783 | 				if (lp->dtimer++ > ISDN_TIMER_DTIMEOUT10) | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 784 | 					isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 785 | 				else | 
 | 786 | 					anymore = 1; | 
 | 787 | 				break; | 
 | 788 | 			case 11: | 
 | 789 | 				/* Callback Delay */ | 
 | 790 | 				if (lp->dtimer++ > lp->cbdelay) | 
 | 791 | 					lp->dialstate = 1; | 
 | 792 | 				anymore = 1; | 
 | 793 | 				break; | 
 | 794 | 			case 12: | 
 | 795 | 				/* Remote does callback. Hangup after cbdelay, then wait for incoming | 
 | 796 | 				 * call (in state 4). | 
 | 797 | 				 */ | 
 | 798 | 				if (lp->dtimer++ > lp->cbdelay) | 
 | 799 | 				{ | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 800 | 					printk(KERN_INFO "%s: hangup waiting for callback ...\n", p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 801 | 					lp->dtimer = 0; | 
 | 802 | 					lp->dialstate = 4; | 
 | 803 | 					cmd.driver = lp->isdn_device; | 
 | 804 | 					cmd.command = ISDN_CMD_HANGUP; | 
 | 805 | 					cmd.arg = lp->isdn_channel; | 
 | 806 | 					isdn_command(&cmd); | 
 | 807 | 					isdn_all_eaz(lp->isdn_device, lp->isdn_channel); | 
 | 808 | 				} | 
 | 809 | 				anymore = 1; | 
 | 810 | 				break; | 
 | 811 | 			default: | 
 | 812 | 				printk(KERN_WARNING "isdn_net: Illegal dialstate %d for device %s\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 813 | 				       lp->dialstate, p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 814 | 		} | 
 | 815 | 		p = (isdn_net_dev *) p->next; | 
 | 816 | 	} | 
 | 817 | 	isdn_timer_ctrl(ISDN_TIMER_NETDIAL, anymore); | 
 | 818 | } | 
 | 819 |  | 
 | 820 | /* | 
 | 821 |  * Perform hangup for a net-interface. | 
 | 822 |  */ | 
 | 823 | void | 
 | 824 | isdn_net_hangup(struct net_device *d) | 
 | 825 | { | 
 | 826 | 	isdn_net_local *lp = (isdn_net_local *) d->priv; | 
 | 827 | 	isdn_ctrl cmd; | 
 | 828 | #ifdef CONFIG_ISDN_X25 | 
 | 829 | 	struct concap_proto *cprot = lp->netdev->cprot; | 
 | 830 | 	struct concap_proto_ops *pops = cprot ? cprot->pops : NULL; | 
 | 831 | #endif | 
 | 832 |  | 
 | 833 | 	if (lp->flags & ISDN_NET_CONNECTED) { | 
 | 834 | 		if (lp->slave != NULL) { | 
 | 835 | 			isdn_net_local *slp = (isdn_net_local *)lp->slave->priv; | 
 | 836 | 			if (slp->flags & ISDN_NET_CONNECTED) { | 
 | 837 | 				printk(KERN_INFO | 
 | 838 | 					"isdn_net: hang up slave %s before %s\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 839 | 					lp->slave->name, d->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 840 | 				isdn_net_hangup(lp->slave); | 
 | 841 | 			} | 
 | 842 | 		} | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 843 | 		printk(KERN_INFO "isdn_net: local hangup %s\n", d->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 844 | #ifdef CONFIG_ISDN_PPP | 
 | 845 | 		if (lp->p_encap == ISDN_NET_ENCAP_SYNCPPP) | 
 | 846 | 			isdn_ppp_free(lp); | 
 | 847 | #endif | 
 | 848 | 		isdn_net_lp_disconnected(lp); | 
 | 849 | #ifdef CONFIG_ISDN_X25 | 
 | 850 | 		/* try if there are generic encap protocol | 
 | 851 | 		   receiver routines and signal the closure of | 
 | 852 | 		   the link */ | 
 | 853 | 		if( pops && pops -> disconn_ind ) | 
 | 854 | 		  pops -> disconn_ind(cprot); | 
 | 855 | #endif /* CONFIG_ISDN_X25 */ | 
 | 856 |  | 
 | 857 | 		cmd.driver = lp->isdn_device; | 
 | 858 | 		cmd.command = ISDN_CMD_HANGUP; | 
 | 859 | 		cmd.arg = lp->isdn_channel; | 
 | 860 | 		isdn_command(&cmd); | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 861 | 		printk(KERN_INFO "%s: Chargesum is %d\n", d->name, lp->charge); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 862 | 		isdn_all_eaz(lp->isdn_device, lp->isdn_channel); | 
 | 863 | 	} | 
 | 864 | 	isdn_net_unbind_channel(lp); | 
 | 865 | } | 
 | 866 |  | 
 | 867 | typedef struct { | 
 | 868 | 	unsigned short source; | 
 | 869 | 	unsigned short dest; | 
 | 870 | } ip_ports; | 
 | 871 |  | 
 | 872 | static void | 
 | 873 | isdn_net_log_skb(struct sk_buff * skb, isdn_net_local * lp) | 
 | 874 | { | 
| Arnaldo Carvalho de Melo | d56f90a | 2007-04-10 20:50:43 -0700 | [diff] [blame] | 875 | 	/* hopefully, this was set correctly */ | 
 | 876 | 	const u_char *p = skb_network_header(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 877 | 	unsigned short proto = ntohs(skb->protocol); | 
 | 878 | 	int data_ofs; | 
 | 879 | 	ip_ports *ipp; | 
 | 880 | 	char addinfo[100]; | 
 | 881 |  | 
 | 882 | 	addinfo[0] = '\0'; | 
 | 883 | 	/* This check stolen from 2.1.72 dev_queue_xmit_nit() */ | 
| Arnaldo Carvalho de Melo | 27a884d | 2007-04-19 20:29:13 -0700 | [diff] [blame] | 884 | 	if (p < skb->data || skb->network_header >= skb->tail) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 885 | 		/* fall back to old isdn_net_log_packet method() */ | 
 | 886 | 		char * buf = skb->data; | 
 | 887 |  | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 888 | 		printk(KERN_DEBUG "isdn_net: protocol %04x is buggy, dev %s\n", skb->protocol, lp->netdev->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 889 | 		p = buf; | 
 | 890 | 		proto = ETH_P_IP; | 
 | 891 | 		switch (lp->p_encap) { | 
 | 892 | 			case ISDN_NET_ENCAP_IPTYP: | 
 | 893 | 				proto = ntohs(*(unsigned short *) &buf[0]); | 
 | 894 | 				p = &buf[2]; | 
 | 895 | 				break; | 
 | 896 | 			case ISDN_NET_ENCAP_ETHER: | 
 | 897 | 				proto = ntohs(*(unsigned short *) &buf[12]); | 
 | 898 | 				p = &buf[14]; | 
 | 899 | 				break; | 
 | 900 | 			case ISDN_NET_ENCAP_CISCOHDLC: | 
 | 901 | 				proto = ntohs(*(unsigned short *) &buf[2]); | 
 | 902 | 				p = &buf[4]; | 
 | 903 | 				break; | 
 | 904 | #ifdef CONFIG_ISDN_PPP | 
 | 905 | 			case ISDN_NET_ENCAP_SYNCPPP: | 
 | 906 | 				proto = ntohs(skb->protocol); | 
 | 907 | 				p = &buf[IPPP_MAX_HEADER]; | 
 | 908 | 				break; | 
 | 909 | #endif | 
 | 910 | 		} | 
 | 911 | 	} | 
 | 912 | 	data_ofs = ((p[0] & 15) * 4); | 
 | 913 | 	switch (proto) { | 
 | 914 | 		case ETH_P_IP: | 
 | 915 | 			switch (p[9]) { | 
 | 916 | 				case 1: | 
 | 917 | 					strcpy(addinfo, " ICMP"); | 
 | 918 | 					break; | 
 | 919 | 				case 2: | 
 | 920 | 					strcpy(addinfo, " IGMP"); | 
 | 921 | 					break; | 
 | 922 | 				case 4: | 
 | 923 | 					strcpy(addinfo, " IPIP"); | 
 | 924 | 					break; | 
 | 925 | 				case 6: | 
 | 926 | 					ipp = (ip_ports *) (&p[data_ofs]); | 
 | 927 | 					sprintf(addinfo, " TCP, port: %d -> %d", ntohs(ipp->source), | 
 | 928 | 						ntohs(ipp->dest)); | 
 | 929 | 					break; | 
 | 930 | 				case 8: | 
 | 931 | 					strcpy(addinfo, " EGP"); | 
 | 932 | 					break; | 
 | 933 | 				case 12: | 
 | 934 | 					strcpy(addinfo, " PUP"); | 
 | 935 | 					break; | 
 | 936 | 				case 17: | 
 | 937 | 					ipp = (ip_ports *) (&p[data_ofs]); | 
 | 938 | 					sprintf(addinfo, " UDP, port: %d -> %d", ntohs(ipp->source), | 
 | 939 | 						ntohs(ipp->dest)); | 
 | 940 | 					break; | 
 | 941 | 				case 22: | 
 | 942 | 					strcpy(addinfo, " IDP"); | 
 | 943 | 					break; | 
 | 944 | 			} | 
 | 945 | 			printk(KERN_INFO | 
 | 946 | 				"OPEN: %d.%d.%d.%d -> %d.%d.%d.%d%s\n", | 
 | 947 |  | 
 | 948 | 			       p[12], p[13], p[14], p[15], | 
 | 949 | 			       p[16], p[17], p[18], p[19], | 
 | 950 | 			       addinfo); | 
 | 951 | 			break; | 
 | 952 | 		case ETH_P_ARP: | 
 | 953 | 			printk(KERN_INFO | 
 | 954 | 				"OPEN: ARP %d.%d.%d.%d -> *.*.*.* ?%d.%d.%d.%d\n", | 
 | 955 | 			       p[14], p[15], p[16], p[17], | 
 | 956 | 			       p[24], p[25], p[26], p[27]); | 
 | 957 | 			break; | 
 | 958 | 	} | 
 | 959 | } | 
 | 960 |  | 
 | 961 | /* | 
 | 962 |  * this function is used to send supervisory data, i.e. data which was | 
 | 963 |  * not received from the network layer, but e.g. frames from ipppd, CCP | 
 | 964 |  * reset frames etc. | 
 | 965 |  */ | 
 | 966 | void isdn_net_write_super(isdn_net_local *lp, struct sk_buff *skb) | 
 | 967 | { | 
 | 968 | 	if (in_irq()) { | 
 | 969 | 		// we can't grab the lock from irq context,  | 
 | 970 | 		// so we just queue the packet | 
 | 971 | 		skb_queue_tail(&lp->super_tx_queue, skb); | 
 | 972 | 		schedule_work(&lp->tqueue); | 
 | 973 | 		return; | 
 | 974 | 	} | 
 | 975 |  | 
 | 976 | 	spin_lock_bh(&lp->xmit_lock); | 
 | 977 | 	if (!isdn_net_lp_busy(lp)) { | 
 | 978 | 		isdn_net_writebuf_skb(lp, skb); | 
 | 979 | 	} else { | 
 | 980 | 		skb_queue_tail(&lp->super_tx_queue, skb); | 
 | 981 | 	} | 
 | 982 | 	spin_unlock_bh(&lp->xmit_lock); | 
 | 983 | } | 
 | 984 |  | 
 | 985 | /* | 
 | 986 |  * called from tq_immediate | 
 | 987 |  */ | 
| David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 988 | static void isdn_net_softint(struct work_struct *work) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 989 | { | 
| David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 990 | 	isdn_net_local *lp = container_of(work, isdn_net_local, tqueue); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 991 | 	struct sk_buff *skb; | 
 | 992 |  | 
 | 993 | 	spin_lock_bh(&lp->xmit_lock); | 
 | 994 | 	while (!isdn_net_lp_busy(lp)) { | 
 | 995 | 		skb = skb_dequeue(&lp->super_tx_queue); | 
 | 996 | 		if (!skb) | 
 | 997 | 			break; | 
 | 998 | 		isdn_net_writebuf_skb(lp, skb);                                 | 
 | 999 | 	} | 
 | 1000 | 	spin_unlock_bh(&lp->xmit_lock); | 
 | 1001 | } | 
 | 1002 |  | 
 | 1003 | /*  | 
 | 1004 |  * all frames sent from the (net) LL to a HL driver should go via this function | 
 | 1005 |  * it's serialized by the caller holding the lp->xmit_lock spinlock | 
 | 1006 |  */ | 
 | 1007 | void isdn_net_writebuf_skb(isdn_net_local *lp, struct sk_buff *skb) | 
 | 1008 | { | 
 | 1009 | 	int ret; | 
 | 1010 | 	int len = skb->len;     /* save len */ | 
 | 1011 |  | 
 | 1012 | 	/* before obtaining the lock the caller should have checked that | 
 | 1013 | 	   the lp isn't busy */ | 
 | 1014 | 	if (isdn_net_lp_busy(lp)) { | 
 | 1015 | 		printk("isdn BUG at %s:%d!\n", __FILE__, __LINE__); | 
 | 1016 | 		goto error; | 
 | 1017 | 	} | 
 | 1018 |  | 
 | 1019 | 	if (!(lp->flags & ISDN_NET_CONNECTED)) { | 
 | 1020 | 		printk("isdn BUG at %s:%d!\n", __FILE__, __LINE__); | 
 | 1021 | 		goto error; | 
 | 1022 | 	} | 
 | 1023 | 	ret = isdn_writebuf_skb_stub(lp->isdn_device, lp->isdn_channel, 1, skb); | 
 | 1024 | 	if (ret != len) { | 
 | 1025 | 		/* we should never get here */ | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1026 | 		printk(KERN_WARNING "%s: HL driver queue full\n", lp->netdev->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1027 | 		goto error; | 
 | 1028 | 	} | 
 | 1029 | 	 | 
 | 1030 | 	lp->transcount += len; | 
 | 1031 | 	isdn_net_inc_frame_cnt(lp); | 
 | 1032 | 	return; | 
 | 1033 |  | 
 | 1034 |  error: | 
 | 1035 | 	dev_kfree_skb(skb); | 
 | 1036 | 	lp->stats.tx_errors++; | 
 | 1037 |  | 
 | 1038 | } | 
 | 1039 |  | 
 | 1040 |  | 
 | 1041 | /* | 
 | 1042 |  *  Helper function for isdn_net_start_xmit. | 
 | 1043 |  *  When called, the connection is already established. | 
 | 1044 |  *  Based on cps-calculation, check if device is overloaded. | 
 | 1045 |  *  If so, and if a slave exists, trigger dialing for it. | 
 | 1046 |  *  If any slave is online, deliver packets using a simple round robin | 
 | 1047 |  *  scheme. | 
 | 1048 |  * | 
 | 1049 |  *  Return: 0 on success, !0 on failure. | 
 | 1050 |  */ | 
 | 1051 |  | 
 | 1052 | static int | 
 | 1053 | isdn_net_xmit(struct net_device *ndev, struct sk_buff *skb) | 
 | 1054 | { | 
 | 1055 | 	isdn_net_dev *nd; | 
 | 1056 | 	isdn_net_local *slp; | 
 | 1057 | 	isdn_net_local *lp = (isdn_net_local *) ndev->priv; | 
 | 1058 | 	int retv = 0; | 
 | 1059 |  | 
 | 1060 | 	if (((isdn_net_local *) (ndev->priv))->master) { | 
 | 1061 | 		printk("isdn BUG at %s:%d!\n", __FILE__, __LINE__); | 
 | 1062 | 		dev_kfree_skb(skb); | 
 | 1063 | 		return 0; | 
 | 1064 | 	} | 
 | 1065 |  | 
 | 1066 | 	/* For the other encaps the header has already been built */ | 
 | 1067 | #ifdef CONFIG_ISDN_PPP | 
 | 1068 | 	if (lp->p_encap == ISDN_NET_ENCAP_SYNCPPP) { | 
 | 1069 | 		return isdn_ppp_xmit(skb, ndev); | 
 | 1070 | 	} | 
 | 1071 | #endif | 
 | 1072 | 	nd = ((isdn_net_local *) ndev->priv)->netdev; | 
 | 1073 | 	lp = isdn_net_get_locked_lp(nd); | 
 | 1074 | 	if (!lp) { | 
 | 1075 | 		printk(KERN_WARNING "%s: all channels busy - requeuing!\n", ndev->name); | 
 | 1076 | 		return 1; | 
 | 1077 | 	} | 
 | 1078 | 	/* we have our lp locked from now on */ | 
 | 1079 |  | 
 | 1080 | 	/* Reset hangup-timeout */ | 
 | 1081 | 	lp->huptimer = 0; // FIXME? | 
 | 1082 | 	isdn_net_writebuf_skb(lp, skb); | 
 | 1083 | 	spin_unlock_bh(&lp->xmit_lock); | 
 | 1084 |  | 
 | 1085 | 	/* the following stuff is here for backwards compatibility. | 
 | 1086 | 	 * in future, start-up and hangup of slaves (based on current load) | 
 | 1087 | 	 * should move to userspace and get based on an overall cps | 
 | 1088 | 	 * calculation | 
 | 1089 | 	 */ | 
 | 1090 | 	if (lp->cps > lp->triggercps) { | 
 | 1091 | 		if (lp->slave) { | 
 | 1092 | 			if (!lp->sqfull) { | 
 | 1093 | 				/* First time overload: set timestamp only */ | 
 | 1094 | 				lp->sqfull = 1; | 
 | 1095 | 				lp->sqfull_stamp = jiffies; | 
 | 1096 | 			} else { | 
 | 1097 | 				/* subsequent overload: if slavedelay exceeded, start dialing */ | 
 | 1098 | 				if (time_after(jiffies, lp->sqfull_stamp + lp->slavedelay)) { | 
 | 1099 | 					slp = lp->slave->priv; | 
 | 1100 | 					if (!(slp->flags & ISDN_NET_CONNECTED)) { | 
 | 1101 | 						isdn_net_force_dial_lp((isdn_net_local *) lp->slave->priv); | 
 | 1102 | 					} | 
 | 1103 | 				} | 
 | 1104 | 			} | 
 | 1105 | 		} | 
 | 1106 | 	} else { | 
 | 1107 | 		if (lp->sqfull && time_after(jiffies, lp->sqfull_stamp + lp->slavedelay + (10 * HZ))) { | 
 | 1108 | 			lp->sqfull = 0; | 
 | 1109 | 		} | 
 | 1110 | 		/* this is a hack to allow auto-hangup for slaves on moderate loads */ | 
 | 1111 | 		nd->queue = nd->local; | 
 | 1112 | 	} | 
 | 1113 |  | 
 | 1114 | 	return retv; | 
 | 1115 |  | 
 | 1116 | } | 
 | 1117 |  | 
 | 1118 | static void | 
 | 1119 | isdn_net_adjust_hdr(struct sk_buff *skb, struct net_device *dev) | 
 | 1120 | { | 
 | 1121 | 	isdn_net_local *lp = (isdn_net_local *) dev->priv; | 
 | 1122 | 	if (!skb) | 
 | 1123 | 		return; | 
 | 1124 | 	if (lp->p_encap == ISDN_NET_ENCAP_ETHER) { | 
| Arnaldo Carvalho de Melo | bbe735e | 2007-03-10 22:16:10 -0300 | [diff] [blame] | 1125 | 		const int pullsize = skb_network_offset(skb) - ETH_HLEN; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1126 | 		if (pullsize > 0) { | 
 | 1127 | 			printk(KERN_DEBUG "isdn_net: Pull junk %d\n", pullsize); | 
 | 1128 | 			skb_pull(skb, pullsize); | 
 | 1129 | 		} | 
 | 1130 | 	} | 
 | 1131 | } | 
 | 1132 |  | 
 | 1133 |  | 
| Adrian Bunk | 3e206b0 | 2005-06-25 14:58:35 -0700 | [diff] [blame] | 1134 | static void isdn_net_tx_timeout(struct net_device * ndev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1135 | { | 
 | 1136 | 	isdn_net_local *lp = (isdn_net_local *) ndev->priv; | 
 | 1137 |  | 
 | 1138 | 	printk(KERN_WARNING "isdn_tx_timeout dev %s dialstate %d\n", ndev->name, lp->dialstate); | 
 | 1139 | 	if (!lp->dialstate){ | 
 | 1140 | 		lp->stats.tx_errors++; | 
 | 1141 |                 /* | 
 | 1142 | 		 * There is a certain probability that this currently | 
 | 1143 | 		 * works at all because if we always wake up the interface, | 
 | 1144 | 		 * then upper layer will try to send the next packet | 
 | 1145 | 		 * immediately. And then, the old clean_up logic in the | 
 | 1146 | 		 * driver will hopefully continue to work as it used to do. | 
 | 1147 | 		 * | 
 | 1148 | 		 * This is rather primitive right know, we better should | 
 | 1149 | 		 * clean internal queues here, in particular for multilink and | 
 | 1150 | 		 * ppp, and reset HL driver's channel, too.   --HE | 
 | 1151 | 		 * | 
 | 1152 | 		 * actually, this may not matter at all, because ISDN hardware | 
 | 1153 | 		 * should not see transmitter hangs at all IMO | 
 | 1154 | 		 * changed KERN_DEBUG to KERN_WARNING to find out if this is  | 
 | 1155 | 		 * ever called   --KG | 
 | 1156 | 		 */ | 
 | 1157 | 	} | 
 | 1158 | 	ndev->trans_start = jiffies; | 
 | 1159 | 	netif_wake_queue(ndev); | 
 | 1160 | } | 
 | 1161 |  | 
 | 1162 | /* | 
 | 1163 |  * Try sending a packet. | 
 | 1164 |  * If this interface isn't connected to a ISDN-Channel, find a free channel, | 
 | 1165 |  * and start dialing. | 
 | 1166 |  */ | 
 | 1167 | static int | 
 | 1168 | isdn_net_start_xmit(struct sk_buff *skb, struct net_device *ndev) | 
 | 1169 | { | 
 | 1170 | 	isdn_net_local *lp = (isdn_net_local *) ndev->priv; | 
 | 1171 | #ifdef CONFIG_ISDN_X25 | 
 | 1172 | 	struct concap_proto * cprot = lp -> netdev -> cprot; | 
 | 1173 | /* At this point hard_start_xmit() passes control to the encapsulation | 
 | 1174 |    protocol (if present). | 
 | 1175 |    For X.25 auto-dialing is completly bypassed because: | 
 | 1176 |    - It does not conform with the semantics of a reliable datalink | 
 | 1177 |      service as needed by X.25 PLP. | 
 | 1178 |    - I don't want that the interface starts dialing when the network layer | 
 | 1179 |      sends a message which requests to disconnect the lapb link (or if it | 
 | 1180 |      sends any other message not resulting in data transmission). | 
 | 1181 |    Instead, dialing will be initiated by the encapsulation protocol entity | 
 | 1182 |    when a dl_establish request is received from the upper layer. | 
 | 1183 | */ | 
 | 1184 | 	if (cprot && cprot -> pops) { | 
 | 1185 | 		int ret = cprot -> pops -> encap_and_xmit ( cprot , skb); | 
 | 1186 |  | 
 | 1187 | 		if (ret) | 
 | 1188 | 			netif_stop_queue(ndev); | 
 | 1189 | 		return ret; | 
 | 1190 | 	} else | 
 | 1191 | #endif | 
 | 1192 | 	/* auto-dialing xmit function */ | 
 | 1193 | 	{ | 
 | 1194 | #ifdef ISDN_DEBUG_NET_DUMP | 
 | 1195 | 		u_char *buf; | 
 | 1196 | #endif | 
 | 1197 | 		isdn_net_adjust_hdr(skb, ndev); | 
 | 1198 | #ifdef ISDN_DEBUG_NET_DUMP | 
 | 1199 | 		buf = skb->data; | 
 | 1200 | 		isdn_dumppkt("S:", buf, skb->len, 40); | 
 | 1201 | #endif | 
 | 1202 |  | 
 | 1203 | 		if (!(lp->flags & ISDN_NET_CONNECTED)) { | 
 | 1204 | 			int chi; | 
 | 1205 | 			/* only do autodial if allowed by config */ | 
 | 1206 | 			if (!(ISDN_NET_DIALMODE(*lp) == ISDN_NET_DM_AUTO)) { | 
 | 1207 | 				isdn_net_unreachable(ndev, skb, "dial rejected: interface not in dialmode `auto'"); | 
 | 1208 | 				dev_kfree_skb(skb); | 
 | 1209 | 				return 0; | 
 | 1210 | 			} | 
 | 1211 | 			if (lp->phone[1]) { | 
 | 1212 | 				ulong flags; | 
 | 1213 |  | 
 | 1214 | 				if(lp->dialwait_timer <= 0) | 
 | 1215 | 					if(lp->dialstarted > 0 && lp->dialtimeout > 0 && time_before(jiffies, lp->dialstarted + lp->dialtimeout + lp->dialwait)) | 
 | 1216 | 						lp->dialwait_timer = lp->dialstarted + lp->dialtimeout + lp->dialwait; | 
 | 1217 |  | 
 | 1218 | 				if(lp->dialwait_timer > 0) { | 
 | 1219 | 					if(time_before(jiffies, lp->dialwait_timer)) { | 
 | 1220 | 						isdn_net_unreachable(ndev, skb, "dial rejected: retry-time not reached"); | 
 | 1221 | 						dev_kfree_skb(skb); | 
 | 1222 | 						return 0; | 
 | 1223 | 					} else | 
 | 1224 | 						lp->dialwait_timer = 0; | 
 | 1225 | 				} | 
 | 1226 | 				/* Grab a free ISDN-Channel */ | 
 | 1227 | 				spin_lock_irqsave(&dev->lock, flags); | 
 | 1228 | 				if (((chi = | 
 | 1229 | 				     isdn_get_free_channel( | 
 | 1230 | 					 		ISDN_USAGE_NET, | 
 | 1231 | 							lp->l2_proto, | 
 | 1232 | 							lp->l3_proto, | 
 | 1233 | 							lp->pre_device, | 
 | 1234 | 						 	lp->pre_channel, | 
 | 1235 | 							lp->msn) | 
 | 1236 | 							) < 0) && | 
 | 1237 | 					((chi = | 
 | 1238 | 				     isdn_get_free_channel( | 
 | 1239 | 					 		ISDN_USAGE_NET, | 
 | 1240 | 							lp->l2_proto, | 
 | 1241 | 							lp->l3_proto, | 
 | 1242 | 							lp->pre_device, | 
 | 1243 | 							lp->pre_channel^1, | 
 | 1244 | 							lp->msn) | 
 | 1245 | 							) < 0)) { | 
 | 1246 | 					spin_unlock_irqrestore(&dev->lock, flags); | 
 | 1247 | 					isdn_net_unreachable(ndev, skb, | 
 | 1248 | 							   "No channel"); | 
 | 1249 | 					dev_kfree_skb(skb); | 
 | 1250 | 					return 0; | 
 | 1251 | 				} | 
 | 1252 | 				/* Log packet, which triggered dialing */ | 
 | 1253 | 				if (dev->net_verbose) | 
 | 1254 | 					isdn_net_log_skb(skb, lp); | 
 | 1255 | 				lp->dialstate = 1; | 
 | 1256 | 				/* Connect interface with channel */ | 
 | 1257 | 				isdn_net_bind_channel(lp, chi); | 
 | 1258 | #ifdef CONFIG_ISDN_PPP | 
 | 1259 | 				if (lp->p_encap == ISDN_NET_ENCAP_SYNCPPP) { | 
 | 1260 | 					/* no 'first_skb' handling for syncPPP */ | 
 | 1261 | 					if (isdn_ppp_bind(lp) < 0) { | 
 | 1262 | 						dev_kfree_skb(skb); | 
 | 1263 | 						isdn_net_unbind_channel(lp); | 
 | 1264 | 						spin_unlock_irqrestore(&dev->lock, flags); | 
 | 1265 | 						return 0;	/* STN (skb to nirvana) ;) */ | 
 | 1266 | 					} | 
 | 1267 | #ifdef CONFIG_IPPP_FILTER | 
 | 1268 | 					if (isdn_ppp_autodial_filter(skb, lp)) { | 
 | 1269 | 						isdn_ppp_free(lp); | 
 | 1270 | 						isdn_net_unbind_channel(lp); | 
 | 1271 | 						spin_unlock_irqrestore(&dev->lock, flags); | 
 | 1272 | 						isdn_net_unreachable(ndev, skb, "dial rejected: packet filtered"); | 
 | 1273 | 						dev_kfree_skb(skb); | 
 | 1274 | 						return 0; | 
 | 1275 | 					} | 
 | 1276 | #endif | 
 | 1277 | 					spin_unlock_irqrestore(&dev->lock, flags); | 
 | 1278 | 					isdn_net_dial();	/* Initiate dialing */ | 
 | 1279 | 					netif_stop_queue(ndev); | 
 | 1280 | 					return 1;	/* let upper layer requeue skb packet */ | 
 | 1281 | 				} | 
 | 1282 | #endif | 
 | 1283 | 				/* Initiate dialing */ | 
 | 1284 | 				spin_unlock_irqrestore(&dev->lock, flags); | 
 | 1285 | 				isdn_net_dial(); | 
 | 1286 | 				isdn_net_device_stop_queue(lp); | 
 | 1287 | 				return 1; | 
 | 1288 | 			} else { | 
 | 1289 | 				isdn_net_unreachable(ndev, skb, | 
 | 1290 | 						     "No phone number"); | 
 | 1291 | 				dev_kfree_skb(skb); | 
 | 1292 | 				return 0; | 
 | 1293 | 			} | 
 | 1294 | 		} else { | 
 | 1295 | 			/* Device is connected to an ISDN channel */  | 
 | 1296 | 			ndev->trans_start = jiffies; | 
 | 1297 | 			if (!lp->dialstate) { | 
 | 1298 | 				/* ISDN connection is established, try sending */ | 
 | 1299 | 				int ret; | 
 | 1300 | 				ret = (isdn_net_xmit(ndev, skb)); | 
 | 1301 | 				if(ret) netif_stop_queue(ndev); | 
 | 1302 | 				return ret; | 
 | 1303 | 			} else | 
 | 1304 | 				netif_stop_queue(ndev); | 
 | 1305 | 		} | 
 | 1306 | 	} | 
 | 1307 | 	return 1; | 
 | 1308 | } | 
 | 1309 |  | 
 | 1310 | /* | 
 | 1311 |  * Shutdown a net-interface. | 
 | 1312 |  */ | 
 | 1313 | static int | 
 | 1314 | isdn_net_close(struct net_device *dev) | 
 | 1315 | { | 
 | 1316 | 	struct net_device *p; | 
 | 1317 | #ifdef CONFIG_ISDN_X25 | 
 | 1318 | 	struct concap_proto * cprot = | 
 | 1319 | 		( (isdn_net_local *) dev->priv ) -> netdev -> cprot; | 
 | 1320 | 	/* printk(KERN_DEBUG "isdn_net_close %s\n" , dev-> name ); */ | 
 | 1321 | #endif | 
 | 1322 |  | 
 | 1323 | #ifdef CONFIG_ISDN_X25 | 
 | 1324 | 	if( cprot && cprot -> pops ) cprot -> pops -> close( cprot ); | 
 | 1325 | #endif | 
 | 1326 | 	netif_stop_queue(dev); | 
 | 1327 | 	if ((p = (((isdn_net_local *) dev->priv)->slave))) { | 
 | 1328 | 		/* If this interface has slaves, stop them also */ | 
 | 1329 | 		while (p) { | 
 | 1330 | #ifdef CONFIG_ISDN_X25 | 
 | 1331 | 			cprot = ( (isdn_net_local *) p->priv ) | 
 | 1332 | 				-> netdev -> cprot; | 
 | 1333 | 			if( cprot && cprot -> pops ) | 
 | 1334 | 				cprot -> pops -> close( cprot ); | 
 | 1335 | #endif | 
 | 1336 | 			isdn_net_hangup(p); | 
 | 1337 | 			p = (((isdn_net_local *) p->priv)->slave); | 
 | 1338 | 		} | 
 | 1339 | 	} | 
 | 1340 | 	isdn_net_hangup(dev); | 
 | 1341 | 	isdn_unlock_drivers(); | 
 | 1342 | 	return 0; | 
 | 1343 | } | 
 | 1344 |  | 
 | 1345 | /* | 
 | 1346 |  * Get statistics | 
 | 1347 |  */ | 
 | 1348 | static struct net_device_stats * | 
 | 1349 | isdn_net_get_stats(struct net_device *dev) | 
 | 1350 | { | 
 | 1351 | 	isdn_net_local *lp = (isdn_net_local *) dev->priv; | 
 | 1352 | 	return &lp->stats; | 
 | 1353 | } | 
 | 1354 |  | 
 | 1355 | /*      This is simply a copy from std. eth.c EXCEPT we pull ETH_HLEN | 
 | 1356 |  *      instead of dev->hard_header_len off. This is done because the | 
 | 1357 |  *      lowlevel-driver has already pulled off its stuff when we get | 
 | 1358 |  *      here and this routine only gets called with p_encap == ETHER. | 
 | 1359 |  *      Determine the packet's protocol ID. The rule here is that we | 
 | 1360 |  *      assume 802.3 if the type field is short enough to be a length. | 
 | 1361 |  *      This is normal practice and works for any 'now in use' protocol. | 
 | 1362 |  */ | 
 | 1363 |  | 
 | 1364 | static unsigned short | 
 | 1365 | isdn_net_type_trans(struct sk_buff *skb, struct net_device *dev) | 
 | 1366 | { | 
 | 1367 | 	struct ethhdr *eth; | 
 | 1368 | 	unsigned char *rawp; | 
 | 1369 |  | 
| Arnaldo Carvalho de Melo | 459a98e | 2007-03-19 15:30:44 -0700 | [diff] [blame] | 1370 | 	skb_reset_mac_header(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1371 | 	skb_pull(skb, ETH_HLEN); | 
 | 1372 | 	eth = eth_hdr(skb); | 
 | 1373 |  | 
 | 1374 | 	if (*eth->h_dest & 1) { | 
 | 1375 | 		if (memcmp(eth->h_dest, dev->broadcast, ETH_ALEN) == 0) | 
 | 1376 | 			skb->pkt_type = PACKET_BROADCAST; | 
 | 1377 | 		else | 
 | 1378 | 			skb->pkt_type = PACKET_MULTICAST; | 
 | 1379 | 	} | 
 | 1380 | 	/* | 
 | 1381 | 	 *      This ALLMULTI check should be redundant by 1.4 | 
 | 1382 | 	 *      so don't forget to remove it. | 
 | 1383 | 	 */ | 
 | 1384 |  | 
 | 1385 | 	else if (dev->flags & (IFF_PROMISC /*| IFF_ALLMULTI*/)) { | 
 | 1386 | 		if (memcmp(eth->h_dest, dev->dev_addr, ETH_ALEN)) | 
 | 1387 | 			skb->pkt_type = PACKET_OTHERHOST; | 
 | 1388 | 	} | 
 | 1389 | 	if (ntohs(eth->h_proto) >= 1536) | 
 | 1390 | 		return eth->h_proto; | 
 | 1391 |  | 
 | 1392 | 	rawp = skb->data; | 
 | 1393 |  | 
 | 1394 | 	/* | 
 | 1395 | 	 *      This is a magic hack to spot IPX packets. Older Novell breaks | 
 | 1396 | 	 *      the protocol design and runs IPX over 802.3 without an 802.2 LLC | 
 | 1397 | 	 *      layer. We look for FFFF which isn't a used 802.2 SSAP/DSAP. This | 
 | 1398 | 	 *      won't work for fault tolerant netware but does for the rest. | 
 | 1399 | 	 */ | 
 | 1400 | 	if (*(unsigned short *) rawp == 0xFFFF) | 
 | 1401 | 		return htons(ETH_P_802_3); | 
 | 1402 | 	/* | 
 | 1403 | 	 *      Real 802.2 LLC | 
 | 1404 | 	 */ | 
 | 1405 | 	return htons(ETH_P_802_2); | 
 | 1406 | } | 
 | 1407 |  | 
 | 1408 |  | 
 | 1409 | /*  | 
 | 1410 |  * CISCO HDLC keepalive specific stuff | 
 | 1411 |  */ | 
 | 1412 | static struct sk_buff* | 
 | 1413 | isdn_net_ciscohdlck_alloc_skb(isdn_net_local *lp, int len) | 
 | 1414 | { | 
 | 1415 | 	unsigned short hl = dev->drv[lp->isdn_device]->interface->hl_hdrlen; | 
 | 1416 | 	struct sk_buff *skb; | 
 | 1417 |  | 
 | 1418 | 	skb = alloc_skb(hl + len, GFP_ATOMIC); | 
 | 1419 | 	if (skb) | 
 | 1420 | 		skb_reserve(skb, hl); | 
 | 1421 | 	else  | 
 | 1422 | 		printk("isdn out of mem at %s:%d!\n", __FILE__, __LINE__); | 
 | 1423 | 	return skb; | 
 | 1424 | } | 
 | 1425 |  | 
 | 1426 | /* cisco hdlck device private ioctls */ | 
| Adrian Bunk | 3e206b0 | 2005-06-25 14:58:35 -0700 | [diff] [blame] | 1427 | static int | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1428 | isdn_ciscohdlck_dev_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) | 
 | 1429 | { | 
 | 1430 | 	isdn_net_local *lp = (isdn_net_local *) dev->priv; | 
 | 1431 | 	unsigned long len = 0; | 
 | 1432 | 	unsigned long expires = 0; | 
 | 1433 | 	int tmp = 0; | 
 | 1434 | 	int period = lp->cisco_keepalive_period; | 
 | 1435 | 	s8 debserint = lp->cisco_debserint; | 
 | 1436 | 	int rc = 0; | 
 | 1437 |  | 
 | 1438 | 	if (lp->p_encap != ISDN_NET_ENCAP_CISCOHDLCK) | 
 | 1439 | 		return -EINVAL; | 
 | 1440 |  | 
 | 1441 | 	switch (cmd) { | 
 | 1442 | 		/* get/set keepalive period */ | 
 | 1443 | 		case SIOCGKEEPPERIOD: | 
 | 1444 | 			len = (unsigned long)sizeof(lp->cisco_keepalive_period); | 
 | 1445 | 			if (copy_to_user(ifr->ifr_data, | 
 | 1446 | 				&lp->cisco_keepalive_period, len)) | 
 | 1447 | 				rc = -EFAULT; | 
 | 1448 | 			break; | 
 | 1449 | 		case SIOCSKEEPPERIOD: | 
 | 1450 | 			tmp = lp->cisco_keepalive_period; | 
 | 1451 | 			len = (unsigned long)sizeof(lp->cisco_keepalive_period); | 
 | 1452 | 			if (copy_from_user(&period, ifr->ifr_data, len)) | 
 | 1453 | 				rc = -EFAULT; | 
 | 1454 | 			if ((period > 0) && (period <= 32767)) | 
 | 1455 | 				lp->cisco_keepalive_period = period; | 
 | 1456 | 			else | 
 | 1457 | 				rc = -EINVAL; | 
 | 1458 | 			if (!rc && (tmp != lp->cisco_keepalive_period)) { | 
 | 1459 | 				expires = (unsigned long)(jiffies + | 
 | 1460 | 					lp->cisco_keepalive_period * HZ); | 
 | 1461 | 				mod_timer(&lp->cisco_timer, expires); | 
 | 1462 | 				printk(KERN_INFO "%s: Keepalive period set " | 
 | 1463 | 					"to %d seconds.\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1464 | 					dev->name, lp->cisco_keepalive_period); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1465 | 			} | 
 | 1466 | 			break; | 
 | 1467 |  | 
 | 1468 | 		/* get/set debugging */ | 
 | 1469 | 		case SIOCGDEBSERINT: | 
 | 1470 | 			len = (unsigned long)sizeof(lp->cisco_debserint); | 
 | 1471 | 			if (copy_to_user(ifr->ifr_data, | 
 | 1472 | 				&lp->cisco_debserint, len)) | 
 | 1473 | 				rc = -EFAULT; | 
 | 1474 | 			break; | 
 | 1475 | 		case SIOCSDEBSERINT: | 
 | 1476 | 			len = (unsigned long)sizeof(lp->cisco_debserint); | 
 | 1477 | 			if (copy_from_user(&debserint, | 
 | 1478 | 				ifr->ifr_data, len)) | 
 | 1479 | 				rc = -EFAULT; | 
 | 1480 | 			if ((debserint >= 0) && (debserint <= 64)) | 
 | 1481 | 				lp->cisco_debserint = debserint; | 
 | 1482 | 			else | 
 | 1483 | 				rc = -EINVAL; | 
 | 1484 | 			break; | 
 | 1485 |  | 
 | 1486 | 		default: | 
 | 1487 | 			rc = -EINVAL; | 
 | 1488 | 			break; | 
 | 1489 | 	} | 
 | 1490 | 	return (rc); | 
 | 1491 | } | 
 | 1492 |  | 
 | 1493 | /* called via cisco_timer.function */ | 
 | 1494 | static void | 
 | 1495 | isdn_net_ciscohdlck_slarp_send_keepalive(unsigned long data) | 
 | 1496 | { | 
 | 1497 | 	isdn_net_local *lp = (isdn_net_local *) data; | 
 | 1498 | 	struct sk_buff *skb; | 
 | 1499 | 	unsigned char *p; | 
 | 1500 | 	unsigned long last_cisco_myseq = lp->cisco_myseq; | 
 | 1501 | 	int myseq_diff = 0; | 
 | 1502 |  | 
 | 1503 | 	if (!(lp->flags & ISDN_NET_CONNECTED) || lp->dialstate) { | 
 | 1504 | 		printk("isdn BUG at %s:%d!\n", __FILE__, __LINE__); | 
 | 1505 | 		return; | 
 | 1506 | 	} | 
 | 1507 | 	lp->cisco_myseq++; | 
 | 1508 |  | 
 | 1509 | 	myseq_diff = (lp->cisco_myseq - lp->cisco_mineseen); | 
 | 1510 | 	if ((lp->cisco_line_state) && ((myseq_diff >= 3)||(myseq_diff <= -3))) { | 
 | 1511 | 		/* line up -> down */ | 
 | 1512 | 		lp->cisco_line_state = 0; | 
 | 1513 | 		printk (KERN_WARNING | 
 | 1514 | 				"UPDOWN: Line protocol on Interface %s," | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1515 | 				" changed state to down\n", lp->netdev->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1516 | 		/* should stop routing higher-level data accross */ | 
 | 1517 | 	} else if ((!lp->cisco_line_state) && | 
 | 1518 | 		(myseq_diff >= 0) && (myseq_diff <= 2)) { | 
 | 1519 | 		/* line down -> up */ | 
 | 1520 | 		lp->cisco_line_state = 1; | 
 | 1521 | 		printk (KERN_WARNING | 
 | 1522 | 				"UPDOWN: Line protocol on Interface %s," | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1523 | 				" changed state to up\n", lp->netdev->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1524 | 		/* restart routing higher-level data accross */ | 
 | 1525 | 	} | 
 | 1526 |  | 
 | 1527 | 	if (lp->cisco_debserint) | 
 | 1528 | 		printk (KERN_DEBUG "%s: HDLC " | 
 | 1529 | 			"myseq %lu, mineseen %lu%c, yourseen %lu, %s\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1530 | 			lp->netdev->dev->name, last_cisco_myseq, lp->cisco_mineseen, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1531 | 			((last_cisco_myseq == lp->cisco_mineseen) ? '*' : 040), | 
 | 1532 | 			lp->cisco_yourseq, | 
 | 1533 | 			((lp->cisco_line_state) ? "line up" : "line down")); | 
 | 1534 |  | 
 | 1535 | 	skb = isdn_net_ciscohdlck_alloc_skb(lp, 4 + 14); | 
 | 1536 | 	if (!skb) | 
 | 1537 | 		return; | 
 | 1538 |  | 
 | 1539 | 	p = skb_put(skb, 4 + 14); | 
 | 1540 |  | 
 | 1541 | 	/* cisco header */ | 
 | 1542 | 	p += put_u8 (p, CISCO_ADDR_UNICAST); | 
 | 1543 | 	p += put_u8 (p, CISCO_CTRL); | 
 | 1544 | 	p += put_u16(p, CISCO_TYPE_SLARP); | 
 | 1545 |  | 
 | 1546 | 	/* slarp keepalive */ | 
 | 1547 | 	p += put_u32(p, CISCO_SLARP_KEEPALIVE); | 
 | 1548 | 	p += put_u32(p, lp->cisco_myseq); | 
 | 1549 | 	p += put_u32(p, lp->cisco_yourseq); | 
 | 1550 | 	p += put_u16(p, 0xffff); // reliablity, always 0xffff | 
 | 1551 |  | 
 | 1552 | 	isdn_net_write_super(lp, skb); | 
 | 1553 |  | 
 | 1554 | 	lp->cisco_timer.expires = jiffies + lp->cisco_keepalive_period * HZ; | 
 | 1555 | 	 | 
 | 1556 | 	add_timer(&lp->cisco_timer); | 
 | 1557 | } | 
 | 1558 |  | 
 | 1559 | static void | 
 | 1560 | isdn_net_ciscohdlck_slarp_send_request(isdn_net_local *lp) | 
 | 1561 | { | 
 | 1562 | 	struct sk_buff *skb; | 
 | 1563 | 	unsigned char *p; | 
 | 1564 |  | 
 | 1565 | 	skb = isdn_net_ciscohdlck_alloc_skb(lp, 4 + 14); | 
 | 1566 | 	if (!skb) | 
 | 1567 | 		return; | 
 | 1568 |  | 
 | 1569 | 	p = skb_put(skb, 4 + 14); | 
 | 1570 |  | 
 | 1571 | 	/* cisco header */ | 
 | 1572 | 	p += put_u8 (p, CISCO_ADDR_UNICAST); | 
 | 1573 | 	p += put_u8 (p, CISCO_CTRL); | 
 | 1574 | 	p += put_u16(p, CISCO_TYPE_SLARP); | 
 | 1575 |  | 
 | 1576 | 	/* slarp request */ | 
 | 1577 | 	p += put_u32(p, CISCO_SLARP_REQUEST); | 
 | 1578 | 	p += put_u32(p, 0); // address | 
 | 1579 | 	p += put_u32(p, 0); // netmask | 
 | 1580 | 	p += put_u16(p, 0); // unused | 
 | 1581 |  | 
 | 1582 | 	isdn_net_write_super(lp, skb); | 
 | 1583 | } | 
 | 1584 |  | 
 | 1585 | static void  | 
 | 1586 | isdn_net_ciscohdlck_connected(isdn_net_local *lp) | 
 | 1587 | { | 
 | 1588 | 	lp->cisco_myseq = 0; | 
 | 1589 | 	lp->cisco_mineseen = 0; | 
 | 1590 | 	lp->cisco_yourseq = 0; | 
 | 1591 | 	lp->cisco_keepalive_period = ISDN_TIMER_KEEPINT; | 
 | 1592 | 	lp->cisco_last_slarp_in = 0; | 
 | 1593 | 	lp->cisco_line_state = 0; | 
 | 1594 | 	lp->cisco_debserint = 0; | 
 | 1595 |  | 
 | 1596 | 	/* send slarp request because interface/seq.no.s reset */ | 
 | 1597 | 	isdn_net_ciscohdlck_slarp_send_request(lp); | 
 | 1598 |  | 
 | 1599 | 	init_timer(&lp->cisco_timer); | 
 | 1600 | 	lp->cisco_timer.data = (unsigned long) lp; | 
 | 1601 | 	lp->cisco_timer.function = isdn_net_ciscohdlck_slarp_send_keepalive; | 
 | 1602 | 	lp->cisco_timer.expires = jiffies + lp->cisco_keepalive_period * HZ; | 
 | 1603 | 	add_timer(&lp->cisco_timer); | 
 | 1604 | } | 
 | 1605 |  | 
 | 1606 | static void  | 
 | 1607 | isdn_net_ciscohdlck_disconnected(isdn_net_local *lp) | 
 | 1608 | { | 
 | 1609 | 	del_timer(&lp->cisco_timer); | 
 | 1610 | } | 
 | 1611 |  | 
 | 1612 | static void | 
 | 1613 | isdn_net_ciscohdlck_slarp_send_reply(isdn_net_local *lp) | 
 | 1614 | { | 
 | 1615 | 	struct sk_buff *skb; | 
 | 1616 | 	unsigned char *p; | 
 | 1617 | 	struct in_device *in_dev = NULL; | 
| Al Viro | a144ea4 | 2006-09-28 18:00:55 -0700 | [diff] [blame] | 1618 | 	__be32 addr = 0;		/* local ipv4 address */ | 
 | 1619 | 	__be32 mask = 0;		/* local netmask */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1620 |  | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 1621 | 	if ((in_dev = lp->netdev->dev->ip_ptr) != NULL) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1622 | 		/* take primary(first) address of interface */ | 
 | 1623 | 		struct in_ifaddr *ifa = in_dev->ifa_list; | 
 | 1624 | 		if (ifa != NULL) { | 
 | 1625 | 			addr = ifa->ifa_local; | 
 | 1626 | 			mask = ifa->ifa_mask; | 
 | 1627 | 		} | 
 | 1628 | 	} | 
 | 1629 |  | 
 | 1630 | 	skb = isdn_net_ciscohdlck_alloc_skb(lp, 4 + 14); | 
 | 1631 | 	if (!skb) | 
 | 1632 | 		return; | 
 | 1633 |  | 
 | 1634 | 	p = skb_put(skb, 4 + 14); | 
 | 1635 |  | 
 | 1636 | 	/* cisco header */ | 
 | 1637 | 	p += put_u8 (p, CISCO_ADDR_UNICAST); | 
 | 1638 | 	p += put_u8 (p, CISCO_CTRL); | 
 | 1639 | 	p += put_u16(p, CISCO_TYPE_SLARP); | 
 | 1640 |  | 
 | 1641 | 	/* slarp reply, send own ip/netmask; if values are nonsense remote | 
 | 1642 | 	 * should think we are unable to provide it with an address via SLARP */ | 
 | 1643 | 	p += put_u32(p, CISCO_SLARP_REPLY); | 
 | 1644 | 	p += put_u32(p, addr);	// address | 
 | 1645 | 	p += put_u32(p, mask);	// netmask | 
 | 1646 | 	p += put_u16(p, 0);	// unused | 
 | 1647 |  | 
 | 1648 | 	isdn_net_write_super(lp, skb); | 
 | 1649 | } | 
 | 1650 |  | 
 | 1651 | static void | 
 | 1652 | isdn_net_ciscohdlck_slarp_in(isdn_net_local *lp, struct sk_buff *skb) | 
 | 1653 | { | 
 | 1654 | 	unsigned char *p; | 
 | 1655 | 	int period; | 
 | 1656 | 	u32 code; | 
 | 1657 | 	u32 my_seq, addr; | 
 | 1658 | 	u32 your_seq, mask; | 
 | 1659 | 	u32 local; | 
 | 1660 | 	u16 unused; | 
 | 1661 |  | 
 | 1662 | 	if (skb->len < 14) | 
 | 1663 | 		return; | 
 | 1664 |  | 
 | 1665 | 	p = skb->data; | 
 | 1666 | 	p += get_u32(p, &code); | 
 | 1667 | 	 | 
 | 1668 | 	switch (code) { | 
 | 1669 | 	case CISCO_SLARP_REQUEST: | 
 | 1670 | 		lp->cisco_yourseq = 0; | 
 | 1671 | 		isdn_net_ciscohdlck_slarp_send_reply(lp); | 
 | 1672 | 		break; | 
 | 1673 | 	case CISCO_SLARP_REPLY: | 
 | 1674 | 		addr = ntohl(*(u32 *)p); | 
 | 1675 | 		mask = ntohl(*(u32 *)(p+4)); | 
 | 1676 | 		if (mask != 0xfffffffc) | 
 | 1677 | 			goto slarp_reply_out; | 
 | 1678 | 		if ((addr & 3) == 0 || (addr & 3) == 3) | 
 | 1679 | 			goto slarp_reply_out; | 
 | 1680 | 		local = addr ^ 3; | 
 | 1681 | 		printk(KERN_INFO "%s: got slarp reply: " | 
 | 1682 | 			"remote ip: %d.%d.%d.%d, " | 
 | 1683 | 			"local ip: %d.%d.%d.%d " | 
 | 1684 | 			"mask: %d.%d.%d.%d\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1685 | 		       lp->netdev->dev->name, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1686 | 		       HIPQUAD(addr), | 
 | 1687 | 		       HIPQUAD(local), | 
 | 1688 | 		       HIPQUAD(mask)); | 
 | 1689 | 		break; | 
 | 1690 |   slarp_reply_out: | 
 | 1691 | 		 printk(KERN_INFO "%s: got invalid slarp " | 
 | 1692 | 				 "reply (%d.%d.%d.%d/%d.%d.%d.%d) " | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1693 | 				 "- ignored\n", lp->netdev->dev->name, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1694 | 				 HIPQUAD(addr), HIPQUAD(mask)); | 
 | 1695 | 		break; | 
 | 1696 | 	case CISCO_SLARP_KEEPALIVE: | 
 | 1697 | 		period = (int)((jiffies - lp->cisco_last_slarp_in | 
 | 1698 | 				+ HZ/2 - 1) / HZ); | 
 | 1699 | 		if (lp->cisco_debserint && | 
 | 1700 | 				(period != lp->cisco_keepalive_period) && | 
 | 1701 | 				lp->cisco_last_slarp_in) { | 
 | 1702 | 			printk(KERN_DEBUG "%s: Keepalive period mismatch - " | 
 | 1703 | 				"is %d but should be %d.\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1704 | 				lp->netdev->dev->name, period, | 
 | 1705 | 				lp->cisco_keepalive_period); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1706 | 		} | 
 | 1707 | 		lp->cisco_last_slarp_in = jiffies; | 
 | 1708 | 		p += get_u32(p, &my_seq); | 
 | 1709 | 		p += get_u32(p, &your_seq); | 
 | 1710 | 		p += get_u16(p, &unused); | 
 | 1711 | 		lp->cisco_yourseq = my_seq; | 
 | 1712 | 		lp->cisco_mineseen = your_seq; | 
 | 1713 | 		break; | 
 | 1714 | 	} | 
 | 1715 | } | 
 | 1716 |  | 
 | 1717 | static void | 
 | 1718 | isdn_net_ciscohdlck_receive(isdn_net_local *lp, struct sk_buff *skb) | 
 | 1719 | { | 
 | 1720 | 	unsigned char *p; | 
 | 1721 |  	u8 addr; | 
 | 1722 |  	u8 ctrl; | 
 | 1723 |  	u16 type; | 
 | 1724 | 	 | 
 | 1725 | 	if (skb->len < 4) | 
 | 1726 | 		goto out_free; | 
 | 1727 |  | 
 | 1728 | 	p = skb->data; | 
 | 1729 | 	p += get_u8 (p, &addr); | 
 | 1730 | 	p += get_u8 (p, &ctrl); | 
 | 1731 | 	p += get_u16(p, &type); | 
 | 1732 | 	skb_pull(skb, 4); | 
 | 1733 | 	 | 
 | 1734 | 	if (addr != CISCO_ADDR_UNICAST && addr != CISCO_ADDR_BROADCAST) { | 
 | 1735 | 		printk(KERN_WARNING "%s: Unknown Cisco addr 0x%02x\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1736 | 		       lp->netdev->dev->name, addr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1737 | 		goto out_free; | 
 | 1738 | 	} | 
 | 1739 | 	if (ctrl != CISCO_CTRL) { | 
 | 1740 | 		printk(KERN_WARNING "%s: Unknown Cisco ctrl 0x%02x\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1741 | 		       lp->netdev->dev->name, ctrl); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1742 | 		goto out_free; | 
 | 1743 | 	} | 
 | 1744 |  | 
 | 1745 | 	switch (type) { | 
 | 1746 | 	case CISCO_TYPE_SLARP: | 
 | 1747 | 		isdn_net_ciscohdlck_slarp_in(lp, skb); | 
 | 1748 | 		goto out_free; | 
 | 1749 | 	case CISCO_TYPE_CDP: | 
 | 1750 | 		if (lp->cisco_debserint) | 
 | 1751 | 			printk(KERN_DEBUG "%s: Received CDP packet. use " | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1752 | 				"\"no cdp enable\" on cisco.\n", | 
 | 1753 | 				lp->netdev->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1754 | 		goto out_free; | 
 | 1755 | 	default: | 
 | 1756 | 		/* no special cisco protocol */ | 
 | 1757 | 		skb->protocol = htons(type); | 
 | 1758 | 		netif_rx(skb); | 
 | 1759 | 		return; | 
 | 1760 | 	} | 
 | 1761 |  | 
 | 1762 |  out_free: | 
 | 1763 | 	kfree_skb(skb); | 
 | 1764 | } | 
 | 1765 |  | 
 | 1766 | /* | 
 | 1767 |  * Got a packet from ISDN-Channel. | 
 | 1768 |  */ | 
 | 1769 | static void | 
 | 1770 | isdn_net_receive(struct net_device *ndev, struct sk_buff *skb) | 
 | 1771 | { | 
 | 1772 | 	isdn_net_local *lp = (isdn_net_local *) ndev->priv; | 
 | 1773 | 	isdn_net_local *olp = lp;	/* original 'lp' */ | 
 | 1774 | #ifdef CONFIG_ISDN_X25 | 
 | 1775 | 	struct concap_proto *cprot = lp -> netdev -> cprot; | 
 | 1776 | #endif | 
 | 1777 | 	lp->transcount += skb->len; | 
 | 1778 |  | 
 | 1779 | 	lp->stats.rx_packets++; | 
 | 1780 | 	lp->stats.rx_bytes += skb->len; | 
 | 1781 | 	if (lp->master) { | 
 | 1782 | 		/* Bundling: If device is a slave-device, deliver to master, also | 
 | 1783 | 		 * handle master's statistics and hangup-timeout | 
 | 1784 | 		 */ | 
 | 1785 | 		ndev = lp->master; | 
 | 1786 | 		lp = (isdn_net_local *) ndev->priv; | 
 | 1787 | 		lp->stats.rx_packets++; | 
 | 1788 | 		lp->stats.rx_bytes += skb->len; | 
 | 1789 | 	} | 
 | 1790 | 	skb->dev = ndev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1791 | 	skb->pkt_type = PACKET_HOST; | 
| Arnaldo Carvalho de Melo | 459a98e | 2007-03-19 15:30:44 -0700 | [diff] [blame] | 1792 | 	skb_reset_mac_header(skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1793 | #ifdef ISDN_DEBUG_NET_DUMP | 
 | 1794 | 	isdn_dumppkt("R:", skb->data, skb->len, 40); | 
 | 1795 | #endif | 
 | 1796 | 	switch (lp->p_encap) { | 
 | 1797 | 		case ISDN_NET_ENCAP_ETHER: | 
 | 1798 | 			/* Ethernet over ISDN */ | 
 | 1799 | 			olp->huptimer = 0; | 
 | 1800 | 			lp->huptimer = 0; | 
 | 1801 | 			skb->protocol = isdn_net_type_trans(skb, ndev); | 
 | 1802 | 			break; | 
 | 1803 | 		case ISDN_NET_ENCAP_UIHDLC: | 
 | 1804 | 			/* HDLC with UI-frame (for ispa with -h1 option) */ | 
 | 1805 | 			olp->huptimer = 0; | 
 | 1806 | 			lp->huptimer = 0; | 
 | 1807 | 			skb_pull(skb, 2); | 
 | 1808 | 			/* Fall through */ | 
 | 1809 | 		case ISDN_NET_ENCAP_RAWIP: | 
 | 1810 | 			/* RAW-IP without MAC-Header */ | 
 | 1811 | 			olp->huptimer = 0; | 
 | 1812 | 			lp->huptimer = 0; | 
 | 1813 | 			skb->protocol = htons(ETH_P_IP); | 
 | 1814 | 			break; | 
 | 1815 | 		case ISDN_NET_ENCAP_CISCOHDLCK: | 
 | 1816 | 			isdn_net_ciscohdlck_receive(lp, skb); | 
 | 1817 | 			return; | 
 | 1818 | 		case ISDN_NET_ENCAP_CISCOHDLC: | 
 | 1819 | 			/* CISCO-HDLC IP with type field and  fake I-frame-header */ | 
 | 1820 | 			skb_pull(skb, 2); | 
 | 1821 | 			/* Fall through */ | 
 | 1822 | 		case ISDN_NET_ENCAP_IPTYP: | 
 | 1823 | 			/* IP with type field */ | 
 | 1824 | 			olp->huptimer = 0; | 
 | 1825 | 			lp->huptimer = 0; | 
 | 1826 | 			skb->protocol = *(unsigned short *) &(skb->data[0]); | 
 | 1827 | 			skb_pull(skb, 2); | 
 | 1828 | 			if (*(unsigned short *) skb->data == 0xFFFF) | 
 | 1829 | 				skb->protocol = htons(ETH_P_802_3); | 
 | 1830 | 			break; | 
 | 1831 | #ifdef CONFIG_ISDN_PPP | 
 | 1832 | 		case ISDN_NET_ENCAP_SYNCPPP: | 
 | 1833 | 			/* huptimer is done in isdn_ppp_push_higher */ | 
 | 1834 | 			isdn_ppp_receive(lp->netdev, olp, skb); | 
 | 1835 | 			return; | 
 | 1836 | #endif | 
 | 1837 |  | 
 | 1838 | 		default: | 
 | 1839 | #ifdef CONFIG_ISDN_X25 | 
 | 1840 | 		  /* try if there are generic sync_device receiver routines */ | 
 | 1841 | 			if(cprot) if(cprot -> pops) | 
 | 1842 | 				if( cprot -> pops -> data_ind){ | 
 | 1843 | 					cprot -> pops -> data_ind(cprot,skb); | 
 | 1844 | 					return; | 
 | 1845 | 				}; | 
 | 1846 | #endif /* CONFIG_ISDN_X25 */ | 
 | 1847 | 			printk(KERN_WARNING "%s: unknown encapsulation, dropping\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 1848 | 			       lp->netdev->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1849 | 			kfree_skb(skb); | 
 | 1850 | 			return; | 
 | 1851 | 	} | 
 | 1852 |  | 
 | 1853 | 	netif_rx(skb); | 
 | 1854 | 	return; | 
 | 1855 | } | 
 | 1856 |  | 
 | 1857 | /* | 
 | 1858 |  * A packet arrived via ISDN. Search interface-chain for a corresponding | 
 | 1859 |  * interface. If found, deliver packet to receiver-function and return 1, | 
 | 1860 |  * else return 0. | 
 | 1861 |  */ | 
 | 1862 | int | 
 | 1863 | isdn_net_rcv_skb(int idx, struct sk_buff *skb) | 
 | 1864 | { | 
 | 1865 | 	isdn_net_dev *p = dev->rx_netdev[idx]; | 
 | 1866 |  | 
 | 1867 | 	if (p) { | 
 | 1868 | 		isdn_net_local *lp = p->local; | 
 | 1869 | 		if ((lp->flags & ISDN_NET_CONNECTED) && | 
 | 1870 | 		    (!lp->dialstate)) { | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 1871 | 			isdn_net_receive(p->dev, skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1872 | 			return 1; | 
 | 1873 | 		} | 
 | 1874 | 	} | 
 | 1875 | 	return 0; | 
 | 1876 | } | 
 | 1877 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1878 | /* | 
 | 1879 |  *  build an header | 
 | 1880 |  *  depends on encaps that is being used. | 
 | 1881 |  */ | 
 | 1882 |  | 
| Stephen Hemminger | 3b04ddd | 2007-10-09 01:40:57 -0700 | [diff] [blame] | 1883 | static int isdn_net_header(struct sk_buff *skb, struct net_device *dev, | 
 | 1884 | 			   unsigned short type, | 
 | 1885 | 			   const void *daddr, const void *saddr, unsigned plen) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1886 | { | 
 | 1887 | 	isdn_net_local *lp = dev->priv; | 
 | 1888 | 	unsigned char *p; | 
 | 1889 | 	ushort len = 0; | 
 | 1890 |  | 
 | 1891 | 	switch (lp->p_encap) { | 
 | 1892 | 		case ISDN_NET_ENCAP_ETHER: | 
| Stephen Hemminger | 3b04ddd | 2007-10-09 01:40:57 -0700 | [diff] [blame] | 1893 | 			len = eth_header(skb, dev, type, daddr, saddr, plen); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1894 | 			break; | 
 | 1895 | #ifdef CONFIG_ISDN_PPP | 
 | 1896 | 		case ISDN_NET_ENCAP_SYNCPPP: | 
 | 1897 | 			/* stick on a fake header to keep fragmentation code happy. */ | 
 | 1898 | 			len = IPPP_MAX_HEADER; | 
 | 1899 | 			skb_push(skb,len); | 
 | 1900 | 			break; | 
 | 1901 | #endif | 
 | 1902 | 		case ISDN_NET_ENCAP_RAWIP: | 
 | 1903 | 			printk(KERN_WARNING "isdn_net_header called with RAW_IP!\n"); | 
 | 1904 | 			len = 0; | 
 | 1905 | 			break; | 
 | 1906 | 		case ISDN_NET_ENCAP_IPTYP: | 
 | 1907 | 			/* ethernet type field */ | 
 | 1908 | 			*((ushort *) skb_push(skb, 2)) = htons(type); | 
 | 1909 | 			len = 2; | 
 | 1910 | 			break; | 
 | 1911 | 		case ISDN_NET_ENCAP_UIHDLC: | 
 | 1912 | 			/* HDLC with UI-Frames (for ispa with -h1 option) */ | 
 | 1913 | 			*((ushort *) skb_push(skb, 2)) = htons(0x0103); | 
 | 1914 | 			len = 2; | 
 | 1915 | 			break; | 
 | 1916 | 		case ISDN_NET_ENCAP_CISCOHDLC: | 
 | 1917 | 		case ISDN_NET_ENCAP_CISCOHDLCK: | 
 | 1918 | 			p = skb_push(skb, 4); | 
 | 1919 | 			p += put_u8 (p, CISCO_ADDR_UNICAST); | 
 | 1920 | 			p += put_u8 (p, CISCO_CTRL); | 
 | 1921 | 			p += put_u16(p, type); | 
 | 1922 | 			len = 4; | 
 | 1923 | 			break; | 
 | 1924 | #ifdef CONFIG_ISDN_X25 | 
 | 1925 | 		default: | 
 | 1926 | 		  /* try if there are generic concap protocol routines */ | 
 | 1927 | 			if( lp-> netdev -> cprot ){ | 
 | 1928 | 				printk(KERN_WARNING "isdn_net_header called with concap_proto!\n"); | 
 | 1929 | 				len = 0; | 
 | 1930 | 				break; | 
 | 1931 | 			} | 
 | 1932 | 			break; | 
 | 1933 | #endif /* CONFIG_ISDN_X25 */ | 
 | 1934 | 	} | 
 | 1935 | 	return len; | 
 | 1936 | } | 
 | 1937 |  | 
 | 1938 | /* We don't need to send arp, because we have point-to-point connections. */ | 
 | 1939 | static int | 
 | 1940 | isdn_net_rebuild_header(struct sk_buff *skb) | 
 | 1941 | { | 
 | 1942 | 	struct net_device *dev = skb->dev; | 
 | 1943 | 	isdn_net_local *lp = dev->priv; | 
 | 1944 | 	int ret = 0; | 
 | 1945 |  | 
 | 1946 | 	if (lp->p_encap == ISDN_NET_ENCAP_ETHER) { | 
 | 1947 | 		struct ethhdr *eth = (struct ethhdr *) skb->data; | 
 | 1948 |  | 
 | 1949 | 		/* | 
 | 1950 | 		 *      Only ARP/IP is currently supported | 
 | 1951 | 		 */ | 
 | 1952 |  | 
 | 1953 | 		if (eth->h_proto != htons(ETH_P_IP)) { | 
 | 1954 | 			printk(KERN_WARNING | 
 | 1955 | 			       "isdn_net: %s don't know how to resolve type %d addresses?\n", | 
 | 1956 | 			       dev->name, (int) eth->h_proto); | 
 | 1957 | 			memcpy(eth->h_source, dev->dev_addr, dev->addr_len); | 
 | 1958 | 			return 0; | 
 | 1959 | 		} | 
 | 1960 | 		/* | 
 | 1961 | 		 *      Try to get ARP to resolve the header. | 
 | 1962 | 		 */ | 
 | 1963 | #ifdef CONFIG_INET | 
 | 1964 | 		ret = arp_find(eth->h_dest, skb); | 
 | 1965 | #endif | 
 | 1966 | 	} | 
 | 1967 | 	return ret; | 
 | 1968 | } | 
 | 1969 |  | 
| Stephen Hemminger | 3b04ddd | 2007-10-09 01:40:57 -0700 | [diff] [blame] | 1970 | static int isdn_header_cache(const struct neighbour *neigh, struct hh_cache *hh) | 
 | 1971 | { | 
 | 1972 | 	const struct net_device *dev = neigh->dev; | 
 | 1973 | 	isdn_net_local *lp = dev->priv; | 
 | 1974 |  | 
 | 1975 | 	if (lp->p_encap == ISDN_NET_ENCAP_ETHER) | 
 | 1976 | 		return eth_header_cache(neigh, hh); | 
 | 1977 | 	return -1; | 
 | 1978 | } | 
 | 1979 |  | 
 | 1980 | static void isdn_header_cache_update(struct hh_cache *hh, | 
 | 1981 | 				     const struct net_device *dev, | 
 | 1982 | 				     const unsigned char *haddr) | 
 | 1983 | { | 
 | 1984 | 	isdn_net_local *lp = dev->priv; | 
 | 1985 | 	if (lp->p_encap == ISDN_NET_ENCAP_ETHER) | 
 | 1986 | 		return eth_header_cache_update(hh, dev, haddr); | 
 | 1987 | } | 
 | 1988 |  | 
 | 1989 | static const struct header_ops isdn_header_ops = { | 
 | 1990 | 	.create = isdn_net_header, | 
 | 1991 | 	.rebuild = isdn_net_rebuild_header, | 
 | 1992 | 	.cache = isdn_header_cache, | 
 | 1993 | 	.cache_update = isdn_header_cache_update, | 
 | 1994 | }; | 
 | 1995 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1996 | /* | 
 | 1997 |  * Interface-setup. (just after registering a new interface) | 
 | 1998 |  */ | 
 | 1999 | static int | 
 | 2000 | isdn_net_init(struct net_device *ndev) | 
 | 2001 | { | 
 | 2002 | 	ushort max_hlhdr_len = 0; | 
| Stephen Hemminger | 3b04ddd | 2007-10-09 01:40:57 -0700 | [diff] [blame] | 2003 | 	int drvidx; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2004 |  | 
 | 2005 | 	ether_setup(ndev); | 
| Stephen Hemminger | 3b04ddd | 2007-10-09 01:40:57 -0700 | [diff] [blame] | 2006 | 	ndev->header_ops = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2007 |  | 
 | 2008 | 	/* Setup the generic properties */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2009 | 	ndev->mtu = 1500; | 
 | 2010 | 	ndev->flags = IFF_NOARP|IFF_POINTOPOINT; | 
 | 2011 | 	ndev->type = ARPHRD_ETHER; | 
 | 2012 | 	ndev->addr_len = ETH_ALEN; | 
| Paul Bolle | d2dcba6 | 2008-04-13 22:44:20 -0700 | [diff] [blame] | 2013 | 	ndev->validate_addr = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2014 |  | 
 | 2015 | 	/* for clients with MPPP maybe higher values better */ | 
 | 2016 | 	ndev->tx_queue_len = 30; | 
 | 2017 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2018 | 	/* The ISDN-specific entries in the device structure. */ | 
 | 2019 | 	ndev->open = &isdn_net_open; | 
 | 2020 | 	ndev->hard_start_xmit = &isdn_net_start_xmit; | 
 | 2021 |  | 
 | 2022 | 	/* | 
 | 2023 | 	 *  up till binding we ask the protocol layer to reserve as much | 
 | 2024 | 	 *  as we might need for HL layer | 
 | 2025 | 	 */ | 
 | 2026 |  | 
 | 2027 | 	for (drvidx = 0; drvidx < ISDN_MAX_DRIVERS; drvidx++) | 
 | 2028 | 		if (dev->drv[drvidx]) | 
 | 2029 | 			if (max_hlhdr_len < dev->drv[drvidx]->interface->hl_hdrlen) | 
 | 2030 | 				max_hlhdr_len = dev->drv[drvidx]->interface->hl_hdrlen; | 
 | 2031 |  | 
 | 2032 | 	ndev->hard_header_len = ETH_HLEN + max_hlhdr_len; | 
 | 2033 | 	ndev->stop = &isdn_net_close; | 
 | 2034 | 	ndev->get_stats = &isdn_net_get_stats; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2035 | 	ndev->do_ioctl = NULL; | 
 | 2036 | 	return 0; | 
 | 2037 | } | 
 | 2038 |  | 
 | 2039 | static void | 
 | 2040 | isdn_net_swapbind(int drvidx) | 
 | 2041 | { | 
 | 2042 | 	isdn_net_dev *p; | 
 | 2043 |  | 
 | 2044 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2045 | 	printk(KERN_DEBUG "n_fi: swapping ch of %d\n", drvidx); | 
 | 2046 | #endif | 
 | 2047 | 	p = dev->netdev; | 
 | 2048 | 	while (p) { | 
 | 2049 | 		if (p->local->pre_device == drvidx) | 
 | 2050 | 			switch (p->local->pre_channel) { | 
 | 2051 | 				case 0: | 
 | 2052 | 					p->local->pre_channel = 1; | 
 | 2053 | 					break; | 
 | 2054 | 				case 1: | 
 | 2055 | 					p->local->pre_channel = 0; | 
 | 2056 | 					break; | 
 | 2057 | 			} | 
 | 2058 | 		p = (isdn_net_dev *) p->next; | 
 | 2059 | 	} | 
 | 2060 | } | 
 | 2061 |  | 
 | 2062 | static void | 
 | 2063 | isdn_net_swap_usage(int i1, int i2) | 
 | 2064 | { | 
 | 2065 | 	int u1 = dev->usage[i1] & ISDN_USAGE_EXCLUSIVE; | 
 | 2066 | 	int u2 = dev->usage[i2] & ISDN_USAGE_EXCLUSIVE; | 
 | 2067 |  | 
 | 2068 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2069 | 	printk(KERN_DEBUG "n_fi: usage of %d and %d\n", i1, i2); | 
 | 2070 | #endif | 
 | 2071 | 	dev->usage[i1] &= ~ISDN_USAGE_EXCLUSIVE; | 
 | 2072 | 	dev->usage[i1] |= u2; | 
 | 2073 | 	dev->usage[i2] &= ~ISDN_USAGE_EXCLUSIVE; | 
 | 2074 | 	dev->usage[i2] |= u1; | 
 | 2075 | 	isdn_info_update(); | 
 | 2076 | } | 
 | 2077 |  | 
 | 2078 | /* | 
 | 2079 |  * An incoming call-request has arrived. | 
 | 2080 |  * Search the interface-chain for an appropriate interface. | 
 | 2081 |  * If found, connect the interface to the ISDN-channel and initiate | 
 | 2082 |  * D- and B-Channel-setup. If secure-flag is set, accept only | 
 | 2083 |  * configured phone-numbers. If callback-flag is set, initiate | 
 | 2084 |  * callback-dialing. | 
 | 2085 |  * | 
 | 2086 |  * Return-Value: 0 = No appropriate interface for this call. | 
 | 2087 |  *               1 = Call accepted | 
 | 2088 |  *               2 = Reject call, wait cbdelay, then call back | 
 | 2089 |  *               3 = Reject call | 
 | 2090 |  *               4 = Wait cbdelay, then call back | 
 | 2091 |  *               5 = No appropriate interface for this call, | 
 | 2092 |  *                   would eventually match if CID was longer. | 
 | 2093 |  */ | 
 | 2094 |  | 
 | 2095 | int | 
 | 2096 | isdn_net_find_icall(int di, int ch, int idx, setup_parm *setup) | 
 | 2097 | { | 
 | 2098 | 	char *eaz; | 
 | 2099 | 	int si1; | 
 | 2100 | 	int si2; | 
 | 2101 | 	int ematch; | 
 | 2102 | 	int wret; | 
 | 2103 | 	int swapped; | 
 | 2104 | 	int sidx = 0; | 
 | 2105 | 	u_long flags; | 
 | 2106 | 	isdn_net_dev *p; | 
 | 2107 | 	isdn_net_phone *n; | 
| Karsten Keil | 0f13864 | 2007-11-22 12:43:13 +0100 | [diff] [blame] | 2108 | 	char nr[ISDN_MSNLEN]; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2109 | 	char *my_eaz; | 
 | 2110 |  | 
 | 2111 | 	/* Search name in netdev-chain */ | 
 | 2112 | 	if (!setup->phone[0]) { | 
 | 2113 | 		nr[0] = '0'; | 
 | 2114 | 		nr[1] = '\0'; | 
 | 2115 | 		printk(KERN_INFO "isdn_net: Incoming call without OAD, assuming '0'\n"); | 
 | 2116 | 	} else | 
| Karsten Keil | 0f13864 | 2007-11-22 12:43:13 +0100 | [diff] [blame] | 2117 | 		strlcpy(nr, setup->phone, ISDN_MSNLEN); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2118 | 	si1 = (int) setup->si1; | 
 | 2119 | 	si2 = (int) setup->si2; | 
 | 2120 | 	if (!setup->eazmsn[0]) { | 
 | 2121 | 		printk(KERN_WARNING "isdn_net: Incoming call without CPN, assuming '0'\n"); | 
 | 2122 | 		eaz = "0"; | 
 | 2123 | 	} else | 
 | 2124 | 		eaz = setup->eazmsn; | 
 | 2125 | 	if (dev->net_verbose > 1) | 
 | 2126 | 		printk(KERN_INFO "isdn_net: call from %s,%d,%d -> %s\n", nr, si1, si2, eaz); | 
 | 2127 | 	/* Accept DATA and VOICE calls at this stage | 
 | 2128 | 	 * local eaz is checked later for allowed call types | 
 | 2129 | 	 */ | 
 | 2130 | 	if ((si1 != 7) && (si1 != 1)) { | 
 | 2131 | 		if (dev->net_verbose > 1) | 
 | 2132 | 			printk(KERN_INFO "isdn_net: Service-Indicator not 1 or 7, ignored\n"); | 
 | 2133 | 		return 0; | 
 | 2134 | 	} | 
 | 2135 | 	n = (isdn_net_phone *) 0; | 
 | 2136 | 	p = dev->netdev; | 
 | 2137 | 	ematch = wret = swapped = 0; | 
 | 2138 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2139 | 	printk(KERN_DEBUG "n_fi: di=%d ch=%d idx=%d usg=%d\n", di, ch, idx, | 
 | 2140 | 		dev->usage[idx]); | 
 | 2141 | #endif | 
 | 2142 | 	while (p) { | 
 | 2143 | 		int matchret; | 
 | 2144 | 		isdn_net_local *lp = p->local; | 
 | 2145 |  | 
 | 2146 | 		/* If last check has triggered as binding-swap, revert it */ | 
 | 2147 | 		switch (swapped) { | 
 | 2148 | 			case 2: | 
 | 2149 | 				isdn_net_swap_usage(idx, sidx); | 
 | 2150 | 				/* fall through */ | 
 | 2151 | 			case 1: | 
 | 2152 | 				isdn_net_swapbind(di); | 
 | 2153 | 				break; | 
 | 2154 | 		} | 
 | 2155 | 		swapped = 0; | 
 | 2156 |                 /* check acceptable call types for DOV */ | 
 | 2157 |                 my_eaz = isdn_map_eaz2msn(lp->msn, di); | 
 | 2158 |                 if (si1 == 1) { /* it's a DOV call, check if we allow it */ | 
 | 2159 |                         if (*my_eaz == 'v' || *my_eaz == 'V' || | 
 | 2160 | 			    *my_eaz == 'b' || *my_eaz == 'B') | 
 | 2161 |                                 my_eaz++; /* skip to allow a match */ | 
 | 2162 |                         else | 
 | 2163 |                                 my_eaz = NULL; /* force non match */ | 
 | 2164 |                 } else { /* it's a DATA call, check if we allow it */ | 
 | 2165 |                         if (*my_eaz == 'b' || *my_eaz == 'B') | 
 | 2166 |                                 my_eaz++; /* skip to allow a match */ | 
 | 2167 |                 } | 
 | 2168 |                 if (my_eaz) | 
 | 2169 |                         matchret = isdn_msncmp(eaz, my_eaz); | 
 | 2170 |                 else | 
 | 2171 |                         matchret = 1; | 
 | 2172 |                 if (!matchret) | 
 | 2173 |                         ematch = 1; | 
 | 2174 |  | 
 | 2175 | 		/* Remember if more numbers eventually can match */ | 
 | 2176 | 		if (matchret > wret) | 
 | 2177 | 			wret = matchret; | 
 | 2178 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2179 | 		printk(KERN_DEBUG "n_fi: if='%s', l.msn=%s, l.flags=%d, l.dstate=%d\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2180 | 		       p->dev->name, lp->msn, lp->flags, lp->dialstate); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2181 | #endif | 
 | 2182 | 		if ((!matchret) &&                                        /* EAZ is matching   */ | 
 | 2183 | 		    (((!(lp->flags & ISDN_NET_CONNECTED)) &&              /* but not connected */ | 
 | 2184 | 		      (USG_NONE(dev->usage[idx]))) ||                     /* and ch. unused or */ | 
 | 2185 | 		     ((((lp->dialstate == 4) || (lp->dialstate == 12)) && /* if dialing        */ | 
 | 2186 | 		       (!(lp->flags & ISDN_NET_CALLBACK)))                /* but no callback   */ | 
 | 2187 | 		     ))) | 
 | 2188 | 			 { | 
 | 2189 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2190 | 			printk(KERN_DEBUG "n_fi: match1, pdev=%d pch=%d\n", | 
 | 2191 | 			       lp->pre_device, lp->pre_channel); | 
 | 2192 | #endif | 
 | 2193 | 			if (dev->usage[idx] & ISDN_USAGE_EXCLUSIVE) { | 
 | 2194 | 				if ((lp->pre_channel != ch) || | 
 | 2195 | 				    (lp->pre_device != di)) { | 
 | 2196 | 					/* Here we got a problem: | 
 | 2197 | 					 * If using an ICN-Card, an incoming call is always signaled on | 
 | 2198 | 					 * on the first channel of the card, if both channels are | 
 | 2199 | 					 * down. However this channel may be bound exclusive. If the | 
 | 2200 | 					 * second channel is free, this call should be accepted. | 
 | 2201 | 					 * The solution is horribly but it runs, so what: | 
 | 2202 | 					 * We exchange the exclusive bindings of the two channels, the | 
 | 2203 | 					 * corresponding variables in the interface-structs. | 
 | 2204 | 					 */ | 
 | 2205 | 					if (ch == 0) { | 
 | 2206 | 						sidx = isdn_dc2minor(di, 1); | 
 | 2207 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2208 | 						printk(KERN_DEBUG "n_fi: ch is 0\n"); | 
 | 2209 | #endif | 
 | 2210 | 						if (USG_NONE(dev->usage[sidx])) { | 
 | 2211 | 							/* Second Channel is free, now see if it is bound | 
 | 2212 | 							 * exclusive too. */ | 
 | 2213 | 							if (dev->usage[sidx] & ISDN_USAGE_EXCLUSIVE) { | 
 | 2214 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2215 | 								printk(KERN_DEBUG "n_fi: 2nd channel is down and bound\n"); | 
 | 2216 | #endif | 
 | 2217 | 								/* Yes, swap bindings only, if the original | 
 | 2218 | 								 * binding is bound to channel 1 of this driver */ | 
 | 2219 | 								if ((lp->pre_device == di) && | 
 | 2220 | 								    (lp->pre_channel == 1)) { | 
 | 2221 | 									isdn_net_swapbind(di); | 
 | 2222 | 									swapped = 1; | 
 | 2223 | 								} else { | 
 | 2224 | 									/* ... else iterate next device */ | 
 | 2225 | 									p = (isdn_net_dev *) p->next; | 
 | 2226 | 									continue; | 
 | 2227 | 								} | 
 | 2228 | 							} else { | 
 | 2229 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2230 | 								printk(KERN_DEBUG "n_fi: 2nd channel is down and unbound\n"); | 
 | 2231 | #endif | 
 | 2232 | 								/* No, swap always and swap excl-usage also */ | 
 | 2233 | 								isdn_net_swap_usage(idx, sidx); | 
 | 2234 | 								isdn_net_swapbind(di); | 
 | 2235 | 								swapped = 2; | 
 | 2236 | 							} | 
 | 2237 | 							/* Now check for exclusive binding again */ | 
 | 2238 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2239 | 							printk(KERN_DEBUG "n_fi: final check\n"); | 
 | 2240 | #endif | 
 | 2241 | 							if ((dev->usage[idx] & ISDN_USAGE_EXCLUSIVE) && | 
 | 2242 | 							    ((lp->pre_channel != ch) || | 
 | 2243 | 							     (lp->pre_device != di))) { | 
 | 2244 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2245 | 								printk(KERN_DEBUG "n_fi: final check failed\n"); | 
 | 2246 | #endif | 
 | 2247 | 								p = (isdn_net_dev *) p->next; | 
 | 2248 | 								continue; | 
 | 2249 | 							} | 
 | 2250 | 						} | 
 | 2251 | 					} else { | 
 | 2252 | 						/* We are already on the second channel, so nothing to do */ | 
 | 2253 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2254 | 						printk(KERN_DEBUG "n_fi: already on 2nd channel\n"); | 
 | 2255 | #endif | 
 | 2256 | 					} | 
 | 2257 | 				} | 
 | 2258 | 			} | 
 | 2259 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2260 | 			printk(KERN_DEBUG "n_fi: match2\n"); | 
 | 2261 | #endif | 
 | 2262 | 			n = lp->phone[0]; | 
 | 2263 | 			if (lp->flags & ISDN_NET_SECURE) { | 
 | 2264 | 				while (n) { | 
 | 2265 | 					if (!isdn_msncmp(nr, n->num)) | 
 | 2266 | 						break; | 
 | 2267 | 					n = (isdn_net_phone *) n->next; | 
 | 2268 | 				} | 
 | 2269 | 			} | 
 | 2270 | 			if (n || (!(lp->flags & ISDN_NET_SECURE))) { | 
 | 2271 | #ifdef ISDN_DEBUG_NET_ICALL | 
 | 2272 | 				printk(KERN_DEBUG "n_fi: match3\n"); | 
 | 2273 | #endif | 
 | 2274 | 				/* matching interface found */ | 
 | 2275 |  | 
 | 2276 | 				/* | 
 | 2277 | 				 * Is the state STOPPED? | 
 | 2278 | 				 * If so, no dialin is allowed, | 
 | 2279 | 				 * so reject actively. | 
 | 2280 | 				 * */ | 
 | 2281 | 				if (ISDN_NET_DIALMODE(*lp) == ISDN_NET_DM_OFF) { | 
 | 2282 | 					printk(KERN_INFO "incoming call, interface %s `stopped' -> rejected\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2283 | 					       p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2284 | 					return 3; | 
 | 2285 | 				} | 
 | 2286 | 				/* | 
 | 2287 | 				 * Is the interface up? | 
 | 2288 | 				 * If not, reject the call actively. | 
 | 2289 | 				 */ | 
 | 2290 | 				if (!isdn_net_device_started(p)) { | 
 | 2291 | 					printk(KERN_INFO "%s: incoming call, interface down -> rejected\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2292 | 					       p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2293 | 					return 3; | 
 | 2294 | 				} | 
 | 2295 | 				/* Interface is up, now see if it's a slave. If so, see if | 
 | 2296 | 				 * it's master and parent slave is online. If not, reject the call. | 
 | 2297 | 				 */ | 
 | 2298 | 				if (lp->master) { | 
 | 2299 | 					isdn_net_local *mlp = (isdn_net_local *) lp->master->priv; | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2300 | 					printk(KERN_DEBUG "ICALLslv: %s\n", p->dev->name); | 
 | 2301 | 					printk(KERN_DEBUG "master=%s\n", lp->master->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2302 | 					if (mlp->flags & ISDN_NET_CONNECTED) { | 
 | 2303 | 						printk(KERN_DEBUG "master online\n"); | 
 | 2304 | 						/* Master is online, find parent-slave (master if first slave) */ | 
 | 2305 | 						while (mlp->slave) { | 
 | 2306 | 							if ((isdn_net_local *) mlp->slave->priv == lp) | 
 | 2307 | 								break; | 
 | 2308 | 							mlp = (isdn_net_local *) mlp->slave->priv; | 
 | 2309 | 						} | 
 | 2310 | 					} else | 
 | 2311 | 						printk(KERN_DEBUG "master offline\n"); | 
 | 2312 | 					/* Found parent, if it's offline iterate next device */ | 
 | 2313 | 					printk(KERN_DEBUG "mlpf: %d\n", mlp->flags & ISDN_NET_CONNECTED); | 
 | 2314 | 					if (!(mlp->flags & ISDN_NET_CONNECTED)) { | 
 | 2315 | 						p = (isdn_net_dev *) p->next; | 
 | 2316 | 						continue; | 
 | 2317 | 					} | 
 | 2318 | 				}  | 
 | 2319 | 				if (lp->flags & ISDN_NET_CALLBACK) { | 
 | 2320 | 					int chi; | 
 | 2321 | 					/* | 
 | 2322 | 					 * Is the state MANUAL? | 
 | 2323 | 					 * If so, no callback can be made, | 
 | 2324 | 					 * so reject actively. | 
 | 2325 | 					 * */ | 
 | 2326 | 					if (ISDN_NET_DIALMODE(*lp) == ISDN_NET_DM_OFF) { | 
 | 2327 | 						printk(KERN_INFO "incoming call for callback, interface %s `off' -> rejected\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2328 | 						       p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2329 | 						return 3; | 
 | 2330 | 					} | 
 | 2331 | 					printk(KERN_DEBUG "%s: call from %s -> %s, start callback\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2332 | 					       p->dev->name, nr, eaz); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2333 | 					if (lp->phone[1]) { | 
 | 2334 | 						/* Grab a free ISDN-Channel */ | 
 | 2335 | 						spin_lock_irqsave(&dev->lock, flags); | 
 | 2336 | 						if ((chi =  | 
 | 2337 | 							isdn_get_free_channel( | 
 | 2338 | 								ISDN_USAGE_NET, | 
 | 2339 | 								lp->l2_proto, | 
 | 2340 | 								lp->l3_proto, | 
 | 2341 | 							  	lp->pre_device, | 
 | 2342 | 						 		lp->pre_channel, | 
 | 2343 | 						 		lp->msn) | 
 | 2344 | 								) < 0) { | 
 | 2345 |  | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2346 | 							printk(KERN_WARNING "isdn_net_find_icall: No channel for %s\n", | 
 | 2347 | 								p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2348 | 							spin_unlock_irqrestore(&dev->lock, flags); | 
 | 2349 | 							return 0; | 
 | 2350 | 						} | 
 | 2351 | 						/* Setup dialstate. */ | 
 | 2352 | 						lp->dtimer = 0; | 
 | 2353 | 						lp->dialstate = 11; | 
 | 2354 | 						/* Connect interface with channel */ | 
 | 2355 | 						isdn_net_bind_channel(lp, chi); | 
 | 2356 | #ifdef CONFIG_ISDN_PPP | 
 | 2357 | 						if (lp->p_encap == ISDN_NET_ENCAP_SYNCPPP) | 
 | 2358 | 							if (isdn_ppp_bind(lp) < 0) { | 
 | 2359 | 								spin_unlock_irqrestore(&dev->lock, flags); | 
 | 2360 | 								isdn_net_unbind_channel(lp); | 
 | 2361 | 								return 0; | 
 | 2362 | 							} | 
 | 2363 | #endif | 
 | 2364 | 						spin_unlock_irqrestore(&dev->lock, flags); | 
 | 2365 | 						/* Initiate dialing by returning 2 or 4 */ | 
 | 2366 | 						return (lp->flags & ISDN_NET_CBHUP) ? 2 : 4; | 
 | 2367 | 					} else | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2368 | 						printk(KERN_WARNING "isdn_net: %s: No phone number\n", | 
 | 2369 | 							p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2370 | 					return 0; | 
 | 2371 | 				} else { | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2372 | 					printk(KERN_DEBUG "%s: call from %s -> %s accepted\n", | 
 | 2373 | 						p->dev->name, nr, eaz); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2374 | 					/* if this interface is dialing, it does it probably on a different | 
 | 2375 | 					   device, so free this device */ | 
 | 2376 | 					if ((lp->dialstate == 4) || (lp->dialstate == 12)) { | 
 | 2377 | #ifdef CONFIG_ISDN_PPP | 
 | 2378 | 						if (lp->p_encap == ISDN_NET_ENCAP_SYNCPPP) | 
 | 2379 | 							isdn_ppp_free(lp); | 
 | 2380 | #endif | 
 | 2381 | 						isdn_net_lp_disconnected(lp); | 
 | 2382 | 						isdn_free_channel(lp->isdn_device, lp->isdn_channel, | 
 | 2383 | 							 ISDN_USAGE_NET); | 
 | 2384 | 					} | 
 | 2385 | 					spin_lock_irqsave(&dev->lock, flags); | 
 | 2386 | 					dev->usage[idx] &= ISDN_USAGE_EXCLUSIVE; | 
 | 2387 | 					dev->usage[idx] |= ISDN_USAGE_NET; | 
 | 2388 | 					strcpy(dev->num[idx], nr); | 
 | 2389 | 					isdn_info_update(); | 
 | 2390 | 					dev->st_netdev[idx] = lp->netdev; | 
 | 2391 | 					lp->isdn_device = di; | 
 | 2392 | 					lp->isdn_channel = ch; | 
 | 2393 | 					lp->ppp_slot = -1; | 
 | 2394 | 					lp->flags |= ISDN_NET_CONNECTED; | 
 | 2395 | 					lp->dialstate = 7; | 
 | 2396 | 					lp->dtimer = 0; | 
 | 2397 | 					lp->outgoing = 0; | 
 | 2398 | 					lp->huptimer = 0; | 
 | 2399 | 					lp->hupflags |= ISDN_WAITCHARGE; | 
 | 2400 | 					lp->hupflags &= ~ISDN_HAVECHARGE; | 
 | 2401 | #ifdef CONFIG_ISDN_PPP | 
 | 2402 | 					if (lp->p_encap == ISDN_NET_ENCAP_SYNCPPP) { | 
 | 2403 | 						if (isdn_ppp_bind(lp) < 0) { | 
 | 2404 | 							isdn_net_unbind_channel(lp); | 
 | 2405 | 							spin_unlock_irqrestore(&dev->lock, flags); | 
 | 2406 | 							return 0; | 
 | 2407 | 						} | 
 | 2408 | 					} | 
 | 2409 | #endif | 
 | 2410 | 					spin_unlock_irqrestore(&dev->lock, flags); | 
 | 2411 | 					return 1; | 
 | 2412 | 				} | 
 | 2413 | 			} | 
 | 2414 | 		} | 
 | 2415 | 		p = (isdn_net_dev *) p->next; | 
 | 2416 | 	} | 
 | 2417 | 	/* If none of configured EAZ/MSN matched and not verbose, be silent */ | 
 | 2418 | 	if (!ematch || dev->net_verbose) | 
 | 2419 | 		printk(KERN_INFO "isdn_net: call from %s -> %d %s ignored\n", nr, di, eaz); | 
 | 2420 | 	return (wret == 2)?5:0; | 
 | 2421 | } | 
 | 2422 |  | 
 | 2423 | /* | 
 | 2424 |  * Search list of net-interfaces for an interface with given name. | 
 | 2425 |  */ | 
 | 2426 | isdn_net_dev * | 
 | 2427 | isdn_net_findif(char *name) | 
 | 2428 | { | 
 | 2429 | 	isdn_net_dev *p = dev->netdev; | 
 | 2430 |  | 
 | 2431 | 	while (p) { | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2432 | 		if (!strcmp(p->dev->name, name)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2433 | 			return p; | 
 | 2434 | 		p = (isdn_net_dev *) p->next; | 
 | 2435 | 	} | 
 | 2436 | 	return (isdn_net_dev *) NULL; | 
 | 2437 | } | 
 | 2438 |  | 
 | 2439 | /* | 
 | 2440 |  * Force a net-interface to dial out. | 
 | 2441 |  * This is called from the userlevel-routine below or | 
 | 2442 |  * from isdn_net_start_xmit(). | 
 | 2443 |  */ | 
| Adrian Bunk | 3e206b0 | 2005-06-25 14:58:35 -0700 | [diff] [blame] | 2444 | static int | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2445 | isdn_net_force_dial_lp(isdn_net_local * lp) | 
 | 2446 | { | 
 | 2447 | 	if ((!(lp->flags & ISDN_NET_CONNECTED)) && !lp->dialstate) { | 
 | 2448 | 		int chi; | 
 | 2449 | 		if (lp->phone[1]) { | 
 | 2450 | 			ulong flags; | 
 | 2451 |  | 
 | 2452 | 			/* Grab a free ISDN-Channel */ | 
 | 2453 | 			spin_lock_irqsave(&dev->lock, flags); | 
 | 2454 | 			if ((chi = isdn_get_free_channel( | 
 | 2455 | 					ISDN_USAGE_NET, | 
 | 2456 | 					lp->l2_proto, | 
 | 2457 | 					lp->l3_proto, | 
 | 2458 | 					lp->pre_device, | 
 | 2459 | 					lp->pre_channel, | 
 | 2460 | 					lp->msn)) < 0) { | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2461 | 				printk(KERN_WARNING "isdn_net_force_dial: No channel for %s\n", | 
 | 2462 | 					lp->netdev->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2463 | 				spin_unlock_irqrestore(&dev->lock, flags); | 
 | 2464 | 				return -EAGAIN; | 
 | 2465 | 			} | 
 | 2466 | 			lp->dialstate = 1; | 
 | 2467 | 			/* Connect interface with channel */ | 
 | 2468 | 			isdn_net_bind_channel(lp, chi); | 
 | 2469 | #ifdef CONFIG_ISDN_PPP | 
 | 2470 | 			if (lp->p_encap == ISDN_NET_ENCAP_SYNCPPP) | 
 | 2471 | 				if (isdn_ppp_bind(lp) < 0) { | 
 | 2472 | 					isdn_net_unbind_channel(lp); | 
 | 2473 | 					spin_unlock_irqrestore(&dev->lock, flags); | 
 | 2474 | 					return -EAGAIN; | 
 | 2475 | 				} | 
 | 2476 | #endif | 
 | 2477 | 			/* Initiate dialing */ | 
 | 2478 | 			spin_unlock_irqrestore(&dev->lock, flags); | 
 | 2479 | 			isdn_net_dial(); | 
 | 2480 | 			return 0; | 
 | 2481 | 		} else | 
 | 2482 | 			return -EINVAL; | 
 | 2483 | 	} else | 
 | 2484 | 		return -EBUSY; | 
 | 2485 | } | 
 | 2486 |  | 
 | 2487 | /* | 
 | 2488 |  * This is called from certain upper protocol layers (multilink ppp | 
 | 2489 |  * and x25iface encapsulation module) that want to initiate dialing | 
 | 2490 |  * themselves. | 
 | 2491 |  */ | 
 | 2492 | int | 
 | 2493 | isdn_net_dial_req(isdn_net_local * lp) | 
 | 2494 | { | 
 | 2495 | 	/* is there a better error code? */ | 
 | 2496 | 	if (!(ISDN_NET_DIALMODE(*lp) == ISDN_NET_DM_AUTO)) return -EBUSY; | 
 | 2497 |  | 
 | 2498 | 	return isdn_net_force_dial_lp(lp); | 
 | 2499 | } | 
 | 2500 |  | 
 | 2501 | /* | 
 | 2502 |  * Force a net-interface to dial out. | 
 | 2503 |  * This is always called from within userspace (ISDN_IOCTL_NET_DIAL). | 
 | 2504 |  */ | 
 | 2505 | int | 
 | 2506 | isdn_net_force_dial(char *name) | 
 | 2507 | { | 
 | 2508 | 	isdn_net_dev *p = isdn_net_findif(name); | 
 | 2509 |  | 
 | 2510 | 	if (!p) | 
 | 2511 | 		return -ENODEV; | 
 | 2512 | 	return (isdn_net_force_dial_lp(p->local)); | 
 | 2513 | } | 
 | 2514 |  | 
 | 2515 | /* | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2516 |  * Helper for alloc_netdev() | 
 | 2517 |  */ | 
 | 2518 | static void _isdn_setup(struct net_device *dev) | 
 | 2519 | { | 
 | 2520 | 	isdn_net_local *lp = dev->priv; | 
 | 2521 |  | 
 | 2522 | 	dev->flags = IFF_NOARP | IFF_POINTOPOINT; | 
 | 2523 | 	lp->p_encap = ISDN_NET_ENCAP_RAWIP; | 
 | 2524 | 	lp->magic = ISDN_NET_MAGIC; | 
 | 2525 | 	lp->last = lp; | 
 | 2526 | 	lp->next = lp; | 
 | 2527 | 	lp->isdn_device = -1; | 
 | 2528 | 	lp->isdn_channel = -1; | 
 | 2529 | 	lp->pre_device = -1; | 
 | 2530 | 	lp->pre_channel = -1; | 
 | 2531 | 	lp->exclusive = -1; | 
 | 2532 | 	lp->ppp_slot = -1; | 
 | 2533 | 	lp->pppbind = -1; | 
 | 2534 | 	skb_queue_head_init(&lp->super_tx_queue); | 
 | 2535 | 	lp->l2_proto = ISDN_PROTO_L2_X75I; | 
 | 2536 | 	lp->l3_proto = ISDN_PROTO_L3_TRANS; | 
 | 2537 | 	lp->triggercps = 6000; | 
 | 2538 | 	lp->slavedelay = 10 * HZ; | 
 | 2539 | 	lp->hupflags = ISDN_INHUP;	/* Do hangup even on incoming calls */ | 
 | 2540 | 	lp->onhtime = 10;	/* Default hangup-time for saving costs */ | 
 | 2541 | 	lp->dialmax = 1; | 
 | 2542 | 	/* Hangup before Callback, manual dial */ | 
 | 2543 | 	lp->flags = ISDN_NET_CBHUP | ISDN_NET_DM_MANUAL; | 
 | 2544 | 	lp->cbdelay = 25;	/* Wait 5 secs before Callback */ | 
 | 2545 | 	lp->dialtimeout = -1;  /* Infinite Dial-Timeout */ | 
 | 2546 | 	lp->dialwait = 5 * HZ; /* Wait 5 sec. after failed dial */ | 
 | 2547 | 	lp->dialstarted = 0;   /* Jiffies of last dial-start */ | 
 | 2548 | 	lp->dialwait_timer = 0;  /* Jiffies of earliest next dial-start */ | 
 | 2549 | } | 
 | 2550 |  | 
 | 2551 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2552 |  * Allocate a new network-interface and initialize its data structures. | 
 | 2553 |  */ | 
 | 2554 | char * | 
 | 2555 | isdn_net_new(char *name, struct net_device *master) | 
 | 2556 | { | 
 | 2557 | 	isdn_net_dev *netdev; | 
 | 2558 |  | 
 | 2559 | 	/* Avoid creating an existing interface */ | 
 | 2560 | 	if (isdn_net_findif(name)) { | 
 | 2561 | 		printk(KERN_WARNING "isdn_net: interface %s already exists\n", name); | 
 | 2562 | 		return NULL; | 
 | 2563 | 	} | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2564 | 	if (name == NULL) | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2565 | 		return NULL; | 
| Burman Yan | 41f9693 | 2006-12-08 02:39:35 -0800 | [diff] [blame] | 2566 | 	if (!(netdev = kzalloc(sizeof(isdn_net_dev), GFP_KERNEL))) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2567 | 		printk(KERN_WARNING "isdn_net: Could not allocate net-device\n"); | 
 | 2568 | 		return NULL; | 
 | 2569 | 	} | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2570 | 	netdev->dev = alloc_netdev(sizeof(isdn_net_local), name, _isdn_setup); | 
 | 2571 | 	if (!netdev->dev) { | 
 | 2572 | 		printk(KERN_WARNING "isdn_net: Could not allocate network device\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2573 | 		kfree(netdev); | 
 | 2574 | 		return NULL; | 
 | 2575 | 	} | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2576 | 	netdev->local = netdev->dev->priv; | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2577 | 	netdev->dev->init = isdn_net_init; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2578 | 	if (master) { | 
 | 2579 | 		/* Device shall be a slave */ | 
 | 2580 | 		struct net_device *p = (((isdn_net_local *) master->priv)->slave); | 
 | 2581 | 		struct net_device *q = master; | 
 | 2582 |  | 
 | 2583 | 		netdev->local->master = master; | 
 | 2584 | 		/* Put device at end of slave-chain */ | 
 | 2585 | 		while (p) { | 
 | 2586 | 			q = p; | 
 | 2587 | 			p = (((isdn_net_local *) p->priv)->slave); | 
 | 2588 | 		} | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2589 | 		((isdn_net_local *) q->priv)->slave = netdev->dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2590 | 	} else { | 
 | 2591 | 		/* Device shall be a master */ | 
 | 2592 | 		/* | 
 | 2593 | 		 * Watchdog timer (currently) for master only. | 
 | 2594 | 		 */ | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2595 | 		netdev->dev->tx_timeout = isdn_net_tx_timeout; | 
 | 2596 | 		netdev->dev->watchdog_timeo = ISDN_NET_TX_TIMEOUT; | 
 | 2597 | 		if (register_netdev(netdev->dev) != 0) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2598 | 			printk(KERN_WARNING "isdn_net: Could not register net-device\n"); | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2599 | 			free_netdev(netdev->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2600 | 			kfree(netdev); | 
 | 2601 | 			return NULL; | 
 | 2602 | 		} | 
 | 2603 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2604 | 	netdev->queue = netdev->local; | 
 | 2605 | 	spin_lock_init(&netdev->queue_lock); | 
 | 2606 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2607 | 	netdev->local->netdev = netdev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2608 |  | 
| David Howells | c402895 | 2006-11-22 14:57:56 +0000 | [diff] [blame] | 2609 | 	INIT_WORK(&netdev->local->tqueue, isdn_net_softint); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2610 | 	spin_lock_init(&netdev->local->xmit_lock); | 
 | 2611 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2612 | 	/* Put into to netdev-chain */ | 
 | 2613 | 	netdev->next = (void *) dev->netdev; | 
 | 2614 | 	dev->netdev = netdev; | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2615 | 	return netdev->dev->name; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2616 | } | 
 | 2617 |  | 
 | 2618 | char * | 
 | 2619 | isdn_net_newslave(char *parm) | 
 | 2620 | { | 
 | 2621 | 	char *p = strchr(parm, ','); | 
 | 2622 | 	isdn_net_dev *n; | 
 | 2623 | 	char newname[10]; | 
 | 2624 |  | 
 | 2625 | 	if (p) { | 
 | 2626 | 		/* Slave-Name MUST not be empty */ | 
 | 2627 | 		if (!strlen(p + 1)) | 
 | 2628 | 			return NULL; | 
 | 2629 | 		strcpy(newname, p + 1); | 
 | 2630 | 		*p = 0; | 
 | 2631 | 		/* Master must already exist */ | 
 | 2632 | 		if (!(n = isdn_net_findif(parm))) | 
 | 2633 | 			return NULL; | 
 | 2634 | 		/* Master must be a real interface, not a slave */ | 
 | 2635 | 		if (n->local->master) | 
 | 2636 | 			return NULL; | 
 | 2637 | 		/* Master must not be started yet */ | 
 | 2638 | 		if (isdn_net_device_started(n))  | 
 | 2639 | 			return NULL; | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2640 | 		return (isdn_net_new(newname, n->dev)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2641 | 	} | 
 | 2642 | 	return NULL; | 
 | 2643 | } | 
 | 2644 |  | 
 | 2645 | /* | 
 | 2646 |  * Set interface-parameters. | 
 | 2647 |  * Always set all parameters, so the user-level application is responsible | 
 | 2648 |  * for not overwriting existing setups. It has to get the current | 
 | 2649 |  * setup first, if only selected parameters are to be changed. | 
 | 2650 |  */ | 
 | 2651 | int | 
 | 2652 | isdn_net_setcfg(isdn_net_ioctl_cfg * cfg) | 
 | 2653 | { | 
 | 2654 | 	isdn_net_dev *p = isdn_net_findif(cfg->name); | 
 | 2655 | 	ulong features; | 
 | 2656 | 	int i; | 
 | 2657 | 	int drvidx; | 
 | 2658 | 	int chidx; | 
 | 2659 | 	char drvid[25]; | 
 | 2660 |  | 
 | 2661 | 	if (p) { | 
 | 2662 | 		isdn_net_local *lp = p->local; | 
 | 2663 |  | 
 | 2664 | 		/* See if any registered driver supports the features we want */ | 
 | 2665 | 		features = ((1 << cfg->l2_proto) << ISDN_FEATURE_L2_SHIFT) | | 
 | 2666 | 			((1 << cfg->l3_proto) << ISDN_FEATURE_L3_SHIFT); | 
 | 2667 | 		for (i = 0; i < ISDN_MAX_DRIVERS; i++) | 
 | 2668 | 			if (dev->drv[i]) | 
 | 2669 | 				if ((dev->drv[i]->interface->features & features) == features) | 
 | 2670 | 					break; | 
 | 2671 | 		if (i == ISDN_MAX_DRIVERS) { | 
 | 2672 | 			printk(KERN_WARNING "isdn_net: No driver with selected features\n"); | 
 | 2673 | 			return -ENODEV; | 
 | 2674 | 		} | 
 | 2675 | 		if (lp->p_encap != cfg->p_encap){ | 
 | 2676 | #ifdef CONFIG_ISDN_X25 | 
 | 2677 | 			struct concap_proto * cprot = p -> cprot; | 
 | 2678 | #endif | 
 | 2679 | 			if (isdn_net_device_started(p)) { | 
 | 2680 | 				printk(KERN_WARNING "%s: cannot change encap when if is up\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2681 | 				       p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2682 | 				return -EBUSY; | 
 | 2683 | 			} | 
 | 2684 | #ifdef CONFIG_ISDN_X25 | 
 | 2685 | 			if( cprot && cprot -> pops ) | 
 | 2686 | 				cprot -> pops -> proto_del ( cprot ); | 
 | 2687 | 			p -> cprot = NULL; | 
 | 2688 | 			lp -> dops = NULL; | 
 | 2689 | 			/* ... ,  prepare for configuration of new one ... */ | 
 | 2690 | 			switch ( cfg -> p_encap ){ | 
 | 2691 | 			case ISDN_NET_ENCAP_X25IFACE: | 
 | 2692 | 				lp -> dops = &isdn_concap_reliable_dl_dops; | 
 | 2693 | 			} | 
 | 2694 | 			/* ... and allocate new one ... */ | 
 | 2695 | 			p -> cprot = isdn_concap_new( cfg -> p_encap ); | 
 | 2696 | 			/* p -> cprot == NULL now if p_encap is not supported | 
 | 2697 | 			   by means of the concap_proto mechanism */ | 
 | 2698 | 			/* the protocol is not configured yet; this will | 
 | 2699 | 			   happen later when isdn_net_reset() is called */ | 
 | 2700 | #endif | 
 | 2701 | 		} | 
 | 2702 | 		switch ( cfg->p_encap ) { | 
 | 2703 | 		case ISDN_NET_ENCAP_SYNCPPP: | 
 | 2704 | #ifndef CONFIG_ISDN_PPP | 
 | 2705 | 			printk(KERN_WARNING "%s: SyncPPP support not configured\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2706 | 			       p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2707 | 			return -EINVAL; | 
 | 2708 | #else | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2709 | 			p->dev->type = ARPHRD_PPP;	/* change ARP type */ | 
 | 2710 | 			p->dev->addr_len = 0; | 
 | 2711 | 			p->dev->do_ioctl = isdn_ppp_dev_ioctl; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2712 | #endif | 
 | 2713 | 			break; | 
 | 2714 | 		case ISDN_NET_ENCAP_X25IFACE: | 
 | 2715 | #ifndef CONFIG_ISDN_X25 | 
 | 2716 | 			printk(KERN_WARNING "%s: isdn-x25 support not configured\n", | 
| Denis V. Lunev | c749b01 | 2007-10-15 12:52:20 -0700 | [diff] [blame] | 2717 | 			       p->dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2718 | 			return -EINVAL; | 
 | 2719 | #else | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2720 | 			p->dev->type = ARPHRD_X25;	/* change ARP type */ | 
 | 2721 | 			p->dev->addr_len = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2722 | #endif | 
 | 2723 | 			break; | 
 | 2724 | 		case ISDN_NET_ENCAP_CISCOHDLCK: | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2725 | 			p->dev->do_ioctl = isdn_ciscohdlck_dev_ioctl; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2726 | 			break; | 
 | 2727 | 		default: | 
 | 2728 | 			if( cfg->p_encap >= 0 && | 
 | 2729 | 			    cfg->p_encap <= ISDN_NET_ENCAP_MAX_ENCAP ) | 
 | 2730 | 				break; | 
 | 2731 | 			printk(KERN_WARNING | 
 | 2732 | 			       "%s: encapsulation protocol %d not supported\n", | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2733 | 			       p->dev->name, cfg->p_encap); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2734 | 			return -EINVAL; | 
 | 2735 | 		} | 
 | 2736 | 		if (strlen(cfg->drvid)) { | 
 | 2737 | 			/* A bind has been requested ... */ | 
 | 2738 | 			char *c, | 
 | 2739 | 			*e; | 
 | 2740 |  | 
 | 2741 | 			drvidx = -1; | 
 | 2742 | 			chidx = -1; | 
 | 2743 | 			strcpy(drvid, cfg->drvid); | 
 | 2744 | 			if ((c = strchr(drvid, ','))) { | 
 | 2745 | 				/* The channel-number is appended to the driver-Id with a comma */ | 
 | 2746 | 				chidx = (int) simple_strtoul(c + 1, &e, 10); | 
 | 2747 | 				if (e == c) | 
 | 2748 | 					chidx = -1; | 
 | 2749 | 				*c = '\0'; | 
 | 2750 | 			} | 
 | 2751 | 			for (i = 0; i < ISDN_MAX_DRIVERS; i++) | 
 | 2752 | 				/* Lookup driver-Id in array */ | 
 | 2753 | 				if (!(strcmp(dev->drvid[i], drvid))) { | 
 | 2754 | 					drvidx = i; | 
 | 2755 | 					break; | 
 | 2756 | 				} | 
 | 2757 | 			if ((drvidx == -1) || (chidx == -1)) | 
 | 2758 | 				/* Either driver-Id or channel-number invalid */ | 
 | 2759 | 				return -ENODEV; | 
 | 2760 | 		} else { | 
 | 2761 | 			/* Parameters are valid, so get them */ | 
 | 2762 | 			drvidx = lp->pre_device; | 
 | 2763 | 			chidx = lp->pre_channel; | 
 | 2764 | 		} | 
 | 2765 | 		if (cfg->exclusive > 0) { | 
 | 2766 | 			unsigned long flags; | 
 | 2767 |  | 
 | 2768 | 			/* If binding is exclusive, try to grab the channel */ | 
 | 2769 | 			spin_lock_irqsave(&dev->lock, flags); | 
 | 2770 | 			if ((i = isdn_get_free_channel(ISDN_USAGE_NET, | 
 | 2771 | 				lp->l2_proto, lp->l3_proto, drvidx, | 
 | 2772 | 				chidx, lp->msn)) < 0) { | 
 | 2773 | 				/* Grab failed, because desired channel is in use */ | 
 | 2774 | 				lp->exclusive = -1; | 
 | 2775 | 				spin_unlock_irqrestore(&dev->lock, flags); | 
 | 2776 | 				return -EBUSY; | 
 | 2777 | 			} | 
 | 2778 | 			/* All went ok, so update isdninfo */ | 
 | 2779 | 			dev->usage[i] = ISDN_USAGE_EXCLUSIVE; | 
 | 2780 | 			isdn_info_update(); | 
 | 2781 | 			spin_unlock_irqrestore(&dev->lock, flags); | 
 | 2782 | 			lp->exclusive = i; | 
 | 2783 | 		} else { | 
 | 2784 | 			/* Non-exclusive binding or unbind. */ | 
 | 2785 | 			lp->exclusive = -1; | 
 | 2786 | 			if ((lp->pre_device != -1) && (cfg->exclusive == -1)) { | 
 | 2787 | 				isdn_unexclusive_channel(lp->pre_device, lp->pre_channel); | 
 | 2788 | 				isdn_free_channel(lp->pre_device, lp->pre_channel, ISDN_USAGE_NET); | 
 | 2789 | 				drvidx = -1; | 
 | 2790 | 				chidx = -1; | 
 | 2791 | 			} | 
 | 2792 | 		} | 
| Karsten Keil | 0f13864 | 2007-11-22 12:43:13 +0100 | [diff] [blame] | 2793 | 		strlcpy(lp->msn, cfg->eaz, sizeof(lp->msn)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2794 | 		lp->pre_device = drvidx; | 
 | 2795 | 		lp->pre_channel = chidx; | 
 | 2796 | 		lp->onhtime = cfg->onhtime; | 
 | 2797 | 		lp->charge = cfg->charge; | 
 | 2798 | 		lp->l2_proto = cfg->l2_proto; | 
 | 2799 | 		lp->l3_proto = cfg->l3_proto; | 
 | 2800 | 		lp->cbdelay = cfg->cbdelay; | 
 | 2801 | 		lp->dialmax = cfg->dialmax; | 
 | 2802 | 		lp->triggercps = cfg->triggercps; | 
 | 2803 | 		lp->slavedelay = cfg->slavedelay * HZ; | 
 | 2804 | 		lp->pppbind = cfg->pppbind; | 
 | 2805 | 		lp->dialtimeout = cfg->dialtimeout >= 0 ? cfg->dialtimeout * HZ : -1; | 
 | 2806 | 		lp->dialwait = cfg->dialwait * HZ; | 
 | 2807 | 		if (cfg->secure) | 
 | 2808 | 			lp->flags |= ISDN_NET_SECURE; | 
 | 2809 | 		else | 
 | 2810 | 			lp->flags &= ~ISDN_NET_SECURE; | 
 | 2811 | 		if (cfg->cbhup) | 
 | 2812 | 			lp->flags |= ISDN_NET_CBHUP; | 
 | 2813 | 		else | 
 | 2814 | 			lp->flags &= ~ISDN_NET_CBHUP; | 
 | 2815 | 		switch (cfg->callback) { | 
 | 2816 | 			case 0: | 
 | 2817 | 				lp->flags &= ~(ISDN_NET_CALLBACK | ISDN_NET_CBOUT); | 
 | 2818 | 				break; | 
 | 2819 | 			case 1: | 
 | 2820 | 				lp->flags |= ISDN_NET_CALLBACK; | 
 | 2821 | 				lp->flags &= ~ISDN_NET_CBOUT; | 
 | 2822 | 				break; | 
 | 2823 | 			case 2: | 
 | 2824 | 				lp->flags |= ISDN_NET_CBOUT; | 
 | 2825 | 				lp->flags &= ~ISDN_NET_CALLBACK; | 
 | 2826 | 				break; | 
 | 2827 | 		} | 
 | 2828 | 		lp->flags &= ~ISDN_NET_DIALMODE_MASK;	/* first all bits off */ | 
 | 2829 | 		if (cfg->dialmode && !(cfg->dialmode & ISDN_NET_DIALMODE_MASK)) { | 
 | 2830 | 			/* old isdnctrl version, where only 0 or 1 is given */ | 
 | 2831 | 			printk(KERN_WARNING | 
 | 2832 | 			     "Old isdnctrl version detected! Please update.\n"); | 
 | 2833 | 			lp->flags |= ISDN_NET_DM_OFF; /* turn on `off' bit */ | 
 | 2834 | 		} | 
 | 2835 | 		else { | 
 | 2836 | 			lp->flags |= cfg->dialmode;  /* turn on selected bits */ | 
 | 2837 | 		} | 
 | 2838 | 		if (cfg->chargehup) | 
 | 2839 | 			lp->hupflags |= ISDN_CHARGEHUP; | 
 | 2840 | 		else | 
 | 2841 | 			lp->hupflags &= ~ISDN_CHARGEHUP; | 
 | 2842 | 		if (cfg->ihup) | 
 | 2843 | 			lp->hupflags |= ISDN_INHUP; | 
 | 2844 | 		else | 
 | 2845 | 			lp->hupflags &= ~ISDN_INHUP; | 
 | 2846 | 		if (cfg->chargeint > 10) { | 
 | 2847 | 			lp->hupflags |= ISDN_CHARGEHUP | ISDN_HAVECHARGE | ISDN_MANCHARGE; | 
 | 2848 | 			lp->chargeint = cfg->chargeint * HZ; | 
 | 2849 | 		} | 
 | 2850 | 		if (cfg->p_encap != lp->p_encap) { | 
 | 2851 | 			if (cfg->p_encap == ISDN_NET_ENCAP_RAWIP) { | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2852 | 				p->dev->header_ops = NULL; | 
 | 2853 | 				p->dev->flags = IFF_NOARP|IFF_POINTOPOINT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2854 | 			} else { | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2855 | 				p->dev->header_ops = &isdn_header_ops; | 
| Stephen Hemminger | 3b04ddd | 2007-10-09 01:40:57 -0700 | [diff] [blame] | 2856 | 				if (cfg->p_encap == ISDN_NET_ENCAP_ETHER) | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2857 | 					p->dev->flags = IFF_BROADCAST | IFF_MULTICAST; | 
| Stephen Hemminger | 3b04ddd | 2007-10-09 01:40:57 -0700 | [diff] [blame] | 2858 | 				else | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 2859 | 					p->dev->flags = IFF_NOARP|IFF_POINTOPOINT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2860 | 			} | 
 | 2861 | 		} | 
 | 2862 | 		lp->p_encap = cfg->p_encap; | 
 | 2863 | 		return 0; | 
 | 2864 | 	} | 
 | 2865 | 	return -ENODEV; | 
 | 2866 | } | 
 | 2867 |  | 
 | 2868 | /* | 
 | 2869 |  * Perform get-interface-parameters.ioctl | 
 | 2870 |  */ | 
 | 2871 | int | 
 | 2872 | isdn_net_getcfg(isdn_net_ioctl_cfg * cfg) | 
 | 2873 | { | 
 | 2874 | 	isdn_net_dev *p = isdn_net_findif(cfg->name); | 
 | 2875 |  | 
 | 2876 | 	if (p) { | 
 | 2877 | 		isdn_net_local *lp = p->local; | 
 | 2878 |  | 
 | 2879 | 		strcpy(cfg->eaz, lp->msn); | 
 | 2880 | 		cfg->exclusive = lp->exclusive; | 
 | 2881 | 		if (lp->pre_device >= 0) { | 
 | 2882 | 			sprintf(cfg->drvid, "%s,%d", dev->drvid[lp->pre_device], | 
 | 2883 | 				lp->pre_channel); | 
 | 2884 | 		} else | 
 | 2885 | 			cfg->drvid[0] = '\0'; | 
 | 2886 | 		cfg->onhtime = lp->onhtime; | 
 | 2887 | 		cfg->charge = lp->charge; | 
 | 2888 | 		cfg->l2_proto = lp->l2_proto; | 
 | 2889 | 		cfg->l3_proto = lp->l3_proto; | 
 | 2890 | 		cfg->p_encap = lp->p_encap; | 
 | 2891 | 		cfg->secure = (lp->flags & ISDN_NET_SECURE) ? 1 : 0; | 
 | 2892 | 		cfg->callback = 0; | 
 | 2893 | 		if (lp->flags & ISDN_NET_CALLBACK) | 
 | 2894 | 			cfg->callback = 1; | 
 | 2895 | 		if (lp->flags & ISDN_NET_CBOUT) | 
 | 2896 | 			cfg->callback = 2; | 
 | 2897 | 		cfg->cbhup = (lp->flags & ISDN_NET_CBHUP) ? 1 : 0; | 
 | 2898 | 		cfg->dialmode = lp->flags & ISDN_NET_DIALMODE_MASK; | 
 | 2899 | 		cfg->chargehup = (lp->hupflags & 4) ? 1 : 0; | 
 | 2900 | 		cfg->ihup = (lp->hupflags & 8) ? 1 : 0; | 
 | 2901 | 		cfg->cbdelay = lp->cbdelay; | 
 | 2902 | 		cfg->dialmax = lp->dialmax; | 
 | 2903 | 		cfg->triggercps = lp->triggercps; | 
 | 2904 | 		cfg->slavedelay = lp->slavedelay / HZ; | 
 | 2905 | 		cfg->chargeint = (lp->hupflags & ISDN_CHARGEHUP) ? | 
 | 2906 | 		    (lp->chargeint / HZ) : 0; | 
 | 2907 | 		cfg->pppbind = lp->pppbind; | 
 | 2908 | 		cfg->dialtimeout = lp->dialtimeout >= 0 ? lp->dialtimeout / HZ : -1; | 
 | 2909 | 		cfg->dialwait = lp->dialwait / HZ; | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2910 | 		if (lp->slave) { | 
 | 2911 | 			if (strlen(lp->slave->name) > 8) | 
 | 2912 | 				strcpy(cfg->slave, "too-long"); | 
 | 2913 | 			else | 
 | 2914 | 				strcpy(cfg->slave, lp->slave->name); | 
 | 2915 | 		} else | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2916 | 			cfg->slave[0] = '\0'; | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2917 | 		if (lp->master) { | 
 | 2918 | 			if (strlen(lp->master->name) > 8) | 
 | 2919 | 				strcpy(cfg->master, "too-long"); | 
 | 2920 | 			strcpy(cfg->master, lp->master->name); | 
 | 2921 | 		} else | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2922 | 			cfg->master[0] = '\0'; | 
 | 2923 | 		return 0; | 
 | 2924 | 	} | 
 | 2925 | 	return -ENODEV; | 
 | 2926 | } | 
 | 2927 |  | 
 | 2928 | /* | 
 | 2929 |  * Add a phone-number to an interface. | 
 | 2930 |  */ | 
 | 2931 | int | 
 | 2932 | isdn_net_addphone(isdn_net_ioctl_phone * phone) | 
 | 2933 | { | 
 | 2934 | 	isdn_net_dev *p = isdn_net_findif(phone->name); | 
 | 2935 | 	isdn_net_phone *n; | 
 | 2936 |  | 
 | 2937 | 	if (p) { | 
| Robert P. J. Day | 5cbded5 | 2006-12-13 00:35:56 -0800 | [diff] [blame] | 2938 | 		if (!(n = kmalloc(sizeof(isdn_net_phone), GFP_KERNEL))) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2939 | 			return -ENOMEM; | 
| Karsten Keil | 0f13864 | 2007-11-22 12:43:13 +0100 | [diff] [blame] | 2940 | 		strlcpy(n->num, phone->phone, sizeof(n->num)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2941 | 		n->next = p->local->phone[phone->outgoing & 1]; | 
 | 2942 | 		p->local->phone[phone->outgoing & 1] = n; | 
 | 2943 | 		return 0; | 
 | 2944 | 	} | 
 | 2945 | 	return -ENODEV; | 
 | 2946 | } | 
 | 2947 |  | 
 | 2948 | /* | 
 | 2949 |  * Copy a string of all phone-numbers of an interface to user space. | 
 | 2950 |  * This might sleep and must be called with the isdn semaphore down. | 
 | 2951 |  */ | 
 | 2952 | int | 
 | 2953 | isdn_net_getphones(isdn_net_ioctl_phone * phone, char __user *phones) | 
 | 2954 | { | 
 | 2955 | 	isdn_net_dev *p = isdn_net_findif(phone->name); | 
 | 2956 | 	int inout = phone->outgoing & 1; | 
 | 2957 | 	int more = 0; | 
 | 2958 | 	int count = 0; | 
 | 2959 | 	isdn_net_phone *n; | 
 | 2960 |  | 
 | 2961 | 	if (!p) | 
 | 2962 | 		return -ENODEV; | 
 | 2963 | 	inout &= 1; | 
 | 2964 | 	for (n = p->local->phone[inout]; n; n = n->next) { | 
 | 2965 | 		if (more) { | 
 | 2966 | 			put_user(' ', phones++); | 
 | 2967 | 			count++; | 
 | 2968 | 		} | 
 | 2969 | 		if (copy_to_user(phones, n->num, strlen(n->num) + 1)) { | 
 | 2970 | 			return -EFAULT; | 
 | 2971 | 		} | 
 | 2972 | 		phones += strlen(n->num); | 
 | 2973 | 		count += strlen(n->num); | 
 | 2974 | 		more = 1; | 
 | 2975 | 	} | 
 | 2976 | 	put_user(0, phones); | 
 | 2977 | 	count++; | 
 | 2978 | 	return count; | 
 | 2979 | } | 
 | 2980 |  | 
 | 2981 | /* | 
 | 2982 |  * Copy a string containing the peer's phone number of a connected interface | 
 | 2983 |  * to user space. | 
 | 2984 |  */ | 
 | 2985 | int | 
 | 2986 | isdn_net_getpeer(isdn_net_ioctl_phone *phone, isdn_net_ioctl_phone __user *peer) | 
 | 2987 | { | 
 | 2988 | 	isdn_net_dev *p = isdn_net_findif(phone->name); | 
 | 2989 | 	int ch, dv, idx; | 
 | 2990 |  | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 2991 | 	if (!p) | 
 | 2992 | 		return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2993 | 	/* | 
 | 2994 | 	 * Theoretical race: while this executes, the remote number might | 
 | 2995 | 	 * become invalid (hang up) or change (new connection), resulting | 
 | 2996 |          * in (partially) wrong number copied to user. This race | 
 | 2997 | 	 * currently ignored. | 
 | 2998 | 	 */ | 
 | 2999 | 	ch = p->local->isdn_channel; | 
 | 3000 | 	dv = p->local->isdn_device; | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 3001 | 	if(ch < 0 && dv < 0) | 
 | 3002 | 		return -ENOTCONN; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3003 | 	idx = isdn_dc2minor(dv, ch); | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 3004 | 	if (idx <0 ) | 
 | 3005 | 		return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3006 | 	/* for pre-bound channels, we need this extra check */ | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 3007 | 	if (strncmp(dev->num[idx], "???", 3) == 0) | 
 | 3008 | 		return -ENOTCONN; | 
 | 3009 | 	strncpy(phone->phone, dev->num[idx], ISDN_MSNLEN); | 
 | 3010 | 	phone->outgoing = USG_OUTGOING(dev->usage[idx]); | 
 | 3011 | 	if (copy_to_user(peer, phone, sizeof(*peer))) | 
 | 3012 | 		return -EFAULT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3013 | 	return 0; | 
 | 3014 | } | 
 | 3015 | /* | 
 | 3016 |  * Delete a phone-number from an interface. | 
 | 3017 |  */ | 
 | 3018 | int | 
 | 3019 | isdn_net_delphone(isdn_net_ioctl_phone * phone) | 
 | 3020 | { | 
 | 3021 | 	isdn_net_dev *p = isdn_net_findif(phone->name); | 
 | 3022 | 	int inout = phone->outgoing & 1; | 
 | 3023 | 	isdn_net_phone *n; | 
 | 3024 | 	isdn_net_phone *m; | 
 | 3025 |  | 
 | 3026 | 	if (p) { | 
 | 3027 | 		n = p->local->phone[inout]; | 
 | 3028 | 		m = NULL; | 
 | 3029 | 		while (n) { | 
 | 3030 | 			if (!strcmp(n->num, phone->phone)) { | 
 | 3031 | 				if (p->local->dial == n) | 
 | 3032 | 					p->local->dial = n->next; | 
 | 3033 | 				if (m) | 
 | 3034 | 					m->next = n->next; | 
 | 3035 | 				else | 
 | 3036 | 					p->local->phone[inout] = n->next; | 
 | 3037 | 				kfree(n); | 
 | 3038 | 				return 0; | 
 | 3039 | 			} | 
 | 3040 | 			m = n; | 
 | 3041 | 			n = (isdn_net_phone *) n->next; | 
 | 3042 | 		} | 
 | 3043 | 		return -EINVAL; | 
 | 3044 | 	} | 
 | 3045 | 	return -ENODEV; | 
 | 3046 | } | 
 | 3047 |  | 
 | 3048 | /* | 
 | 3049 |  * Delete all phone-numbers of an interface. | 
 | 3050 |  */ | 
 | 3051 | static int | 
 | 3052 | isdn_net_rmallphone(isdn_net_dev * p) | 
 | 3053 | { | 
 | 3054 | 	isdn_net_phone *n; | 
 | 3055 | 	isdn_net_phone *m; | 
 | 3056 | 	int i; | 
 | 3057 |  | 
 | 3058 | 	for (i = 0; i < 2; i++) { | 
 | 3059 | 		n = p->local->phone[i]; | 
 | 3060 | 		while (n) { | 
 | 3061 | 			m = n->next; | 
 | 3062 | 			kfree(n); | 
 | 3063 | 			n = m; | 
 | 3064 | 		} | 
 | 3065 | 		p->local->phone[i] = NULL; | 
 | 3066 | 	} | 
 | 3067 | 	p->local->dial = NULL; | 
 | 3068 | 	return 0; | 
 | 3069 | } | 
 | 3070 |  | 
 | 3071 | /* | 
 | 3072 |  * Force a hangup of a network-interface. | 
 | 3073 |  */ | 
 | 3074 | int | 
 | 3075 | isdn_net_force_hangup(char *name) | 
 | 3076 | { | 
 | 3077 | 	isdn_net_dev *p = isdn_net_findif(name); | 
 | 3078 | 	struct net_device *q; | 
 | 3079 |  | 
 | 3080 | 	if (p) { | 
 | 3081 | 		if (p->local->isdn_device < 0) | 
 | 3082 | 			return 1; | 
 | 3083 | 		q = p->local->slave; | 
 | 3084 | 		/* If this interface has slaves, do a hangup for them also. */ | 
 | 3085 | 		while (q) { | 
 | 3086 | 			isdn_net_hangup(q); | 
 | 3087 | 			q = (((isdn_net_local *) q->priv)->slave); | 
 | 3088 | 		} | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 3089 | 		isdn_net_hangup(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3090 | 		return 0; | 
 | 3091 | 	} | 
 | 3092 | 	return -ENODEV; | 
 | 3093 | } | 
 | 3094 |  | 
 | 3095 | /* | 
 | 3096 |  * Helper-function for isdn_net_rm: Do the real work. | 
 | 3097 |  */ | 
 | 3098 | static int | 
 | 3099 | isdn_net_realrm(isdn_net_dev * p, isdn_net_dev * q) | 
 | 3100 | { | 
 | 3101 | 	u_long flags; | 
 | 3102 |  | 
 | 3103 | 	if (isdn_net_device_started(p)) { | 
 | 3104 | 		return -EBUSY; | 
 | 3105 | 	} | 
 | 3106 | #ifdef CONFIG_ISDN_X25 | 
 | 3107 | 	if( p -> cprot && p -> cprot -> pops ) | 
 | 3108 | 		p -> cprot -> pops -> proto_del ( p -> cprot ); | 
 | 3109 | #endif | 
 | 3110 | 	/* Free all phone-entries */ | 
 | 3111 | 	isdn_net_rmallphone(p); | 
 | 3112 | 	/* If interface is bound exclusive, free channel-usage */ | 
 | 3113 | 	if (p->local->exclusive != -1) | 
 | 3114 | 		isdn_unexclusive_channel(p->local->pre_device, p->local->pre_channel); | 
 | 3115 | 	if (p->local->master) { | 
 | 3116 | 		/* It's a slave-device, so update master's slave-pointer if necessary */ | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 3117 | 		if (((isdn_net_local *) (p->local->master->priv))->slave == p->dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3118 | 			((isdn_net_local *) (p->local->master->priv))->slave = p->local->slave; | 
 | 3119 | 	} else { | 
 | 3120 | 		/* Unregister only if it's a master-device */ | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 3121 | 		unregister_netdev(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3122 | 	} | 
 | 3123 | 	/* Unlink device from chain */ | 
 | 3124 | 	spin_lock_irqsave(&dev->lock, flags); | 
 | 3125 | 	if (q) | 
 | 3126 | 		q->next = p->next; | 
 | 3127 | 	else | 
 | 3128 | 		dev->netdev = p->next; | 
 | 3129 | 	if (p->local->slave) { | 
 | 3130 | 		/* If this interface has a slave, remove it also */ | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 3131 | 		char *slavename = p->local->slave->name; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3132 | 		isdn_net_dev *n = dev->netdev; | 
 | 3133 | 		q = NULL; | 
 | 3134 | 		while (n) { | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 3135 | 			if (!strcmp(n->dev->name, slavename)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3136 | 				spin_unlock_irqrestore(&dev->lock, flags); | 
 | 3137 | 				isdn_net_realrm(n, q); | 
 | 3138 | 				spin_lock_irqsave(&dev->lock, flags); | 
 | 3139 | 				break; | 
 | 3140 | 			} | 
 | 3141 | 			q = n; | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 3142 | 			n = (isdn_net_dev *)n->next; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3143 | 		} | 
 | 3144 | 	} | 
 | 3145 | 	spin_unlock_irqrestore(&dev->lock, flags); | 
 | 3146 | 	/* If no more net-devices remain, disable auto-hangup timer */ | 
 | 3147 | 	if (dev->netdev == NULL) | 
 | 3148 | 		isdn_timer_ctrl(ISDN_TIMER_NETHANGUP, 0); | 
| Karsten Keil | d62a38d | 2007-10-08 20:37:11 -0700 | [diff] [blame] | 3149 | 	free_netdev(p->dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3150 | 	kfree(p); | 
 | 3151 |  | 
 | 3152 | 	return 0; | 
 | 3153 | } | 
 | 3154 |  | 
 | 3155 | /* | 
 | 3156 |  * Remove a single network-interface. | 
 | 3157 |  */ | 
 | 3158 | int | 
 | 3159 | isdn_net_rm(char *name) | 
 | 3160 | { | 
 | 3161 | 	u_long flags; | 
 | 3162 | 	isdn_net_dev *p; | 
 | 3163 | 	isdn_net_dev *q; | 
 | 3164 |  | 
 | 3165 | 	/* Search name in netdev-chain */ | 
 | 3166 | 	spin_lock_irqsave(&dev->lock, flags); | 
 | 3167 | 	p = dev->netdev; | 
 | 3168 | 	q = NULL; | 
 | 3169 | 	while (p) { | 
| Karsten Keil | faca94f | 2007-10-15 02:11:44 -0700 | [diff] [blame] | 3170 | 		if (!strcmp(p->dev->name, name)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3171 | 			spin_unlock_irqrestore(&dev->lock, flags); | 
 | 3172 | 			return (isdn_net_realrm(p, q)); | 
 | 3173 | 		} | 
 | 3174 | 		q = p; | 
 | 3175 | 		p = (isdn_net_dev *) p->next; | 
 | 3176 | 	} | 
 | 3177 | 	spin_unlock_irqrestore(&dev->lock, flags); | 
 | 3178 | 	/* If no more net-devices remain, disable auto-hangup timer */ | 
 | 3179 | 	if (dev->netdev == NULL) | 
 | 3180 | 		isdn_timer_ctrl(ISDN_TIMER_NETHANGUP, 0); | 
 | 3181 | 	return -ENODEV; | 
 | 3182 | } | 
 | 3183 |  | 
 | 3184 | /* | 
 | 3185 |  * Remove all network-interfaces | 
 | 3186 |  */ | 
 | 3187 | int | 
 | 3188 | isdn_net_rmall(void) | 
 | 3189 | { | 
 | 3190 | 	u_long flags; | 
 | 3191 | 	int ret; | 
 | 3192 |  | 
 | 3193 | 	/* Walk through netdev-chain */ | 
 | 3194 | 	spin_lock_irqsave(&dev->lock, flags); | 
 | 3195 | 	while (dev->netdev) { | 
 | 3196 | 		if (!dev->netdev->local->master) { | 
 | 3197 | 			/* Remove master-devices only, slaves get removed with their master */ | 
 | 3198 | 			spin_unlock_irqrestore(&dev->lock, flags); | 
 | 3199 | 			if ((ret = isdn_net_realrm(dev->netdev, NULL))) { | 
 | 3200 | 				return ret; | 
 | 3201 | 			} | 
 | 3202 | 			spin_lock_irqsave(&dev->lock, flags); | 
 | 3203 | 		} | 
 | 3204 | 	} | 
 | 3205 | 	dev->netdev = NULL; | 
 | 3206 | 	spin_unlock_irqrestore(&dev->lock, flags); | 
 | 3207 | 	return 0; | 
 | 3208 | } |