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