Annotation of embedaddon/libnet/src/libnet_build_ethernet.c, revision 1.1.1.1
1.1 misho 1: /*
2: * $Id: libnet_build_ethernet.c,v 1.8 2004/01/03 20:31:01 mike Exp $
3: *
4: * libnet
5: * libnet_build_ethernet.c - ethernet packet assembler
6: *
7: * Copyright (c) 1998 - 2004 Mike D. Schiffman <mike@infonexus.com>
8: * All rights reserved.
9: *
10: * Redistribution and use in source and binary forms, with or without
11: * modification, are permitted provided that the following conditions
12: * are met:
13: * 1. Redistributions of source code must retain the above copyright
14: * notice, this list of conditions and the following disclaimer.
15: * 2. Redistributions in binary form must reproduce the above copyright
16: * notice, this list of conditions and the following disclaimer in the
17: * documentation and/or other materials provided with the distribution.
18: *
19: * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
20: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22: * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
23: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29: * SUCH DAMAGE.
30: *
31: */
32:
33: #if (HAVE_CONFIG_H)
34: #include "../include/config.h"
35: #endif
36: #if (!(_WIN32) || (__CYGWIN__))
37: #include "../include/libnet.h"
38: #else
39: #include "../include/win32/libnet.h"
40: #endif
41:
42: libnet_ptag_t
43: libnet_build_ethernet(u_int8_t *dst, u_int8_t *src, u_int16_t type, u_int8_t *payload,
44: u_int32_t payload_s, libnet_t *l, libnet_ptag_t ptag)
45: {
46: u_int32_t n, h;
47: libnet_pblock_t *p;
48: struct libnet_ethernet_hdr eth_hdr;
49:
50: if (l == NULL)
51: {
52: return (-1);
53: }
54:
55: /* sanity check injection type if we're not in advanced mode */
56: if (l->injection_type != LIBNET_LINK &&
57: !(((l->injection_type) & LIBNET_ADV_MASK)))
58: {
59: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
60: "%s(): called with non-link layer wire injection primitive",
61: __func__);
62: p = NULL;
63: goto bad;
64: }
65:
66: n = LIBNET_ETH_H + payload_s;
67: h = 0;
68:
69: /*
70: * Find the existing protocol block if a ptag is specified, or create
71: * a new one.
72: */
73: p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_ETH_H);
74: if (p == NULL)
75: {
76: return (-1);
77: }
78:
79: memset(ð_hdr, 0, sizeof(eth_hdr));
80: memcpy(eth_hdr.ether_dhost, dst, ETHER_ADDR_LEN); /* destination address */
81: memcpy(eth_hdr.ether_shost, src, ETHER_ADDR_LEN); /* source address */
82: eth_hdr.ether_type = htons(type); /* packet type */
83:
84: n = libnet_pblock_append(l, p, (u_int8_t *)ð_hdr, LIBNET_ETH_H);
85: if (n == -1)
86: {
87: goto bad;
88: }
89:
90: if ((payload && !payload_s) || (!payload && payload_s))
91: {
92: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
93: "%s(): payload inconsistency\n", __func__);
94: goto bad;
95: }
96:
97: if (payload && payload_s)
98: {
99: n = libnet_pblock_append(l, p, payload, payload_s);
100: if (n == -1)
101: {
102: goto bad;
103: }
104: }
105:
106: return (ptag ? ptag : libnet_pblock_update(l, p, h, LIBNET_PBLOCK_ETH_H));
107: bad:
108: libnet_pblock_delete(l, p);
109: return (-1);
110: }
111:
112:
113: libnet_ptag_t
114: libnet_autobuild_ethernet(u_int8_t *dst, u_int16_t type, libnet_t *l)
115: {
116: u_int32_t n, h;
117: struct libnet_ether_addr *src;
118: libnet_pblock_t *p;
119: libnet_ptag_t ptag;
120: struct libnet_ethernet_hdr eth_hdr;
121:
122: if (l == NULL)
123: {
124: return (-1);
125: }
126:
127: /* sanity check injection type if we're not in advanced mode */
128: if (l->injection_type != LIBNET_LINK &&
129: !(((l->injection_type) & LIBNET_ADV_MASK)))
130: {
131: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
132: "libnet_autobuild_ethernet() called with non-link layer wire"
133: " injection primitive");
134: p = NULL;
135: goto bad;
136: }
137:
138: n = LIBNET_ETH_H;
139: h = 0;
140: ptag = LIBNET_PTAG_INITIALIZER;
141: src = libnet_get_hwaddr(l);
142: if (src == NULL)
143: {
144: /* err msg set in libnet_get_hwaddr() */
145: return (-1);
146: }
147:
148: /*
149: * Create a new pblock.
150: */
151: p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_ETH_H);
152: if (p == NULL)
153: {
154: return (-1);
155: }
156:
157: memset(ð_hdr, 0, sizeof(eth_hdr));
158: memcpy(eth_hdr.ether_dhost, dst, ETHER_ADDR_LEN); /* destination address */
159: memcpy(eth_hdr.ether_shost, src, ETHER_ADDR_LEN); /* source address */
160: eth_hdr.ether_type = htons(type); /* packet type */
161:
162: n = libnet_pblock_append(l, p, (u_int8_t *)ð_hdr, LIBNET_ETH_H);
163: if (n == -1)
164: {
165: goto bad;
166: }
167:
168: return (libnet_pblock_update(l, p, h, LIBNET_PBLOCK_ETH_H));
169: bad:
170: libnet_pblock_delete(l, p);
171: return (-1);
172: }
173: /* EOF */
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to libnet_build_ethernet.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / embedaddon / libnet / src