Annotation of embedaddon/libnet/src/libnet_build_802.2.c, revision 1.1.1.1
1.1 misho 1: /*
2: * $Id: libnet_build_802.2.c,v 1.10 2004/01/28 19:45:00 mike Exp $
3: *
4: * libnet
5: * libnet_build_802.2.c - 802.2 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_802_2(u_int8_t dsap, u_int8_t ssap, u_int8_t control,
44: u_int8_t *payload, 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_802_2_hdr _802_2_hdr;
49:
50: if (l == NULL)
51: {
52: return (-1);
53: }
54:
55: n = LIBNET_802_2_H + payload_s;
56: h = 0;
57:
58: /*
59: * Find the existing protocol block if a ptag is specified, or create
60: * a new one.
61: */
62: p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_802_2_H);
63: if (p == NULL)
64: {
65: return (-1);
66: }
67:
68: memset(&_802_2_hdr, 0, sizeof(_802_2_hdr));
69: _802_2_hdr.llc_dsap = dsap;
70: _802_2_hdr.llc_ssap = ssap;
71: _802_2_hdr.llc_control = control;
72:
73: n = libnet_pblock_append(l, p, (u_int8_t *)&_802_2_hdr, LIBNET_802_2_H);
74: if (n == -1)
75: {
76: goto bad;
77: }
78:
79: if ((payload && !payload_s) || (!payload && payload_s))
80: {
81: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
82: "%s(): payload inconsistency\n", __func__);
83: goto bad;
84: }
85:
86: if (payload && payload_s)
87: {
88: n = libnet_pblock_append(l, p, payload, payload_s);
89: if (n == -1)
90: {
91: goto bad;
92: }
93: }
94:
95: return (ptag ? ptag : libnet_pblock_update(l, p, h,
96: LIBNET_PBLOCK_802_2_H));
97: bad:
98: libnet_pblock_delete(l, p);
99: return (-1);
100: }
101:
102:
103: libnet_ptag_t
104: libnet_build_802_2snap(u_int8_t dsap, u_int8_t ssap, u_int8_t control, u_int8_t *oui,
105: u_int16_t type, u_int8_t *payload, u_int32_t payload_s, libnet_t *l,
106: libnet_ptag_t ptag)
107: {
108: u_int32_t n, h;
109: libnet_pblock_t *p;
110: struct libnet_802_2snap_hdr _802_2_hdr;
111:
112: if (l == NULL)
113: {
114: return (-1);
115: }
116:
117: n = LIBNET_802_2SNAP_H + payload_s;
118: h = 0;
119:
120: /*
121: * Find the existing protocol block if a ptag is specified, or create
122: * a new one.
123: */
124: p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_802_2SNAP_H);
125: if (p == NULL)
126: {
127: return (-1);
128: }
129:
130: memset(&_802_2_hdr, 0, sizeof(_802_2_hdr));
131: _802_2_hdr.snap_dsap = dsap;
132: _802_2_hdr.snap_ssap = ssap;
133: _802_2_hdr.snap_control = control;
134: memcpy(_802_2_hdr.snap_oui, oui, 3);
135: _802_2_hdr.snap_type = htons(type);
136:
137: n = libnet_pblock_append(l, p, (u_int8_t *)&_802_2_hdr, LIBNET_802_2SNAP_H);
138: if (n == -1)
139: {
140: goto bad;
141: }
142:
143: if ((payload && !payload_s) || (!payload && payload_s))
144: {
145: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
146: "%s(): payload inconsistency\n", __func__);
147: goto bad;
148: }
149:
150: if (payload && payload_s)
151: {
152: n = libnet_pblock_append(l, p, payload, payload_s);
153: if (n == -1)
154: {
155: goto bad;
156: }
157: }
158:
159: return (ptag ? ptag : libnet_pblock_update(l, p, h,
160: LIBNET_PBLOCK_802_2SNAP_H));
161: bad:
162: libnet_pblock_delete(l, p);
163: return (-1);
164: }
165:
166:
167: /* EOF */
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to libnet_build_802.2.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