1*83ee113eSDavid van Moolenbroek /* $NetBSD: ethernet.c,v 1.1.1.2 2014/07/12 11:57:43 spz Exp $ */
2*83ee113eSDavid van Moolenbroek /* ethernet.c
3*83ee113eSDavid van Moolenbroek
4*83ee113eSDavid van Moolenbroek Packet assembly code, originally contributed by Archie Cobbs. */
5*83ee113eSDavid van Moolenbroek
6*83ee113eSDavid van Moolenbroek /*
7*83ee113eSDavid van Moolenbroek * Copyright (c) 2004,2007,2009,2014 by Internet Systems Consortium, Inc. ("ISC")
8*83ee113eSDavid van Moolenbroek * Copyright (c) 1996-2003 by Internet Software Consortium
9*83ee113eSDavid van Moolenbroek *
10*83ee113eSDavid van Moolenbroek * Permission to use, copy, modify, and distribute this software for any
11*83ee113eSDavid van Moolenbroek * purpose with or without fee is hereby granted, provided that the above
12*83ee113eSDavid van Moolenbroek * copyright notice and this permission notice appear in all copies.
13*83ee113eSDavid van Moolenbroek *
14*83ee113eSDavid van Moolenbroek * THE SOFTWARE IS PROVIDED "AS IS" AND ISC DISCLAIMS ALL WARRANTIES
15*83ee113eSDavid van Moolenbroek * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
16*83ee113eSDavid van Moolenbroek * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL ISC BE LIABLE FOR
17*83ee113eSDavid van Moolenbroek * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
18*83ee113eSDavid van Moolenbroek * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
19*83ee113eSDavid van Moolenbroek * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT
20*83ee113eSDavid van Moolenbroek * OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
21*83ee113eSDavid van Moolenbroek *
22*83ee113eSDavid van Moolenbroek * Internet Systems Consortium, Inc.
23*83ee113eSDavid van Moolenbroek * 950 Charter Street
24*83ee113eSDavid van Moolenbroek * Redwood City, CA 94063
25*83ee113eSDavid van Moolenbroek * <info@isc.org>
26*83ee113eSDavid van Moolenbroek * https://www.isc.org/
27*83ee113eSDavid van Moolenbroek *
28*83ee113eSDavid van Moolenbroek */
29*83ee113eSDavid van Moolenbroek
30*83ee113eSDavid van Moolenbroek #include <sys/cdefs.h>
31*83ee113eSDavid van Moolenbroek __RCSID("$NetBSD: ethernet.c,v 1.1.1.2 2014/07/12 11:57:43 spz Exp $");
32*83ee113eSDavid van Moolenbroek
33*83ee113eSDavid van Moolenbroek #include "dhcpd.h"
34*83ee113eSDavid van Moolenbroek
35*83ee113eSDavid van Moolenbroek #if defined (PACKET_ASSEMBLY) || defined (PACKET_DECODING)
36*83ee113eSDavid van Moolenbroek #include "includes/netinet/if_ether.h"
37*83ee113eSDavid van Moolenbroek #endif /* PACKET_ASSEMBLY || PACKET_DECODING */
38*83ee113eSDavid van Moolenbroek
39*83ee113eSDavid van Moolenbroek #if defined (PACKET_ASSEMBLY)
40*83ee113eSDavid van Moolenbroek /* Assemble an hardware header... */
41*83ee113eSDavid van Moolenbroek
assemble_ethernet_header(interface,buf,bufix,to)42*83ee113eSDavid van Moolenbroek void assemble_ethernet_header (interface, buf, bufix, to)
43*83ee113eSDavid van Moolenbroek struct interface_info *interface;
44*83ee113eSDavid van Moolenbroek unsigned char *buf;
45*83ee113eSDavid van Moolenbroek unsigned *bufix;
46*83ee113eSDavid van Moolenbroek struct hardware *to;
47*83ee113eSDavid van Moolenbroek {
48*83ee113eSDavid van Moolenbroek struct isc_ether_header eh;
49*83ee113eSDavid van Moolenbroek
50*83ee113eSDavid van Moolenbroek if (to && to -> hlen == 7) /* XXX */
51*83ee113eSDavid van Moolenbroek memcpy (eh.ether_dhost, &to -> hbuf [1],
52*83ee113eSDavid van Moolenbroek sizeof eh.ether_dhost);
53*83ee113eSDavid van Moolenbroek else
54*83ee113eSDavid van Moolenbroek memset (eh.ether_dhost, 0xff, sizeof (eh.ether_dhost));
55*83ee113eSDavid van Moolenbroek if (interface -> hw_address.hlen - 1 == sizeof (eh.ether_shost))
56*83ee113eSDavid van Moolenbroek memcpy (eh.ether_shost, &interface -> hw_address.hbuf [1],
57*83ee113eSDavid van Moolenbroek sizeof (eh.ether_shost));
58*83ee113eSDavid van Moolenbroek else
59*83ee113eSDavid van Moolenbroek memset (eh.ether_shost, 0x00, sizeof (eh.ether_shost));
60*83ee113eSDavid van Moolenbroek
61*83ee113eSDavid van Moolenbroek eh.ether_type = htons (ETHERTYPE_IP);
62*83ee113eSDavid van Moolenbroek
63*83ee113eSDavid van Moolenbroek memcpy (&buf [*bufix], &eh, ETHER_HEADER_SIZE);
64*83ee113eSDavid van Moolenbroek *bufix += ETHER_HEADER_SIZE;
65*83ee113eSDavid van Moolenbroek }
66*83ee113eSDavid van Moolenbroek #endif /* PACKET_ASSEMBLY */
67*83ee113eSDavid van Moolenbroek
68*83ee113eSDavid van Moolenbroek #ifdef PACKET_DECODING
69*83ee113eSDavid van Moolenbroek /* Decode a hardware header... */
70*83ee113eSDavid van Moolenbroek
decode_ethernet_header(interface,buf,bufix,from)71*83ee113eSDavid van Moolenbroek ssize_t decode_ethernet_header (interface, buf, bufix, from)
72*83ee113eSDavid van Moolenbroek struct interface_info *interface;
73*83ee113eSDavid van Moolenbroek unsigned char *buf;
74*83ee113eSDavid van Moolenbroek unsigned bufix;
75*83ee113eSDavid van Moolenbroek struct hardware *from;
76*83ee113eSDavid van Moolenbroek {
77*83ee113eSDavid van Moolenbroek struct isc_ether_header eh;
78*83ee113eSDavid van Moolenbroek
79*83ee113eSDavid van Moolenbroek memcpy (&eh, buf + bufix, ETHER_HEADER_SIZE);
80*83ee113eSDavid van Moolenbroek
81*83ee113eSDavid van Moolenbroek #ifdef USERLAND_FILTER
82*83ee113eSDavid van Moolenbroek if (ntohs (eh.ether_type) != ETHERTYPE_IP)
83*83ee113eSDavid van Moolenbroek return -1;
84*83ee113eSDavid van Moolenbroek #endif
85*83ee113eSDavid van Moolenbroek memcpy (&from -> hbuf [1], eh.ether_shost, sizeof (eh.ether_shost));
86*83ee113eSDavid van Moolenbroek from -> hbuf [0] = ARPHRD_ETHER;
87*83ee113eSDavid van Moolenbroek from -> hlen = (sizeof eh.ether_shost) + 1;
88*83ee113eSDavid van Moolenbroek
89*83ee113eSDavid van Moolenbroek return ETHER_HEADER_SIZE;
90*83ee113eSDavid van Moolenbroek }
91*83ee113eSDavid van Moolenbroek #endif /* PACKET_DECODING */
92