1: /*
2: * $Id: libnet_build_stp.c,v 1.1.1.1 2012/02/21 22:14:23 misho Exp $
3: *
4: * libnet
5: * libnet_build_stp.c - STP 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_stp_conf(u_int16_t id, u_int8_t version, u_int8_t bpdu_type,
44: u_int8_t flags, u_int8_t *root_id, u_int32_t root_pc, u_int8_t *bridge_id,
45: u_int16_t port_id, u_int16_t message_age, u_int16_t max_age,
46: u_int16_t hello_time, u_int16_t f_delay, u_int8_t *payload,
47: u_int32_t payload_s, libnet_t *l, libnet_ptag_t ptag)
48: {
49: u_int32_t n, h;
50: libnet_pblock_t *p;
51:
52: /* until we get some data marshalling in place we can't use this */
53: /* struct libnet_stp_conf_hdr stp_hdr; */
54: u_int8_t stp_hdr[35];
55: u_int16_t value_s;
56: u_int32_t value_l;
57:
58: if (l == NULL)
59: {
60: return (-1);
61: }
62:
63: n = LIBNET_STP_CONF_H + payload_s; /* size of memory block */
64: h = 0; /* no checksum */
65:
66: /*
67: * Find the existing protocol block if a ptag is specified, or create
68: * a new one.
69: */
70: p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_STP_CONF_H);
71: if (p == NULL)
72: {
73: return (-1);
74: }
75:
76: /* until we get some data marshalling in place we can't use this */
77: /*
78: stp_hdr.stp_id = htons(id);
79: stp_hdr.stp_version = version;
80: stp_hdr.stp_bpdu_type = bpdu_type;
81: stp_hdr.stp_flags = flags;
82: memcpy(&stp_hdr.stp_rootid, root_id, 8);
83: stp_hdr.stp_rootpc = htonl(root_pc);
84: memcpy(&stp_hdr.stp_bridgeid, bridge_id, 8);
85: stp_hdr.stp_portid = htons(port_id);
86: stp_hdr.stp_mage = htons(message_age);
87: stp_hdr.stp_maxage = htons(max_age);
88: stp_hdr.stp_hellot = htons(hello_time);
89: stp_hdr.stp_fdelay = htons(f_delay);
90: */
91:
92: value_s = htons(id);
93: memcpy(stp_hdr, &value_s, 2);
94: stp_hdr[2] = version;
95: stp_hdr[3] = bpdu_type;
96: stp_hdr[4] = flags;
97: memcpy(&stp_hdr[5], root_id, 8);
98: value_l = htonl(root_pc);
99: memcpy(&stp_hdr[13], &value_l, 4);
100: memcpy(&stp_hdr[17], bridge_id, 8);
101: value_s = htons(port_id);
102: memcpy(&stp_hdr[25], &value_s, 2);
103: #if (LIBNET_BIG_ENDIAN == 1)
104: value_s = htons(message_age);
105: #else
106: value_s = message_age;
107: #endif
108: memcpy(&stp_hdr[27], &value_s, 2);
109: #if (LIBNET_BIG_ENDIAN == 1)
110: value_s = htons(max_age);
111: #else
112: value_s = max_age;
113: #endif
114: memcpy(&stp_hdr[29], &value_s, 2);
115: #if (LIBNET_BIG_ENDIAN == 1)
116: value_s = htons(hello_time);
117: #else
118: value_s = hello_time;
119: #endif
120: memcpy(&stp_hdr[31], &value_s, 2);
121: #if (LIBNET_BIG_ENDIAN == 1)
122: value_s = htons(f_delay);
123: #else
124: value_s = f_delay;
125: #endif
126: memcpy(&stp_hdr[33], &value_s, 2);
127:
128:
129: /* until we get some data marshalling in place we can't use this */
130: /*n = libnet_pblock_append(l, p, (u_int8_t *)&stp_hdr, LIBNET_STP_CONF_H); */
131: n = libnet_pblock_append(l, p, stp_hdr, LIBNET_STP_CONF_H);
132: if (n == -1)
133: {
134: goto bad;
135: }
136:
137: if ((payload && !payload_s) || (!payload && payload_s))
138: {
139: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
140: "%s(): payload inconsistency\n", __func__);
141: goto bad;
142: }
143:
144: if (payload && payload_s)
145: {
146: n = libnet_pblock_append(l, p, payload, payload_s);
147: if (n == -1)
148: {
149: goto bad;
150: }
151: }
152:
153: return (ptag ? ptag : libnet_pblock_update(l, p, h,
154: LIBNET_PBLOCK_STP_CONF_H));
155: bad:
156: libnet_pblock_delete(l, p);
157: return (-1);
158: }
159:
160:
161: libnet_ptag_t
162: libnet_build_stp_tcn(u_int16_t id, u_int8_t version, u_int8_t bpdu_type,
163: u_int8_t *payload, u_int32_t payload_s, libnet_t *l, libnet_ptag_t ptag)
164: {
165: u_int32_t n, h;
166: libnet_pblock_t *p;
167:
168: struct libnet_stp_tcn_hdr stp_hdr;
169:
170: if (l == NULL)
171: {
172: return (-1);
173: }
174:
175: n = LIBNET_STP_TCN_H + payload_s; /* size of memory block */
176: h = 0; /* no checksum */
177:
178: /*
179: * Find the existing protocol block if a ptag is specified, or create
180: * a new one.
181: */
182: p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_STP_TCN_H);
183: if (p == NULL)
184: {
185: return (-1);
186: }
187:
188: memset(&stp_hdr, 0, sizeof(stp_hdr));
189: stp_hdr.stp_id = htons(id);
190: stp_hdr.stp_version = version;
191: stp_hdr.stp_bpdu_type = bpdu_type;
192:
193: n = libnet_pblock_append(l, p, (u_int8_t *)&stp_hdr, LIBNET_STP_TCN_H);
194: if (n == -1)
195: {
196: goto bad;
197: }
198:
199: if ((payload && !payload_s) || (!payload && payload_s))
200: {
201: snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
202: "%s(): payload inconsistency\n", __func__);
203: goto bad;
204: }
205:
206: if (payload && payload_s)
207: {
208: n = libnet_pblock_append(l, p, payload, payload_s);
209: if (n == -1)
210: {
211: goto bad;
212: }
213: }
214:
215: return (ptag ? ptag : libnet_pblock_update(l, p, h,
216: LIBNET_PBLOCK_STP_TCN_H));
217: bad:
218: libnet_pblock_delete(l, p);
219: return (-1);
220: }
221:
222: /* EOF */
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to libnet_build_stp.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