xref: /minix3/external/bsd/dhcp/dist/common/ethernet.c (revision 83ee113ee0d94f3844d44065af2311604e9a30ad)
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