xref: /openbmc/linux/net/appletalk/aarp.c (revision e730c15519d09ea528b4d2f1103681fa5937c0e6)
1 /*
2  *	AARP:		An implementation of the AppleTalk AARP protocol for
3  *			Ethernet 'ELAP'.
4  *
5  *		Alan Cox  <Alan.Cox@linux.org>
6  *
7  *	This doesn't fit cleanly with the IP arp. Potentially we can use
8  *	the generic neighbour discovery code to clean this up.
9  *
10  *	FIXME:
11  *		We ought to handle the retransmits with a single list and a
12  *	separate fast timer for when it is needed.
13  *		Use neighbour discovery code.
14  *		Token Ring Support.
15  *
16  *		This program is free software; you can redistribute it and/or
17  *		modify it under the terms of the GNU General Public License
18  *		as published by the Free Software Foundation; either version
19  *		2 of the License, or (at your option) any later version.
20  *
21  *
22  *	References:
23  *		Inside AppleTalk (2nd Ed).
24  *	Fixes:
25  *		Jaume Grau	-	flush caches on AARP_PROBE
26  *		Rob Newberry	-	Added proxy AARP and AARP proc fs,
27  *					moved probing from DDP module.
28  *		Arnaldo C. Melo -	don't mangle rx packets
29  *
30  */
31 
32 #include <linux/if_arp.h>
33 #include <net/sock.h>
34 #include <net/datalink.h>
35 #include <net/psnap.h>
36 #include <linux/atalk.h>
37 #include <linux/delay.h>
38 #include <linux/init.h>
39 #include <linux/proc_fs.h>
40 #include <linux/seq_file.h>
41 
42 int sysctl_aarp_expiry_time = AARP_EXPIRY_TIME;
43 int sysctl_aarp_tick_time = AARP_TICK_TIME;
44 int sysctl_aarp_retransmit_limit = AARP_RETRANSMIT_LIMIT;
45 int sysctl_aarp_resolve_time = AARP_RESOLVE_TIME;
46 
47 /* Lists of aarp entries */
48 /**
49  *	struct aarp_entry - AARP entry
50  *	@last_sent - Last time we xmitted the aarp request
51  *	@packet_queue - Queue of frames wait for resolution
52  *	@status - Used for proxy AARP
53  *	expires_at - Entry expiry time
54  *	target_addr - DDP Address
55  *	dev - Device to use
56  *	hwaddr - Physical i/f address of target/router
57  *	xmit_count - When this hits 10 we give up
58  *	next - Next entry in chain
59  */
60 struct aarp_entry {
61 	/* These first two are only used for unresolved entries */
62 	unsigned long		last_sent;
63 	struct sk_buff_head	packet_queue;
64 	int			status;
65 	unsigned long		expires_at;
66 	struct atalk_addr	target_addr;
67 	struct net_device	*dev;
68 	char			hwaddr[6];
69 	unsigned short		xmit_count;
70 	struct aarp_entry	*next;
71 };
72 
73 /* Hashed list of resolved, unresolved and proxy entries */
74 static struct aarp_entry *resolved[AARP_HASH_SIZE];
75 static struct aarp_entry *unresolved[AARP_HASH_SIZE];
76 static struct aarp_entry *proxies[AARP_HASH_SIZE];
77 static int unresolved_count;
78 
79 /* One lock protects it all. */
80 static DEFINE_RWLOCK(aarp_lock);
81 
82 /* Used to walk the list and purge/kick entries.  */
83 static struct timer_list aarp_timer;
84 
85 /*
86  *	Delete an aarp queue
87  *
88  *	Must run under aarp_lock.
89  */
90 static void __aarp_expire(struct aarp_entry *a)
91 {
92 	skb_queue_purge(&a->packet_queue);
93 	kfree(a);
94 }
95 
96 /*
97  *	Send an aarp queue entry request
98  *
99  *	Must run under aarp_lock.
100  */
101 static void __aarp_send_query(struct aarp_entry *a)
102 {
103 	static unsigned char aarp_eth_multicast[ETH_ALEN] =
104 					{ 0x09, 0x00, 0x07, 0xFF, 0xFF, 0xFF };
105 	struct net_device *dev = a->dev;
106 	struct elapaarp *eah;
107 	int len = dev->hard_header_len + sizeof(*eah) + aarp_dl->header_length;
108 	struct sk_buff *skb = alloc_skb(len, GFP_ATOMIC);
109 	struct atalk_addr *sat = atalk_find_dev_addr(dev);
110 
111 	if (!skb)
112 		return;
113 
114 	if (!sat) {
115 		kfree_skb(skb);
116 		return;
117 	}
118 
119 	/* Set up the buffer */
120 	skb_reserve(skb, dev->hard_header_len + aarp_dl->header_length);
121 	skb_reset_network_header(skb);
122 	skb_reset_transport_header(skb);
123 	skb_put(skb, sizeof(*eah));
124 	skb->protocol    = htons(ETH_P_ATALK);
125 	skb->dev	 = dev;
126 	eah		 = aarp_hdr(skb);
127 
128 	/* Set up the ARP */
129 	eah->hw_type	 = htons(AARP_HW_TYPE_ETHERNET);
130 	eah->pa_type	 = htons(ETH_P_ATALK);
131 	eah->hw_len	 = ETH_ALEN;
132 	eah->pa_len	 = AARP_PA_ALEN;
133 	eah->function	 = htons(AARP_REQUEST);
134 
135 	memcpy(eah->hw_src, dev->dev_addr, ETH_ALEN);
136 
137 	eah->pa_src_zero = 0;
138 	eah->pa_src_net	 = sat->s_net;
139 	eah->pa_src_node = sat->s_node;
140 
141 	memset(eah->hw_dst, '\0', ETH_ALEN);
142 
143 	eah->pa_dst_zero = 0;
144 	eah->pa_dst_net	 = a->target_addr.s_net;
145 	eah->pa_dst_node = a->target_addr.s_node;
146 
147 	/* Send it */
148 	aarp_dl->request(aarp_dl, skb, aarp_eth_multicast);
149 	/* Update the sending count */
150 	a->xmit_count++;
151 	a->last_sent = jiffies;
152 }
153 
154 /* This runs under aarp_lock and in softint context, so only atomic memory
155  * allocations can be used. */
156 static void aarp_send_reply(struct net_device *dev, struct atalk_addr *us,
157 			    struct atalk_addr *them, unsigned char *sha)
158 {
159 	struct elapaarp *eah;
160 	int len = dev->hard_header_len + sizeof(*eah) + aarp_dl->header_length;
161 	struct sk_buff *skb = alloc_skb(len, GFP_ATOMIC);
162 
163 	if (!skb)
164 		return;
165 
166 	/* Set up the buffer */
167 	skb_reserve(skb, dev->hard_header_len + aarp_dl->header_length);
168 	skb_reset_network_header(skb);
169 	skb_reset_transport_header(skb);
170 	skb_put(skb, sizeof(*eah));
171 	skb->protocol    = htons(ETH_P_ATALK);
172 	skb->dev	 = dev;
173 	eah		 = aarp_hdr(skb);
174 
175 	/* Set up the ARP */
176 	eah->hw_type	 = htons(AARP_HW_TYPE_ETHERNET);
177 	eah->pa_type	 = htons(ETH_P_ATALK);
178 	eah->hw_len	 = ETH_ALEN;
179 	eah->pa_len	 = AARP_PA_ALEN;
180 	eah->function	 = htons(AARP_REPLY);
181 
182 	memcpy(eah->hw_src, dev->dev_addr, ETH_ALEN);
183 
184 	eah->pa_src_zero = 0;
185 	eah->pa_src_net	 = us->s_net;
186 	eah->pa_src_node = us->s_node;
187 
188 	if (!sha)
189 		memset(eah->hw_dst, '\0', ETH_ALEN);
190 	else
191 		memcpy(eah->hw_dst, sha, ETH_ALEN);
192 
193 	eah->pa_dst_zero = 0;
194 	eah->pa_dst_net	 = them->s_net;
195 	eah->pa_dst_node = them->s_node;
196 
197 	/* Send it */
198 	aarp_dl->request(aarp_dl, skb, sha);
199 }
200 
201 /*
202  *	Send probe frames. Called from aarp_probe_network and
203  *	aarp_proxy_probe_network.
204  */
205 
206 static void aarp_send_probe(struct net_device *dev, struct atalk_addr *us)
207 {
208 	struct elapaarp *eah;
209 	int len = dev->hard_header_len + sizeof(*eah) + aarp_dl->header_length;
210 	struct sk_buff *skb = alloc_skb(len, GFP_ATOMIC);
211 	static unsigned char aarp_eth_multicast[ETH_ALEN] =
212 					{ 0x09, 0x00, 0x07, 0xFF, 0xFF, 0xFF };
213 
214 	if (!skb)
215 		return;
216 
217 	/* Set up the buffer */
218 	skb_reserve(skb, dev->hard_header_len + aarp_dl->header_length);
219 	skb_reset_network_header(skb);
220 	skb_reset_transport_header(skb);
221 	skb_put(skb, sizeof(*eah));
222 	skb->protocol    = htons(ETH_P_ATALK);
223 	skb->dev	 = dev;
224 	eah		 = aarp_hdr(skb);
225 
226 	/* Set up the ARP */
227 	eah->hw_type	 = htons(AARP_HW_TYPE_ETHERNET);
228 	eah->pa_type	 = htons(ETH_P_ATALK);
229 	eah->hw_len	 = ETH_ALEN;
230 	eah->pa_len	 = AARP_PA_ALEN;
231 	eah->function	 = htons(AARP_PROBE);
232 
233 	memcpy(eah->hw_src, dev->dev_addr, ETH_ALEN);
234 
235 	eah->pa_src_zero = 0;
236 	eah->pa_src_net	 = us->s_net;
237 	eah->pa_src_node = us->s_node;
238 
239 	memset(eah->hw_dst, '\0', ETH_ALEN);
240 
241 	eah->pa_dst_zero = 0;
242 	eah->pa_dst_net	 = us->s_net;
243 	eah->pa_dst_node = us->s_node;
244 
245 	/* Send it */
246 	aarp_dl->request(aarp_dl, skb, aarp_eth_multicast);
247 }
248 
249 /*
250  *	Handle an aarp timer expire
251  *
252  *	Must run under the aarp_lock.
253  */
254 
255 static void __aarp_expire_timer(struct aarp_entry **n)
256 {
257 	struct aarp_entry *t;
258 
259 	while (*n)
260 		/* Expired ? */
261 		if (time_after(jiffies, (*n)->expires_at)) {
262 			t = *n;
263 			*n = (*n)->next;
264 			__aarp_expire(t);
265 		} else
266 			n = &((*n)->next);
267 }
268 
269 /*
270  *	Kick all pending requests 5 times a second.
271  *
272  *	Must run under the aarp_lock.
273  */
274 static void __aarp_kick(struct aarp_entry **n)
275 {
276 	struct aarp_entry *t;
277 
278 	while (*n)
279 		/* Expired: if this will be the 11th tx, we delete instead. */
280 		if ((*n)->xmit_count >= sysctl_aarp_retransmit_limit) {
281 			t = *n;
282 			*n = (*n)->next;
283 			__aarp_expire(t);
284 		} else {
285 			__aarp_send_query(*n);
286 			n = &((*n)->next);
287 		}
288 }
289 
290 /*
291  *	A device has gone down. Take all entries referring to the device
292  *	and remove them.
293  *
294  *	Must run under the aarp_lock.
295  */
296 static void __aarp_expire_device(struct aarp_entry **n, struct net_device *dev)
297 {
298 	struct aarp_entry *t;
299 
300 	while (*n)
301 		if ((*n)->dev == dev) {
302 			t = *n;
303 			*n = (*n)->next;
304 			__aarp_expire(t);
305 		} else
306 			n = &((*n)->next);
307 }
308 
309 /* Handle the timer event */
310 static void aarp_expire_timeout(unsigned long unused)
311 {
312 	int ct;
313 
314 	write_lock_bh(&aarp_lock);
315 
316 	for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
317 		__aarp_expire_timer(&resolved[ct]);
318 		__aarp_kick(&unresolved[ct]);
319 		__aarp_expire_timer(&unresolved[ct]);
320 		__aarp_expire_timer(&proxies[ct]);
321 	}
322 
323 	write_unlock_bh(&aarp_lock);
324 	mod_timer(&aarp_timer, jiffies +
325 			       (unresolved_count ? sysctl_aarp_tick_time :
326 				sysctl_aarp_expiry_time));
327 }
328 
329 /* Network device notifier chain handler. */
330 static int aarp_device_event(struct notifier_block *this, unsigned long event,
331 			     void *ptr)
332 {
333 	struct net_device *dev = ptr;
334 	int ct;
335 
336 	if (event == NETDEV_DOWN) {
337 		write_lock_bh(&aarp_lock);
338 
339 		for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
340 			__aarp_expire_device(&resolved[ct], dev);
341 			__aarp_expire_device(&unresolved[ct], dev);
342 			__aarp_expire_device(&proxies[ct], dev);
343 		}
344 
345 		write_unlock_bh(&aarp_lock);
346 	}
347 	return NOTIFY_DONE;
348 }
349 
350 /* Expire all entries in a hash chain */
351 static void __aarp_expire_all(struct aarp_entry **n)
352 {
353 	struct aarp_entry *t;
354 
355 	while (*n) {
356 		t = *n;
357 		*n = (*n)->next;
358 		__aarp_expire(t);
359 	}
360 }
361 
362 /* Cleanup all hash chains -- module unloading */
363 static void aarp_purge(void)
364 {
365 	int ct;
366 
367 	write_lock_bh(&aarp_lock);
368 	for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
369 		__aarp_expire_all(&resolved[ct]);
370 		__aarp_expire_all(&unresolved[ct]);
371 		__aarp_expire_all(&proxies[ct]);
372 	}
373 	write_unlock_bh(&aarp_lock);
374 }
375 
376 /*
377  *	Create a new aarp entry.  This must use GFP_ATOMIC because it
378  *	runs while holding spinlocks.
379  */
380 static struct aarp_entry *aarp_alloc(void)
381 {
382 	struct aarp_entry *a = kmalloc(sizeof(*a), GFP_ATOMIC);
383 
384 	if (a)
385 		skb_queue_head_init(&a->packet_queue);
386 	return a;
387 }
388 
389 /*
390  * Find an entry. We might return an expired but not yet purged entry. We
391  * don't care as it will do no harm.
392  *
393  * This must run under the aarp_lock.
394  */
395 static struct aarp_entry *__aarp_find_entry(struct aarp_entry *list,
396 					    struct net_device *dev,
397 					    struct atalk_addr *sat)
398 {
399 	while (list) {
400 		if (list->target_addr.s_net == sat->s_net &&
401 		    list->target_addr.s_node == sat->s_node &&
402 		    list->dev == dev)
403 			break;
404 		list = list->next;
405 	}
406 
407 	return list;
408 }
409 
410 /* Called from the DDP code, and thus must be exported. */
411 void aarp_proxy_remove(struct net_device *dev, struct atalk_addr *sa)
412 {
413 	int hash = sa->s_node % (AARP_HASH_SIZE - 1);
414 	struct aarp_entry *a;
415 
416 	write_lock_bh(&aarp_lock);
417 
418 	a = __aarp_find_entry(proxies[hash], dev, sa);
419 	if (a)
420 		a->expires_at = jiffies - 1;
421 
422 	write_unlock_bh(&aarp_lock);
423 }
424 
425 /* This must run under aarp_lock. */
426 static struct atalk_addr *__aarp_proxy_find(struct net_device *dev,
427 					    struct atalk_addr *sa)
428 {
429 	int hash = sa->s_node % (AARP_HASH_SIZE - 1);
430 	struct aarp_entry *a = __aarp_find_entry(proxies[hash], dev, sa);
431 
432 	return a ? sa : NULL;
433 }
434 
435 /*
436  * Probe a Phase 1 device or a device that requires its Net:Node to
437  * be set via an ioctl.
438  */
439 static void aarp_send_probe_phase1(struct atalk_iface *iface)
440 {
441 	struct ifreq atreq;
442 	struct sockaddr_at *sa = (struct sockaddr_at *)&atreq.ifr_addr;
443 
444 	sa->sat_addr.s_node = iface->address.s_node;
445 	sa->sat_addr.s_net = ntohs(iface->address.s_net);
446 
447 	/* We pass the Net:Node to the drivers/cards by a Device ioctl. */
448 	if (!(iface->dev->do_ioctl(iface->dev, &atreq, SIOCSIFADDR))) {
449 		(void)iface->dev->do_ioctl(iface->dev, &atreq, SIOCGIFADDR);
450 		if (iface->address.s_net != htons(sa->sat_addr.s_net) ||
451 		    iface->address.s_node != sa->sat_addr.s_node)
452 			iface->status |= ATIF_PROBE_FAIL;
453 
454 		iface->address.s_net  = htons(sa->sat_addr.s_net);
455 		iface->address.s_node = sa->sat_addr.s_node;
456 	}
457 }
458 
459 
460 void aarp_probe_network(struct atalk_iface *atif)
461 {
462 	if (atif->dev->type == ARPHRD_LOCALTLK ||
463 	    atif->dev->type == ARPHRD_PPP)
464 		aarp_send_probe_phase1(atif);
465 	else {
466 		unsigned int count;
467 
468 		for (count = 0; count < AARP_RETRANSMIT_LIMIT; count++) {
469 			aarp_send_probe(atif->dev, &atif->address);
470 
471 			/* Defer 1/10th */
472 			msleep(100);
473 
474 			if (atif->status & ATIF_PROBE_FAIL)
475 				break;
476 		}
477 	}
478 }
479 
480 int aarp_proxy_probe_network(struct atalk_iface *atif, struct atalk_addr *sa)
481 {
482 	int hash, retval = -EPROTONOSUPPORT;
483 	struct aarp_entry *entry;
484 	unsigned int count;
485 
486 	/*
487 	 * we don't currently support LocalTalk or PPP for proxy AARP;
488 	 * if someone wants to try and add it, have fun
489 	 */
490 	if (atif->dev->type == ARPHRD_LOCALTLK ||
491 	    atif->dev->type == ARPHRD_PPP)
492 		goto out;
493 
494 	/*
495 	 * create a new AARP entry with the flags set to be published --
496 	 * we need this one to hang around even if it's in use
497 	 */
498 	entry = aarp_alloc();
499 	retval = -ENOMEM;
500 	if (!entry)
501 		goto out;
502 
503 	entry->expires_at = -1;
504 	entry->status = ATIF_PROBE;
505 	entry->target_addr.s_node = sa->s_node;
506 	entry->target_addr.s_net = sa->s_net;
507 	entry->dev = atif->dev;
508 
509 	write_lock_bh(&aarp_lock);
510 
511 	hash = sa->s_node % (AARP_HASH_SIZE - 1);
512 	entry->next = proxies[hash];
513 	proxies[hash] = entry;
514 
515 	for (count = 0; count < AARP_RETRANSMIT_LIMIT; count++) {
516 		aarp_send_probe(atif->dev, sa);
517 
518 		/* Defer 1/10th */
519 		write_unlock_bh(&aarp_lock);
520 		msleep(100);
521 		write_lock_bh(&aarp_lock);
522 
523 		if (entry->status & ATIF_PROBE_FAIL)
524 			break;
525 	}
526 
527 	if (entry->status & ATIF_PROBE_FAIL) {
528 		entry->expires_at = jiffies - 1; /* free the entry */
529 		retval = -EADDRINUSE; /* return network full */
530 	} else { /* clear the probing flag */
531 		entry->status &= ~ATIF_PROBE;
532 		retval = 1;
533 	}
534 
535 	write_unlock_bh(&aarp_lock);
536 out:
537 	return retval;
538 }
539 
540 /* Send a DDP frame */
541 int aarp_send_ddp(struct net_device *dev, struct sk_buff *skb,
542 		  struct atalk_addr *sa, void *hwaddr)
543 {
544 	static char ddp_eth_multicast[ETH_ALEN] =
545 		{ 0x09, 0x00, 0x07, 0xFF, 0xFF, 0xFF };
546 	int hash;
547 	struct aarp_entry *a;
548 
549 	skb_reset_network_header(skb);
550 
551 	/* Check for LocalTalk first */
552 	if (dev->type == ARPHRD_LOCALTLK) {
553 		struct atalk_addr *at = atalk_find_dev_addr(dev);
554 		struct ddpehdr *ddp = (struct ddpehdr *)skb->data;
555 		int ft = 2;
556 
557 		/*
558 		 * Compressible ?
559 		 *
560 		 * IFF: src_net == dest_net == device_net
561 		 * (zero matches anything)
562 		 */
563 
564 		if ((!ddp->deh_snet || at->s_net == ddp->deh_snet) &&
565 		    (!ddp->deh_dnet || at->s_net == ddp->deh_dnet)) {
566 			skb_pull(skb, sizeof(*ddp) - 4);
567 
568 			/*
569 			 *	The upper two remaining bytes are the port
570 			 *	numbers	we just happen to need. Now put the
571 			 *	length in the lower two.
572 			 */
573 			*((__be16 *)skb->data) = htons(skb->len);
574 			ft = 1;
575 		}
576 		/*
577 		 * Nice and easy. No AARP type protocols occur here so we can
578 		 * just shovel it out with a 3 byte LLAP header
579 		 */
580 
581 		skb_push(skb, 3);
582 		skb->data[0] = sa->s_node;
583 		skb->data[1] = at->s_node;
584 		skb->data[2] = ft;
585 		skb->dev     = dev;
586 		goto sendit;
587 	}
588 
589 	/* On a PPP link we neither compress nor aarp.  */
590 	if (dev->type == ARPHRD_PPP) {
591 		skb->protocol = htons(ETH_P_PPPTALK);
592 		skb->dev = dev;
593 		goto sendit;
594 	}
595 
596 	/* Non ELAP we cannot do. */
597 	if (dev->type != ARPHRD_ETHER)
598 		return -1;
599 
600 	skb->dev = dev;
601 	skb->protocol = htons(ETH_P_ATALK);
602 	hash = sa->s_node % (AARP_HASH_SIZE - 1);
603 
604 	/* Do we have a resolved entry? */
605 	if (sa->s_node == ATADDR_BCAST) {
606 		/* Send it */
607 		ddp_dl->request(ddp_dl, skb, ddp_eth_multicast);
608 		goto sent;
609 	}
610 
611 	write_lock_bh(&aarp_lock);
612 	a = __aarp_find_entry(resolved[hash], dev, sa);
613 
614 	if (a) { /* Return 1 and fill in the address */
615 		a->expires_at = jiffies + (sysctl_aarp_expiry_time * 10);
616 		ddp_dl->request(ddp_dl, skb, a->hwaddr);
617 		write_unlock_bh(&aarp_lock);
618 		goto sent;
619 	}
620 
621 	/* Do we have an unresolved entry: This is the less common path */
622 	a = __aarp_find_entry(unresolved[hash], dev, sa);
623 	if (a) { /* Queue onto the unresolved queue */
624 		skb_queue_tail(&a->packet_queue, skb);
625 		goto out_unlock;
626 	}
627 
628 	/* Allocate a new entry */
629 	a = aarp_alloc();
630 	if (!a) {
631 		/* Whoops slipped... good job it's an unreliable protocol 8) */
632 		write_unlock_bh(&aarp_lock);
633 		return -1;
634 	}
635 
636 	/* Set up the queue */
637 	skb_queue_tail(&a->packet_queue, skb);
638 	a->expires_at	 = jiffies + sysctl_aarp_resolve_time;
639 	a->dev		 = dev;
640 	a->next		 = unresolved[hash];
641 	a->target_addr	 = *sa;
642 	a->xmit_count	 = 0;
643 	unresolved[hash] = a;
644 	unresolved_count++;
645 
646 	/* Send an initial request for the address */
647 	__aarp_send_query(a);
648 
649 	/*
650 	 * Switch to fast timer if needed (That is if this is the first
651 	 * unresolved entry to get added)
652 	 */
653 
654 	if (unresolved_count == 1)
655 		mod_timer(&aarp_timer, jiffies + sysctl_aarp_tick_time);
656 
657 	/* Now finally, it is safe to drop the lock. */
658 out_unlock:
659 	write_unlock_bh(&aarp_lock);
660 
661 	/* Tell the ddp layer we have taken over for this frame. */
662 	return 0;
663 
664 sendit:
665 	if (skb->sk)
666 		skb->priority = skb->sk->sk_priority;
667 	dev_queue_xmit(skb);
668 sent:
669 	return 1;
670 }
671 
672 /*
673  *	An entry in the aarp unresolved queue has become resolved. Send
674  *	all the frames queued under it.
675  *
676  *	Must run under aarp_lock.
677  */
678 static void __aarp_resolved(struct aarp_entry **list, struct aarp_entry *a,
679 			    int hash)
680 {
681 	struct sk_buff *skb;
682 
683 	while (*list)
684 		if (*list == a) {
685 			unresolved_count--;
686 			*list = a->next;
687 
688 			/* Move into the resolved list */
689 			a->next = resolved[hash];
690 			resolved[hash] = a;
691 
692 			/* Kick frames off */
693 			while ((skb = skb_dequeue(&a->packet_queue)) != NULL) {
694 				a->expires_at = jiffies +
695 						sysctl_aarp_expiry_time * 10;
696 				ddp_dl->request(ddp_dl, skb, a->hwaddr);
697 			}
698 		} else
699 			list = &((*list)->next);
700 }
701 
702 /*
703  *	This is called by the SNAP driver whenever we see an AARP SNAP
704  *	frame. We currently only support Ethernet.
705  */
706 static int aarp_rcv(struct sk_buff *skb, struct net_device *dev,
707 		    struct packet_type *pt, struct net_device *orig_dev)
708 {
709 	struct elapaarp *ea = aarp_hdr(skb);
710 	int hash, ret = 0;
711 	__u16 function;
712 	struct aarp_entry *a;
713 	struct atalk_addr sa, *ma, da;
714 	struct atalk_iface *ifa;
715 
716 	if (dev->nd_net != &init_net)
717 		goto out0;
718 
719 	/* We only do Ethernet SNAP AARP. */
720 	if (dev->type != ARPHRD_ETHER)
721 		goto out0;
722 
723 	/* Frame size ok? */
724 	if (!skb_pull(skb, sizeof(*ea)))
725 		goto out0;
726 
727 	function = ntohs(ea->function);
728 
729 	/* Sanity check fields. */
730 	if (function < AARP_REQUEST || function > AARP_PROBE ||
731 	    ea->hw_len != ETH_ALEN || ea->pa_len != AARP_PA_ALEN ||
732 	    ea->pa_src_zero || ea->pa_dst_zero)
733 		goto out0;
734 
735 	/* Looks good. */
736 	hash = ea->pa_src_node % (AARP_HASH_SIZE - 1);
737 
738 	/* Build an address. */
739 	sa.s_node = ea->pa_src_node;
740 	sa.s_net = ea->pa_src_net;
741 
742 	/* Process the packet. Check for replies of me. */
743 	ifa = atalk_find_dev(dev);
744 	if (!ifa)
745 		goto out1;
746 
747 	if (ifa->status & ATIF_PROBE &&
748 	    ifa->address.s_node == ea->pa_dst_node &&
749 	    ifa->address.s_net == ea->pa_dst_net) {
750 		ifa->status |= ATIF_PROBE_FAIL; /* Fail the probe (in use) */
751 		goto out1;
752 	}
753 
754 	/* Check for replies of proxy AARP entries */
755 	da.s_node = ea->pa_dst_node;
756 	da.s_net  = ea->pa_dst_net;
757 
758 	write_lock_bh(&aarp_lock);
759 	a = __aarp_find_entry(proxies[hash], dev, &da);
760 
761 	if (a && a->status & ATIF_PROBE) {
762 		a->status |= ATIF_PROBE_FAIL;
763 		/*
764 		 * we do not respond to probe or request packets for
765 		 * this address while we are probing this address
766 		 */
767 		goto unlock;
768 	}
769 
770 	switch (function) {
771 		case AARP_REPLY:
772 			if (!unresolved_count)	/* Speed up */
773 				break;
774 
775 			/* Find the entry.  */
776 			a = __aarp_find_entry(unresolved[hash], dev, &sa);
777 			if (!a || dev != a->dev)
778 				break;
779 
780 			/* We can fill one in - this is good. */
781 			memcpy(a->hwaddr, ea->hw_src, ETH_ALEN);
782 			__aarp_resolved(&unresolved[hash], a, hash);
783 			if (!unresolved_count)
784 				mod_timer(&aarp_timer,
785 					  jiffies + sysctl_aarp_expiry_time);
786 			break;
787 
788 		case AARP_REQUEST:
789 		case AARP_PROBE:
790 
791 			/*
792 			 * If it is my address set ma to my address and reply.
793 			 * We can treat probe and request the same.  Probe
794 			 * simply means we shouldn't cache the querying host,
795 			 * as in a probe they are proposing an address not
796 			 * using one.
797 			 *
798 			 * Support for proxy-AARP added. We check if the
799 			 * address is one of our proxies before we toss the
800 			 * packet out.
801 			 */
802 
803 			sa.s_node = ea->pa_dst_node;
804 			sa.s_net  = ea->pa_dst_net;
805 
806 			/* See if we have a matching proxy. */
807 			ma = __aarp_proxy_find(dev, &sa);
808 			if (!ma)
809 				ma = &ifa->address;
810 			else { /* We need to make a copy of the entry. */
811 				da.s_node = sa.s_node;
812 				da.s_net = da.s_net;
813 				ma = &da;
814 			}
815 
816 			if (function == AARP_PROBE) {
817 				/*
818 				 * A probe implies someone trying to get an
819 				 * address. So as a precaution flush any
820 				 * entries we have for this address.
821 				 */
822 				struct aarp_entry *a;
823 
824 				a = __aarp_find_entry(resolved[sa.s_node %
825 							  (AARP_HASH_SIZE - 1)],
826 						      skb->dev, &sa);
827 
828 				/*
829 				 * Make it expire next tick - that avoids us
830 				 * getting into a probe/flush/learn/probe/
831 				 * flush/learn cycle during probing of a slow
832 				 * to respond host addr.
833 				 */
834 				if (a) {
835 					a->expires_at = jiffies - 1;
836 					mod_timer(&aarp_timer, jiffies +
837 							sysctl_aarp_tick_time);
838 				}
839 			}
840 
841 			if (sa.s_node != ma->s_node)
842 				break;
843 
844 			if (sa.s_net && ma->s_net && sa.s_net != ma->s_net)
845 				break;
846 
847 			sa.s_node = ea->pa_src_node;
848 			sa.s_net = ea->pa_src_net;
849 
850 			/* aarp_my_address has found the address to use for us.
851 			*/
852 			aarp_send_reply(dev, ma, &sa, ea->hw_src);
853 			break;
854 	}
855 
856 unlock:
857 	write_unlock_bh(&aarp_lock);
858 out1:
859 	ret = 1;
860 out0:
861 	kfree_skb(skb);
862 	return ret;
863 }
864 
865 static struct notifier_block aarp_notifier = {
866 	.notifier_call = aarp_device_event,
867 };
868 
869 static unsigned char aarp_snap_id[] = { 0x00, 0x00, 0x00, 0x80, 0xF3 };
870 
871 void __init aarp_proto_init(void)
872 {
873 	aarp_dl = register_snap_client(aarp_snap_id, aarp_rcv);
874 	if (!aarp_dl)
875 		printk(KERN_CRIT "Unable to register AARP with SNAP.\n");
876 	init_timer(&aarp_timer);
877 	aarp_timer.function = aarp_expire_timeout;
878 	aarp_timer.data	    = 0;
879 	aarp_timer.expires  = jiffies + sysctl_aarp_expiry_time;
880 	add_timer(&aarp_timer);
881 	register_netdevice_notifier(&aarp_notifier);
882 }
883 
884 /* Remove the AARP entries associated with a device. */
885 void aarp_device_down(struct net_device *dev)
886 {
887 	int ct;
888 
889 	write_lock_bh(&aarp_lock);
890 
891 	for (ct = 0; ct < AARP_HASH_SIZE; ct++) {
892 		__aarp_expire_device(&resolved[ct], dev);
893 		__aarp_expire_device(&unresolved[ct], dev);
894 		__aarp_expire_device(&proxies[ct], dev);
895 	}
896 
897 	write_unlock_bh(&aarp_lock);
898 }
899 
900 #ifdef CONFIG_PROC_FS
901 struct aarp_iter_state {
902 	int bucket;
903 	struct aarp_entry **table;
904 };
905 
906 /*
907  * Get the aarp entry that is in the chain described
908  * by the iterator.
909  * If pos is set then skip till that index.
910  * pos = 1 is the first entry
911  */
912 static struct aarp_entry *iter_next(struct aarp_iter_state *iter, loff_t *pos)
913 {
914 	int ct = iter->bucket;
915 	struct aarp_entry **table = iter->table;
916 	loff_t off = 0;
917 	struct aarp_entry *entry;
918 
919  rescan:
920 	while(ct < AARP_HASH_SIZE) {
921 		for (entry = table[ct]; entry; entry = entry->next) {
922 			if (!pos || ++off == *pos) {
923 				iter->table = table;
924 				iter->bucket = ct;
925 				return entry;
926 			}
927 		}
928 		++ct;
929 	}
930 
931 	if (table == resolved) {
932 		ct = 0;
933 		table = unresolved;
934 		goto rescan;
935 	}
936 	if (table == unresolved) {
937 		ct = 0;
938 		table = proxies;
939 		goto rescan;
940 	}
941 	return NULL;
942 }
943 
944 static void *aarp_seq_start(struct seq_file *seq, loff_t *pos)
945 {
946 	struct aarp_iter_state *iter = seq->private;
947 
948 	read_lock_bh(&aarp_lock);
949 	iter->table     = resolved;
950 	iter->bucket    = 0;
951 
952 	return *pos ? iter_next(iter, pos) : SEQ_START_TOKEN;
953 }
954 
955 static void *aarp_seq_next(struct seq_file *seq, void *v, loff_t *pos)
956 {
957 	struct aarp_entry *entry = v;
958 	struct aarp_iter_state *iter = seq->private;
959 
960 	++*pos;
961 
962 	/* first line after header */
963 	if (v == SEQ_START_TOKEN)
964 		entry = iter_next(iter, NULL);
965 
966 	/* next entry in current bucket */
967 	else if (entry->next)
968 		entry = entry->next;
969 
970 	/* next bucket or table */
971 	else {
972 		++iter->bucket;
973 		entry = iter_next(iter, NULL);
974 	}
975 	return entry;
976 }
977 
978 static void aarp_seq_stop(struct seq_file *seq, void *v)
979 {
980 	read_unlock_bh(&aarp_lock);
981 }
982 
983 static const char *dt2str(unsigned long ticks)
984 {
985 	static char buf[32];
986 
987 	sprintf(buf, "%ld.%02ld", ticks / HZ, ((ticks % HZ) * 100 ) / HZ);
988 
989 	return buf;
990 }
991 
992 static int aarp_seq_show(struct seq_file *seq, void *v)
993 {
994 	struct aarp_iter_state *iter = seq->private;
995 	struct aarp_entry *entry = v;
996 	unsigned long now = jiffies;
997 
998 	if (v == SEQ_START_TOKEN)
999 		seq_puts(seq,
1000 			 "Address  Interface   Hardware Address"
1001 			 "   Expires LastSend  Retry Status\n");
1002 	else {
1003 		seq_printf(seq, "%04X:%02X  %-12s",
1004 			   ntohs(entry->target_addr.s_net),
1005 			   (unsigned int) entry->target_addr.s_node,
1006 			   entry->dev ? entry->dev->name : "????");
1007 		seq_printf(seq, "%02X:%02X:%02X:%02X:%02X:%02X",
1008 			   entry->hwaddr[0] & 0xFF,
1009 			   entry->hwaddr[1] & 0xFF,
1010 			   entry->hwaddr[2] & 0xFF,
1011 			   entry->hwaddr[3] & 0xFF,
1012 			   entry->hwaddr[4] & 0xFF,
1013 			   entry->hwaddr[5] & 0xFF);
1014 		seq_printf(seq, " %8s",
1015 			   dt2str((long)entry->expires_at - (long)now));
1016 		if (iter->table == unresolved)
1017 			seq_printf(seq, " %8s %6hu",
1018 				   dt2str(now - entry->last_sent),
1019 				   entry->xmit_count);
1020 		else
1021 			seq_puts(seq, "                ");
1022 		seq_printf(seq, " %s\n",
1023 			   (iter->table == resolved) ? "resolved"
1024 			   : (iter->table == unresolved) ? "unresolved"
1025 			   : (iter->table == proxies) ? "proxies"
1026 			   : "unknown");
1027 	}
1028 	return 0;
1029 }
1030 
1031 static const struct seq_operations aarp_seq_ops = {
1032 	.start  = aarp_seq_start,
1033 	.next   = aarp_seq_next,
1034 	.stop   = aarp_seq_stop,
1035 	.show   = aarp_seq_show,
1036 };
1037 
1038 static int aarp_seq_open(struct inode *inode, struct file *file)
1039 {
1040 	struct seq_file *seq;
1041 	int rc = -ENOMEM;
1042 	struct aarp_iter_state *s = kmalloc(sizeof(*s), GFP_KERNEL);
1043 
1044 	if (!s)
1045 		goto out;
1046 
1047 	rc = seq_open(file, &aarp_seq_ops);
1048 	if (rc)
1049 		goto out_kfree;
1050 
1051 	seq	     = file->private_data;
1052 	seq->private = s;
1053 	memset(s, 0, sizeof(*s));
1054 out:
1055 	return rc;
1056 out_kfree:
1057 	kfree(s);
1058 	goto out;
1059 }
1060 
1061 const struct file_operations atalk_seq_arp_fops = {
1062 	.owner		= THIS_MODULE,
1063 	.open           = aarp_seq_open,
1064 	.read           = seq_read,
1065 	.llseek         = seq_lseek,
1066 	.release	= seq_release_private,
1067 };
1068 #endif
1069 
1070 /* General module cleanup. Called from cleanup_module() in ddp.c. */
1071 void aarp_cleanup_module(void)
1072 {
1073 	del_timer_sync(&aarp_timer);
1074 	unregister_netdevice_notifier(&aarp_notifier);
1075 	unregister_snap_client(aarp_dl);
1076 	aarp_purge();
1077 }
1078