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