Annotation of embedaddon/libnet/src/libnet_build_ethernet.c, revision 1.1.1.2
1.1 misho 1: /*
1.1.1.2 ! misho 2: * $Id: libnet_build_ethernet.c,v 1.9 2004/04/13 17:32:28 mike Exp $
1.1 misho 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
1.1.1.2 ! misho 43: libnet_build_ethernet(const uint8_t *dst, const uint8_t *src, uint16_t type,
! 44: const uint8_t *payload, uint32_t payload_s, libnet_t *l, libnet_ptag_t ptag)
1.1 misho 45: {
1.1.1.2 ! misho 46: uint32_t n, h;
1.1 misho 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:
1.1.1.2 ! misho 79: memset(ð_hdr, 0, sizeof(eth_hdr));
! 80: memcpy(eth_hdr.ether_dhost, dst, ETHER_ADDR_LEN); /* destination address */
1.1 misho 81: memcpy(eth_hdr.ether_shost, src, ETHER_ADDR_LEN); /* source address */
82: eth_hdr.ether_type = htons(type); /* packet type */
83:
1.1.1.2 ! misho 84: n = libnet_pblock_append(l, p, (uint8_t *)ð_hdr, LIBNET_ETH_H);
1.1 misho 85: if (n == -1)
86: {
87: goto bad;
88: }
89:
1.1.1.2 ! misho 90: /* boilerplate payload sanity check / append macro */
! 91: LIBNET_DO_PAYLOAD(l, p);
1.1 misho 92:
93: return (ptag ? ptag : libnet_pblock_update(l, p, h, LIBNET_PBLOCK_ETH_H));
94: bad:
95: libnet_pblock_delete(l, p);
96: return (-1);
97: }
98:
99:
100: libnet_ptag_t
1.1.1.2 ! misho 101: libnet_autobuild_ethernet(const uint8_t *dst, uint16_t type, libnet_t *l)
1.1 misho 102: {
1.1.1.2 ! misho 103: uint32_t n, h;
1.1 misho 104: struct libnet_ether_addr *src;
105: libnet_pblock_t *p;
106: libnet_ptag_t ptag;
107: struct libnet_ethernet_hdr eth_hdr;
108:
109: if (l == NULL)
110: {
111: return (-1);
112: }
113:
114: /* sanity check injection type if we're not in advanced mode */
115: if (l->injection_type != LIBNET_LINK &&
116: !(((l->injection_type) & LIBNET_ADV_MASK)))
117: {
118: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
119: "libnet_autobuild_ethernet() called with non-link layer wire"
120: " injection primitive");
121: p = NULL;
122: goto bad;
123: }
124:
125: n = LIBNET_ETH_H;
126: h = 0;
127: ptag = LIBNET_PTAG_INITIALIZER;
128: src = libnet_get_hwaddr(l);
129: if (src == NULL)
130: {
131: /* err msg set in libnet_get_hwaddr() */
132: return (-1);
133: }
134:
135: /*
136: * Create a new pblock.
137: */
138: p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_ETH_H);
139: if (p == NULL)
140: {
141: return (-1);
142: }
143:
1.1.1.2 ! misho 144: memset(ð_hdr, 0, sizeof(eth_hdr));
! 145: memcpy(eth_hdr.ether_dhost, dst, ETHER_ADDR_LEN); /* destination address */
1.1 misho 146: memcpy(eth_hdr.ether_shost, src, ETHER_ADDR_LEN); /* source address */
147: eth_hdr.ether_type = htons(type); /* packet type */
148:
1.1.1.2 ! misho 149: n = libnet_pblock_append(l, p, (uint8_t *)ð_hdr, LIBNET_ETH_H);
1.1 misho 150: if (n == -1)
151: {
152: goto bad;
153: }
154:
155: return (libnet_pblock_update(l, p, h, LIBNET_PBLOCK_ETH_H));
156: bad:
157: libnet_pblock_delete(l, p);
158: return (-1);
159: }
160: /* 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