summaryrefslogtreecommitdiff
path: root/src/libnet_build_stp.c
diff options
context:
space:
mode:
authorSam Roberts <vieuxtech@gmail.com>2019-09-23 13:10:22 -0700
committerSam Roberts <vieuxtech@gmail.com>2019-09-23 13:46:14 -0700
commit4cacef3582dcb94aae7da412f4027f04fa317f57 (patch)
treea72e0d39c8e721f103be41f32c3f19191c015f0c /src/libnet_build_stp.c
parent923f9a43eb9b45f992bbc107732684193454487a (diff)
downloadlibnet-4cacef3582dcb94aae7da412f4027f04fa317f57.tar.gz
Move libnet/ content to top of git repo
1. Moved scripts into libnet/scripts/, moved debian/ into libnet/, and other top-level content into libnet/. 2. Moved libnet/* up to ./
Diffstat (limited to 'src/libnet_build_stp.c')
-rw-r--r--src/libnet_build_stp.c189
1 files changed, 189 insertions, 0 deletions
diff --git a/src/libnet_build_stp.c b/src/libnet_build_stp.c
new file mode 100644
index 0000000..c77d382
--- /dev/null
+++ b/src/libnet_build_stp.c
@@ -0,0 +1,189 @@
+/*
+ * $Id: libnet_build_stp.c,v 1.9 2004/04/13 17:32:28 mike Exp $
+ *
+ * libnet
+ * libnet_build_stp.c - STP packet assembler
+ *
+ * Copyright (c) 1998 - 2004 Mike D. Schiffman <mike@infonexus.com>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ *
+ */
+
+#include "common.h"
+
+libnet_ptag_t
+libnet_build_stp_conf(uint16_t id, uint8_t version, uint8_t bpdu_type,
+uint8_t flags, const uint8_t *root_id, uint32_t root_pc, const uint8_t *bridge_id,
+uint16_t port_id, uint16_t message_age, uint16_t max_age,
+uint16_t hello_time, uint16_t f_delay, const uint8_t *payload,
+uint32_t payload_s, libnet_t *l, libnet_ptag_t ptag)
+{
+ uint32_t n, h;
+ libnet_pblock_t *p;
+
+ /* until we get some data marshalling in place we can't use this */
+ /* struct libnet_stp_conf_hdr stp_hdr; */
+ uint8_t stp_hdr[35];
+ uint16_t value_s;
+ uint32_t value_l;
+
+ if (l == NULL)
+ {
+ return (-1);
+ }
+
+ n = LIBNET_STP_CONF_H + payload_s; /* size of memory block */
+ h = 0; /* no checksum */
+
+ /*
+ * Find the existing protocol block if a ptag is specified, or create
+ * a new one.
+ */
+ p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_STP_CONF_H);
+ if (p == NULL)
+ {
+ return (-1);
+ }
+
+ /* until we get some data marshalling in place we can't use this */
+ /*
+ stp_hdr.stp_id = htons(id);
+ stp_hdr.stp_version = version;
+ stp_hdr.stp_bpdu_type = bpdu_type;
+ stp_hdr.stp_flags = flags;
+ memcpy(&stp_hdr.stp_rootid, root_id, 8);
+ stp_hdr.stp_rootpc = htonl(root_pc);
+ memcpy(&stp_hdr.stp_bridgeid, bridge_id, 8);
+ stp_hdr.stp_portid = htons(port_id);
+ stp_hdr.stp_mage = htons(message_age);
+ stp_hdr.stp_maxage = htons(max_age);
+ stp_hdr.stp_hellot = htons(hello_time);
+ stp_hdr.stp_fdelay = htons(f_delay);
+ */
+
+ value_s = htons(id);
+ memcpy(stp_hdr, &value_s, 2);
+ stp_hdr[2] = version;
+ stp_hdr[3] = bpdu_type;
+ stp_hdr[4] = flags;
+ memcpy(&stp_hdr[5], root_id, 8);
+ value_l = htonl(root_pc);
+ memcpy(&stp_hdr[13], &value_l, 4);
+ memcpy(&stp_hdr[17], bridge_id, 8);
+ value_s = htons(port_id);
+ memcpy(&stp_hdr[25], &value_s, 2);
+#if (LIBNET_BIG_ENDIAN == 1)
+ value_s = htons(message_age);
+#else
+ value_s = message_age;
+#endif
+ memcpy(&stp_hdr[27], &value_s, 2);
+#if (LIBNET_BIG_ENDIAN == 1)
+ value_s = htons(max_age);
+#else
+ value_s = max_age;
+#endif
+ memcpy(&stp_hdr[29], &value_s, 2);
+#if (LIBNET_BIG_ENDIAN == 1)
+ value_s = htons(hello_time);
+#else
+ value_s = hello_time;
+#endif
+ memcpy(&stp_hdr[31], &value_s, 2);
+#if (LIBNET_BIG_ENDIAN == 1)
+ value_s = htons(f_delay);
+#else
+ value_s = f_delay;
+#endif
+ memcpy(&stp_hdr[33], &value_s, 2);
+
+
+ /* until we get some data marshalling in place we can't use this */
+ /*n = libnet_pblock_append(l, p, (uint8_t *)&stp_hdr, LIBNET_STP_CONF_H); */
+ n = libnet_pblock_append(l, p, stp_hdr, LIBNET_STP_CONF_H);
+ if (n == -1)
+ {
+ goto bad;
+ }
+
+ /* boilerplate payload sanity check / append macro */
+ LIBNET_DO_PAYLOAD(l, p);
+
+ return (ptag ? ptag : libnet_pblock_update(l, p, h,
+ LIBNET_PBLOCK_STP_CONF_H));
+bad:
+ libnet_pblock_delete(l, p);
+ return (-1);
+}
+
+
+libnet_ptag_t
+libnet_build_stp_tcn(uint16_t id, uint8_t version, uint8_t bpdu_type,
+const uint8_t *payload, uint32_t payload_s, libnet_t *l, libnet_ptag_t ptag)
+{
+ uint32_t n, h;
+ libnet_pblock_t *p;
+
+ struct libnet_stp_tcn_hdr stp_hdr;
+
+ if (l == NULL)
+ {
+ return (-1);
+ }
+
+ n = LIBNET_STP_TCN_H + payload_s; /* size of memory block */
+ h = 0; /* no checksum */
+
+ /*
+ * Find the existing protocol block if a ptag is specified, or create
+ * a new one.
+ */
+ p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_STP_TCN_H);
+ if (p == NULL)
+ {
+ return (-1);
+ }
+
+ memset(&stp_hdr, 0, sizeof(stp_hdr));
+ stp_hdr.stp_id = htons(id);
+ stp_hdr.stp_version = version;
+ stp_hdr.stp_bpdu_type = bpdu_type;
+
+ n = libnet_pblock_append(l, p, (uint8_t *)&stp_hdr, LIBNET_STP_TCN_H);
+ if (n == -1)
+ {
+ goto bad;
+ }
+
+ /* boilerplate payload sanity check / append macro */
+ LIBNET_DO_PAYLOAD(l, p);
+
+ return (ptag ? ptag : libnet_pblock_update(l, p, h,
+ LIBNET_PBLOCK_STP_TCN_H));
+bad:
+ libnet_pblock_delete(l, p);
+ return (-1);
+}
+
+/* EOF */