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