qio: Track the amount of bytes read
[akaros.git] / kern / src / net / ethermedium.c
1 /* Copyright © 1994-1999 Lucent Technologies Inc.  All rights reserved.
2  * Portions Copyright © 1997-1999 Vita Nuova Limited
3  * Portions Copyright © 2000-2007 Vita Nuova Holdings Limited
4  *                                (www.vitanuova.com)
5  * Revisions Copyright © 2000-2007 Lucent Technologies Inc. and others
6  *
7  * Modified for the Akaros operating system:
8  * Copyright (c) 2013-2014 The Regents of the University of California
9  * Copyright (c) 2013-2015 Google Inc.
10  *
11  * Permission is hereby granted, free of charge, to any person obtaining a copy
12  * of this software and associated documentation files (the "Software"), to deal
13  * in the Software without restriction, including without limitation the rights
14  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
15  * copies of the Software, and to permit persons to whom the Software is
16  * furnished to do so, subject to the following conditions:
17  *
18  * The above copyright notice and this permission notice shall be included in
19  * all copies or substantial portions of the Software.
20  *
21  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
22  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
23  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL THE
24  * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
25  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
26  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
27  * SOFTWARE. */
28
29 #include <vfs.h>
30 #include <kfs.h>
31 #include <slab.h>
32 #include <kmalloc.h>
33 #include <kref.h>
34 #include <string.h>
35 #include <stdio.h>
36 #include <assert.h>
37 #include <error.h>
38 #include <cpio.h>
39 #include <pmap.h>
40 #include <smp.h>
41 #include <ip.h>
42
43 typedef struct Etherhdr Etherhdr;
44 struct Etherhdr {
45         uint8_t d[6];
46         uint8_t s[6];
47         uint8_t t[2];
48 };
49
50 static uint8_t ipbroadcast[IPaddrlen] = {
51         0xff, 0xff, 0xff, 0xff,
52         0xff, 0xff, 0xff, 0xff,
53         0xff, 0xff, 0xff, 0xff,
54         0xff, 0xff, 0xff, 0xff,
55 };
56
57 static uint8_t etherbroadcast[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
58
59 static void etherread4(void *a);
60 static void etherread6(void *a);
61 static void etherbind(struct Ipifc *ifc, int argc, char **argv);
62 static void etherunbind(struct Ipifc *ifc);
63 static void etherbwrite(struct Ipifc *ifc, struct block *bp, int version,
64                                                 uint8_t * ip);
65 static void etheraddmulti(struct Ipifc *ifc, uint8_t * a, uint8_t * ia);
66 static void etherremmulti(struct Ipifc *ifc, uint8_t * a, uint8_t * ia);
67 static struct block *multicastarp(struct Fs *f, struct arpent *a,
68                                                                   struct medium *, uint8_t * mac);
69 static void sendarp(struct Ipifc *ifc, struct arpent *a);
70 static void sendgarp(struct Ipifc *ifc, uint8_t * unused_uint8_p_t);
71 static int multicastea(uint8_t * ea, uint8_t * ip);
72 static void recvarpproc(void *);
73 static void resolveaddr6(struct Ipifc *ifc, struct arpent *a);
74 static void etherpref2addr(uint8_t * pref, uint8_t * ea);
75
76 struct medium ethermedium = {
77         .name = "ether",
78         .hsize = 14,
79         .mintu = 60,
80         .maxtu = 1514,
81         .maclen = 6,
82         .bind = etherbind,
83         .unbind = etherunbind,
84         .bwrite = etherbwrite,
85         .addmulti = etheraddmulti,
86         .remmulti = etherremmulti,
87         .ares = arpenter,
88         .areg = sendgarp,
89         .pref2addr = etherpref2addr,
90 };
91
92 struct medium trexmedium = {
93         .name = "trex",
94         .hsize = 14,
95         .mintu = 60,
96         .maxtu = 1514,
97         .maclen = 6,
98         .bind = etherbind,
99         .unbind = etherunbind,
100         .bwrite = etherbwrite,
101         .addmulti = etheraddmulti,
102         .remmulti = etherremmulti,
103         .ares = arpenter,
104         .areg = sendgarp,
105         .pref2addr = etherpref2addr,
106 };
107
108 typedef struct Etherrock Etherrock;
109 struct Etherrock {
110         struct Fs *f;                           /* file system we belong to */
111         struct proc *arpp;                      /* arp process */
112         struct proc *read4p;            /* reading process (v4) */
113         struct proc *read6p;            /* reading process (v6) */
114         struct chan *mchan4;            /* Data channel for v4 */
115         struct chan *achan;                     /* Arp channel */
116         struct chan *cchan4;            /* Control channel for v4 */
117         struct chan *mchan6;            /* Data channel for v6 */
118         struct chan *cchan6;            /* Control channel for v6 */
119 };
120
121 /*
122  *  ethernet arp request
123  */
124 enum {
125         ETARP = 0x0806,
126         ETIP4 = 0x0800,
127         ETIP6 = 0x86DD,
128         ARPREQUEST = 1,
129         ARPREPLY = 2,
130 };
131
132 typedef struct Etherarp Etherarp;
133 struct Etherarp {
134         uint8_t d[6];
135         uint8_t s[6];
136         uint8_t type[2];
137         uint8_t hrd[2];
138         uint8_t pro[2];
139         uint8_t hln;
140         uint8_t pln;
141         uint8_t op[2];
142         uint8_t sha[6];
143         uint8_t spa[4];
144         uint8_t tha[6];
145         uint8_t tpa[4];
146 };
147
148 static char *nbmsg = "nonblocking";
149
150 static unsigned int parsefeat(char *ptr)
151 {
152         unsigned int feat = 0;
153
154         if (strstr(ptr, "ipck"))
155                 feat |= NETF_IPCK;
156         if (strstr(ptr, "udpck"))
157                 feat |= NETF_UDPCK;
158         if (strstr(ptr, "tcpck"))
159                 feat |= NETF_TCPCK;
160         if (strstr(ptr, "padmin"))
161                 feat |= NETF_PADMIN;
162         if (strstr(ptr, "sg"))
163                 feat |= NETF_SG;
164         if (strstr(ptr, "tso"))
165                 feat |= NETF_TSO;
166         return feat;
167 }
168
169 /*
170  *  called to bind an IP ifc to an ethernet device
171  *  called with ifc wlock'd
172  */
173 static void etherbind(struct Ipifc *ifc, int argc, char **argv)
174 {
175         ERRSTACK(1);
176         struct chan *mchan4, *cchan4, *achan, *mchan6, *cchan6;
177         char *addr, *dir, *buf;
178         int fd, cfd, n;
179         char *ptr;
180         Etherrock *er;
181
182         if (argc < 2)
183                 error(EINVAL, ERROR_FIXME);
184
185         addr = kmalloc(Maxpath, MEM_WAIT);      //char addr[2*KNAMELEN];
186         dir = kmalloc(Maxpath, MEM_WAIT);       //char addr[2*KNAMELEN];
187         mchan4 = cchan4 = achan = mchan6 = cchan6 = NULL;
188         buf = NULL;
189         if (waserror()) {
190                 if (mchan4 != NULL)
191                         cclose(mchan4);
192                 if (cchan4 != NULL)
193                         cclose(cchan4);
194                 if (achan != NULL)
195                         cclose(achan);
196                 if (mchan6 != NULL)
197                         cclose(mchan6);
198                 if (cchan6 != NULL)
199                         cclose(cchan6);
200                 if (buf != NULL)
201                         kfree(buf);
202                 kfree(addr);
203                 kfree(dir);
204                 nexterror();
205         }
206
207         /*
208          *  open ip converstation
209          *
210          *  the dial will fail if the type is already open on
211          *  this device.
212          */
213         snprintf(addr, Maxpath, "%s!0x800", argv[2]);
214         fd = kdial(addr, NULL, dir, &cfd);
215         if (fd < 0)
216                 error(EFAIL, "dial 0x800 failed: %s", get_cur_errbuf());
217         mchan4 = commonfdtochan(fd, O_RDWR, 0, 1);
218         cchan4 = commonfdtochan(cfd, O_RDWR, 0, 1);
219         sysclose(fd);
220         sysclose(cfd);
221
222         /*
223          *  make it non-blocking
224          */
225         devtab[cchan4->type].write(cchan4, nbmsg, strlen(nbmsg), 0);
226
227         /*
228          *  get mac address and speed
229          */
230         snprintf(addr, Maxpath, "%s/stats", dir);
231         fd = sysopen(addr, O_READ);
232         if (fd < 0)
233                 error(EFAIL, "can't open ether stats: %s", get_cur_errbuf());
234
235         buf = kzmalloc(512, 0);
236         n = sysread(fd, buf, 511);
237         sysclose(fd);
238         if (n <= 0)
239                 error(EIO, ERROR_FIXME);
240         buf[n] = 0;
241
242         ptr = strstr(buf, "addr: ");
243         if (!ptr)
244                 error(EIO, ERROR_FIXME);
245         ptr += 6;
246         parsemac(ifc->mac, ptr, 6);
247
248         ptr = strstr(buf, "mbps: ");
249         if (ptr) {
250                 ptr += 6;
251                 ifc->mbps = atoi(ptr);
252         } else
253                 ifc->mbps = 100;
254
255
256         ptr = strstr(buf, "feat: ");
257         if (ptr) {
258                 ptr += 6;
259                 ifc->feat = parsefeat(ptr);
260         } else {
261                 ifc->feat = 0;
262         }
263         /*
264          *  open arp conversation
265          */
266         snprintf(addr, Maxpath, "%s!0x806", argv[2]);
267         fd = kdial(addr, NULL, NULL, NULL);
268         if (fd < 0)
269                 error(EFAIL, "dial 0x806 failed: %s", get_cur_errbuf());
270         achan = commonfdtochan(fd, O_RDWR, 0, 1);
271         sysclose(fd);
272
273         /*
274          *  open ip conversation
275          *
276          *  the dial will fail if the type is already open on
277          *  this device.
278          */
279         snprintf(addr, Maxpath, "%s!0x86DD", argv[2]);
280         fd = kdial(addr, NULL, dir, &cfd);
281         if (fd < 0)
282                 error(EFAIL, "dial 0x86DD failed: %s", get_cur_errbuf());
283         mchan6 = commonfdtochan(fd, O_RDWR, 0, 1);
284         cchan6 = commonfdtochan(cfd, O_RDWR, 0, 1);
285         sysclose(fd);
286         sysclose(cfd);
287
288         /*
289          *  make it non-blocking
290          */
291         devtab[cchan6->type].write(cchan6, nbmsg, strlen(nbmsg), 0);
292
293         er = kzmalloc(sizeof(*er), 0);
294         er->mchan4 = mchan4;
295         er->cchan4 = cchan4;
296         er->achan = achan;
297         er->mchan6 = mchan6;
298         er->cchan6 = cchan6;
299         er->f = ifc->conv->p->f;
300         ifc->arg = er;
301
302         kfree(buf);
303         kfree(addr);
304         kfree(dir);
305         poperror();
306
307         ktask("etherread4", etherread4, ifc);
308         ktask("recvarpproc", recvarpproc, ifc);
309         ktask("etherread6", etherread6, ifc);
310 }
311
312 /*
313  *  called with ifc wlock'd
314  */
315 static void etherunbind(struct Ipifc *ifc)
316 {
317         Etherrock *er = ifc->arg;
318         printk("[kernel] etherunbind not supported yet!\n");
319
320         // we'll need to tell the ktasks to exit, maybe via flags and a wakeup
321 #if 0
322         if (er->read4p)
323                 postnote(er->read4p, 1, "unbind", 0);
324         if (er->read6p)
325                 postnote(er->read6p, 1, "unbind", 0);
326         if (er->arpp)
327                 postnote(er->arpp, 1, "unbind", 0);
328 #endif
329
330         /* wait for readers to die */
331         while (er->arpp != 0 || er->read4p != 0 || er->read6p != 0)
332                 cpu_relax();
333         kthread_usleep(300 * 1000);
334
335         if (er->mchan4 != NULL)
336                 cclose(er->mchan4);
337         if (er->achan != NULL)
338                 cclose(er->achan);
339         if (er->cchan4 != NULL)
340                 cclose(er->cchan4);
341         if (er->mchan6 != NULL)
342                 cclose(er->mchan6);
343         if (er->cchan6 != NULL)
344                 cclose(er->cchan6);
345
346         kfree(er);
347 }
348
349 /*
350  * copy ethernet address
351  */
352 static inline void etherfilladdr(uint16_t *pkt, uint16_t *dst, uint16_t *src)
353 {
354         *pkt++ = *dst++;
355         *pkt++ = *dst++;
356         *pkt++ = *dst++;
357         *pkt++ = *src++;
358         *pkt++ = *src++;
359         *pkt = *src;
360 }
361
362 /*
363  *  called by ipoput with a single block to write with ifc rlock'd
364  */
365 static void
366 etherbwrite(struct Ipifc *ifc, struct block *bp, int version, uint8_t * ip)
367 {
368         Etherhdr *eh;
369         struct arpent *a;
370         uint8_t mac[6];
371         Etherrock *er = ifc->arg;
372
373         ipifc_trace_block(ifc, bp);
374         /* get mac address of destination.
375          *
376          * Locking is tricky here.  If we get arpent 'a' back, the f->arp is
377          * qlocked.  if multicastarp returns bp, then it unlocked it for us.  if
378          * not, sendarp or resolveaddr6 unlocked it for us.  yikes. */
379         a = arpget(er->f->arp, bp, version, ifc, ip, mac);
380         if (a) {
381                 /* check for broadcast or multicast.  if it is either, this sorts that
382                  * out and returns the bp for the first packet on the arp's hold list.*/
383                 bp = multicastarp(er->f, a, ifc->m, mac);
384                 if (bp == NULL) {
385                         switch (version) {
386                                 case V4:
387                                         sendarp(ifc, a);
388                                         break;
389                                 case V6:
390                                         resolveaddr6(ifc, a);
391                                         break;
392                                 default:
393                                         panic("etherbwrite: version %d", version);
394                         }
395                         return;
396                 }
397         }
398
399         /* make it a single block with space for the ether header */
400         bp = padblock(bp, ifc->m->hsize);
401         if (bp->next)
402                 bp = concatblock(bp);
403         eh = (Etherhdr *) bp->rp;
404
405         /* copy in mac addresses and ether type */
406         etherfilladdr((uint16_t *)bp->rp, (uint16_t *)mac, (uint16_t *)ifc->mac);
407
408         switch (version) {
409                 case V4:
410                         eh->t[0] = 0x08;
411                         eh->t[1] = 0x00;
412                         devtab[er->mchan4->type].bwrite(er->mchan4, bp, 0);
413                         break;
414                 case V6:
415                         eh->t[0] = 0x86;
416                         eh->t[1] = 0xDD;
417                         devtab[er->mchan6->type].bwrite(er->mchan6, bp, 0);
418                         break;
419                 default:
420                         panic("etherbwrite2: version %d", version);
421         }
422         ifc->out++;
423 }
424
425 /*
426  *  process to read from the ethernet
427  */
428 static void etherread4(void *a)
429 {
430         ERRSTACK(2);
431         struct Ipifc *ifc;
432         struct block *bp;
433         Etherrock *er;
434
435         ifc = a;
436         er = ifc->arg;
437         er->read4p = current;   /* hide identity under a rock for unbind */
438         if (waserror()) {
439                 er->read4p = 0;
440                 poperror();
441                 warn("etherread4 returns, probably unexpectedly\n");
442                 return;
443         }
444         for (;;) {
445                 bp = devtab[er->mchan4->type].bread(er->mchan4, 128 * 1024, 0);
446                 if (!canrlock(&ifc->rwlock)) {
447                         freeb(bp);
448                         continue;
449                 }
450                 if (waserror()) {
451                         runlock(&ifc->rwlock);
452                         nexterror();
453                 }
454                 ifc->in++;
455                 bp->rp += ifc->m->hsize;
456                 if (ifc->lifc == NULL) {
457                         freeb(bp);
458                 } else {
459                         ipifc_trace_block(ifc, bp);
460                         ipiput4(er->f, ifc, bp);
461                 }
462                 runlock(&ifc->rwlock);
463                 poperror();
464         }
465         poperror();
466 }
467
468 /*
469  *  process to read from the ethernet, IPv6
470  */
471 static void etherread6(void *a)
472 {
473         ERRSTACK(2);
474         struct Ipifc *ifc;
475         struct block *bp;
476         Etherrock *er;
477
478         ifc = a;
479         er = ifc->arg;
480         er->read6p = current;   /* hide identity under a rock for unbind */
481         if (waserror()) {
482                 er->read6p = 0;
483                 warn("etherread6 returns, probably unexpectedly\n");
484                 poperror();
485                 return;
486         }
487         for (;;) {
488                 bp = devtab[er->mchan6->type].bread(er->mchan6, ifc->maxtu, 0);
489                 if (!canrlock(&ifc->rwlock)) {
490                         freeb(bp);
491                         continue;
492                 }
493                 if (waserror()) {
494                         runlock(&ifc->rwlock);
495                         nexterror();
496                 }
497                 ifc->in++;
498                 bp->rp += ifc->m->hsize;
499                 if (ifc->lifc == NULL) {
500                         freeb(bp);
501                 } else {
502                         ipifc_trace_block(ifc, bp);
503                         ipiput6(er->f, ifc, bp);
504                 }
505                 runlock(&ifc->rwlock);
506                 poperror();
507         }
508         poperror();
509 }
510
511 static void etheraddmulti(struct Ipifc *ifc, uint8_t * a, uint8_t * unused)
512 {
513         uint8_t mac[6];
514         char buf[64];
515         Etherrock *er = ifc->arg;
516         int version;
517
518         version = multicastea(mac, a);
519         snprintf(buf, sizeof(buf), "addmulti %E", mac);
520         switch (version) {
521                 case V4:
522                         devtab[er->cchan4->type].write(er->cchan4, buf, strlen(buf), 0);
523                         break;
524                 case V6:
525                         devtab[er->cchan6->type].write(er->cchan6, buf, strlen(buf), 0);
526                         break;
527                 default:
528                         panic("etheraddmulti: version %d", version);
529         }
530 }
531
532 static void etherremmulti(struct Ipifc *ifc, uint8_t * a, uint8_t * unused)
533 {
534         uint8_t mac[6];
535         char buf[64];
536         Etherrock *er = ifc->arg;
537         int version;
538
539         version = multicastea(mac, a);
540         snprintf(buf, sizeof(buf), "remmulti %E", mac);
541         switch (version) {
542                 case V4:
543                         devtab[er->cchan4->type].write(er->cchan4, buf, strlen(buf), 0);
544                         break;
545                 case V6:
546                         devtab[er->cchan6->type].write(er->cchan6, buf, strlen(buf), 0);
547                         break;
548                 default:
549                         panic("etherremmulti: version %d", version);
550         }
551 }
552
553 /*
554  *  send an ethernet arp
555  *  (only v4, v6 uses the neighbor discovery, rfc1970)
556  *
557  * May drop packets on stale arps. */
558 static void sendarp(struct Ipifc *ifc, struct arpent *a)
559 {
560         int n;
561         struct block *bp;
562         Etherarp *e;
563         Etherrock *er = ifc->arg;
564
565         /* don't do anything if it's been less than a second since the last.  ctime
566          * is set to 0 for the first time through.  we hold the f->arp qlock, so
567          * there shouldn't be a problem with another arp request for this same
568          * arpent coming down til we update ctime again. */
569         if (NOW - a->ctime < 1000) {
570                 arprelease(er->f->arp, a);
571                 return;
572         }
573
574         /* remove all but the last message.  brho: this might be unnecessary.  we'll
575          * eventually send them.  but they should be quite stale at this point. */
576         while ((bp = a->hold) != NULL) {
577                 if (bp == a->last)
578                         break;
579                 a->hold = bp->list;
580                 freeblist(bp);
581         }
582
583         /* update last sent time */
584         a->ctime = NOW;
585         arprelease(er->f->arp, a);
586
587         n = sizeof(Etherarp);
588         if (n < a->type->mintu)
589                 n = a->type->mintu;
590         bp = block_alloc(n, MEM_WAIT);
591         memset(bp->rp, 0, n);
592         e = (Etherarp *) bp->rp;
593         memmove(e->tpa, a->ip + IPv4off, sizeof(e->tpa));
594         ipv4local(ifc, e->spa);
595         memmove(e->sha, ifc->mac, sizeof(e->sha));
596         memset(e->d, 0xff, sizeof(e->d));       /* ethernet broadcast */
597         memmove(e->s, ifc->mac, sizeof(e->s));
598
599         hnputs(e->type, ETARP);
600         hnputs(e->hrd, 1);
601         hnputs(e->pro, ETIP4);
602         e->hln = sizeof(e->sha);
603         e->pln = sizeof(e->spa);
604         hnputs(e->op, ARPREQUEST);
605         bp->wp += n;
606
607         n = devtab[er->achan->type].bwrite(er->achan, bp, 0);
608         if (n < 0)
609                 printd("arp: send: %r\n");
610 }
611
612 static void resolveaddr6(struct Ipifc *ifc, struct arpent *a)
613 {
614         int sflag;
615         struct block *bp;
616         Etherrock *er = ifc->arg;
617         uint8_t ipsrc[IPaddrlen];
618
619         /* don't do anything if it's been less than a second since the last */
620         if (NOW - a->ctime < ReTransTimer) {
621                 arprelease(er->f->arp, a);
622                 return;
623         }
624
625         /* remove all but the last message */
626         while ((bp = a->hold) != NULL) {
627                 if (bp == a->last)
628                         break;
629                 a->hold = bp->list;
630                 freeblist(bp);
631         }
632
633         /* try to keep it around for a second more */
634         a->ctime = NOW;
635         a->rtime = NOW + ReTransTimer;
636         if (a->rxtsrem <= 0) {
637                 arprelease(er->f->arp, a);
638                 return;
639         }
640
641         a->rxtsrem--;
642         arprelease(er->f->arp, a);
643
644         if ((sflag = ipv6anylocal(ifc, ipsrc)))
645                 icmpns(er->f, ipsrc, sflag, a->ip, TARG_MULTI, ifc->mac);
646 }
647
648 /*
649  *  send a gratuitous arp to refresh arp caches
650  */
651 static void sendgarp(struct Ipifc *ifc, uint8_t * ip)
652 {
653         int n;
654         struct block *bp;
655         Etherarp *e;
656         Etherrock *er = ifc->arg;
657
658         /* don't arp for our initial non address */
659         if (ipcmp(ip, IPnoaddr) == 0)
660                 return;
661
662         n = sizeof(Etherarp);
663         if (n < ifc->m->mintu)
664                 n = ifc->m->mintu;
665         bp = block_alloc(n, MEM_WAIT);
666         memset(bp->rp, 0, n);
667         e = (Etherarp *) bp->rp;
668         memmove(e->tpa, ip + IPv4off, sizeof(e->tpa));
669         memmove(e->spa, ip + IPv4off, sizeof(e->spa));
670         memmove(e->sha, ifc->mac, sizeof(e->sha));
671         memset(e->d, 0xff, sizeof(e->d));       /* ethernet broadcast */
672         memmove(e->s, ifc->mac, sizeof(e->s));
673
674         hnputs(e->type, ETARP);
675         hnputs(e->hrd, 1);
676         hnputs(e->pro, ETIP4);
677         e->hln = sizeof(e->sha);
678         e->pln = sizeof(e->spa);
679         hnputs(e->op, ARPREQUEST);
680         bp->wp += n;
681
682         n = devtab[er->achan->type].bwrite(er->achan, bp, 0);
683         if (n < 0)
684                 printd("garp: send: %r\n");
685 }
686
687 static void recvarp(struct Ipifc *ifc)
688 {
689         int n;
690         struct block *ebp, *rbp;
691         Etherarp *e, *r;
692         uint8_t ip[IPaddrlen];
693         static uint8_t eprinted[4];
694         Etherrock *er = ifc->arg;
695
696         ebp = devtab[er->achan->type].bread(er->achan, ifc->maxtu, 0);
697         if (ebp == NULL) {
698                 printd("arp: rcv: %r\n");
699                 return;
700         }
701
702         e = (Etherarp *) ebp->rp;
703         switch (nhgets(e->op)) {
704                 default:
705                         break;
706
707                 case ARPREPLY:
708                         /* check for machine using my ip address */
709                         v4tov6(ip, e->spa);
710                         if (iplocalonifc(ifc, ip) || ipproxyifc(er->f, ifc, ip)) {
711                                 if (memcmp(e->sha, ifc->mac, sizeof(e->sha)) != 0) {
712                                         printd("arprep: 0x%E/0x%E also has ip addr %V\n",
713                                                    e->s, e->sha, e->spa);
714                                         break;
715                                 }
716                         }
717
718                         /* make sure we're not entering broadcast addresses */
719                         if (ipcmp(ip, ipbroadcast) == 0 ||
720                                 !memcmp(e->sha, etherbroadcast, sizeof(e->sha))) {
721                                 printd
722                                         ("arprep: 0x%E/0x%E cannot register broadcast address %I\n",
723                                          e->s, e->sha, e->spa);
724                                 break;
725                         }
726
727                         arpenter(er->f, V4, e->spa, e->sha, sizeof(e->sha), 0);
728                         break;
729
730                 case ARPREQUEST:
731                         /* don't answer arps till we know who we are */
732                         if (ifc->lifc == 0)
733                                 break;
734
735                         /* check for machine using my ip or ether address */
736                         v4tov6(ip, e->spa);
737                         if (iplocalonifc(ifc, ip) || ipproxyifc(er->f, ifc, ip)) {
738                                 if (memcmp(e->sha, ifc->mac, sizeof(e->sha)) != 0) {
739                                         if (memcmp(eprinted, e->spa, sizeof(e->spa))) {
740                                                 /* print only once */
741                                                 printd("arpreq: 0x%E also has ip addr %V\n", e->sha,
742                                                            e->spa);
743                                                 memmove(eprinted, e->spa, sizeof(e->spa));
744                                         }
745                                 }
746                         } else {
747                                 if (memcmp(e->sha, ifc->mac, sizeof(e->sha)) == 0) {
748                                         printd("arpreq: %V also has ether addr %E\n", e->spa,
749                                                    e->sha);
750                                         break;
751                                 }
752                         }
753
754                         /* refresh what we know about sender */
755                         arpenter(er->f, V4, e->spa, e->sha, sizeof(e->sha), 1);
756
757                         /* answer only requests for our address or systems we're proxying for */
758                         v4tov6(ip, e->tpa);
759                         if (!iplocalonifc(ifc, ip))
760                                 if (!ipproxyifc(er->f, ifc, ip))
761                                         break;
762
763                         n = sizeof(Etherarp);
764                         if (n < ifc->mintu)
765                                 n = ifc->mintu;
766                         rbp = block_alloc(n, MEM_WAIT);
767                         r = (Etherarp *) rbp->rp;
768                         memset(r, 0, sizeof(Etherarp));
769                         hnputs(r->type, ETARP);
770                         hnputs(r->hrd, 1);
771                         hnputs(r->pro, ETIP4);
772                         r->hln = sizeof(r->sha);
773                         r->pln = sizeof(r->spa);
774                         hnputs(r->op, ARPREPLY);
775                         memmove(r->tha, e->sha, sizeof(r->tha));
776                         memmove(r->tpa, e->spa, sizeof(r->tpa));
777                         memmove(r->sha, ifc->mac, sizeof(r->sha));
778                         memmove(r->spa, e->tpa, sizeof(r->spa));
779                         memmove(r->d, e->sha, sizeof(r->d));
780                         memmove(r->s, ifc->mac, sizeof(r->s));
781                         rbp->wp += n;
782
783                         n = devtab[er->achan->type].bwrite(er->achan, rbp, 0);
784                         if (n < 0)
785                                 printd("arp: write: %r\n");
786         }
787         freeb(ebp);
788 }
789
790 static void recvarpproc(void *v)
791 {
792         ERRSTACK(1);
793         struct Ipifc *ifc = v;
794         Etherrock *er = ifc->arg;
795
796         er->arpp = current;
797         if (waserror()) {
798                 er->arpp = 0;
799                 warn("recvarpproc returns, probably unexpectedly\n");
800                 poperror();
801                 return;
802         }
803         for (;;)
804                 recvarp(ifc);
805         poperror();
806 }
807
808 static int multicastea(uint8_t * ea, uint8_t * ip)
809 {
810         int x;
811
812         switch (x = ipismulticast(ip)) {
813                 case V4:
814                         ea[0] = 0x01;
815                         ea[1] = 0x00;
816                         ea[2] = 0x5e;
817                         ea[3] = ip[13] & 0x7f;
818                         ea[4] = ip[14];
819                         ea[5] = ip[15];
820                         break;
821                 case V6:
822                         ea[0] = 0x33;
823                         ea[1] = 0x33;
824                         ea[2] = ip[12];
825                         ea[3] = ip[13];
826                         ea[4] = ip[14];
827                         ea[5] = ip[15];
828                         break;
829         }
830         return x;
831 }
832
833 /*
834  *  fill in an arp entry for broadcast or multicast
835  *  addresses.  Return the first queued packet for the
836  *  IP address.
837  */
838 static struct block *multicastarp(struct Fs *f,
839                                                                   struct arpent *a, struct medium *medium,
840                                                                   uint8_t * mac)
841 {
842         /* is it broadcast? */
843         switch (ipforme(f, a->ip)) {
844                 case Runi:
845                         return NULL;
846                 case Rbcast:
847                         memset(mac, 0xff, 6);
848                         return arpresolve(f->arp, a, medium, mac);
849                 default:
850                         break;
851         }
852
853         /* if multicast, fill in mac */
854         switch (multicastea(mac, a->ip)) {
855                 case V4:
856                 case V6:
857                         return arpresolve(f->arp, a, medium, mac);
858         }
859
860         /* let arp take care of it */
861         return NULL;
862 }
863
864 linker_func_4(ethermediumlink)
865 {
866         addipmedium(&ethermedium);
867         addipmedium(&trexmedium);
868 }
869
870 static void etherpref2addr(uint8_t * pref, uint8_t * ea)
871 {
872         pref[8] = ea[0] | 0x2;
873         pref[9] = ea[1];
874         pref[10] = ea[2];
875         pref[11] = 0xFF;
876         pref[12] = 0xFE;
877         pref[13] = ea[3];
878         pref[14] = ea[4];
879         pref[15] = ea[5];
880 }