summaryrefslogtreecommitdiff
path: root/src/libnet_build_bgp.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/libnet_build_bgp.c')
-rw-r--r--src/libnet_build_bgp.c294
1 files changed, 294 insertions, 0 deletions
diff --git a/src/libnet_build_bgp.c b/src/libnet_build_bgp.c
new file mode 100644
index 0000000..7b1d15b
--- /dev/null
+++ b/src/libnet_build_bgp.c
@@ -0,0 +1,294 @@
+/*
+ * $Id: libnet_build_bgp.c,v 1.8 2004/04/13 17:32:28 mike Exp $
+ *
+ * libnet
+ * libnet_build_bgp.c - BGP packet assembler (RFC 1771)
+ *
+ * Copyright (c) 2003 Frederic Raynal <pappy@security-labs.org>
+ * 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.
+ *
+ */
+
+#if (HAVE_CONFIG_H)
+#include "../include/config.h"
+#endif
+#if (!(_WIN32) || (__CYGWIN__))
+#include "../include/libnet.h"
+#else
+#include "../include/win32/libnet.h"
+#endif
+
+libnet_ptag_t
+libnet_build_bgp4_header(uint8_t marker[LIBNET_BGP4_MARKER_SIZE],
+uint16_t len, uint8_t 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_bgp4_header_hdr bgp4_hdr;
+
+ if (l == NULL)
+ {
+ return (-1);
+ }
+
+ n = LIBNET_BGP4_HEADER_H + payload_s; /* size of memory block */
+ h = 0; /* BGP headers have 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_BGP4_HEADER_H);
+ if (p == NULL)
+ {
+ return (-1);
+ }
+
+ memset(&bgp4_hdr, 0, sizeof(bgp4_hdr));
+ memcpy(bgp4_hdr.marker, marker, LIBNET_BGP4_MARKER_SIZE * sizeof(uint8_t));
+ bgp4_hdr.len = htons(len);
+ bgp4_hdr.type = type;
+
+ n = libnet_pblock_append(l, p, (uint8_t *)&bgp4_hdr, LIBNET_BGP4_HEADER_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_BGP4_HEADER_H));
+bad:
+ libnet_pblock_delete(l, p);
+ return (-1);
+}
+
+libnet_ptag_t
+libnet_build_bgp4_open(uint8_t version, uint16_t src_as, uint16_t hold_time,
+uint32_t bgp_id, uint8_t opt_len, const uint8_t *payload, uint32_t payload_s,
+libnet_t *l, libnet_ptag_t ptag)
+{
+ uint32_t n, h;
+ libnet_pblock_t *p;
+ uint16_t val;
+
+ if (l == NULL)
+ {
+ return (-1);
+ }
+
+ n = LIBNET_BGP4_OPEN_H + payload_s; /* size of memory block */
+ h = 0; /* BGP msg have 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_BGP4_OPEN_H);
+ if (p == NULL)
+ {
+ return (-1);
+ }
+
+ /* for memory alignment reason, we need to append each field separately */
+ n = libnet_pblock_append(l, p, (uint8_t *)&version, sizeof (version));
+ if (n == -1)
+ {
+ goto bad;
+ }
+
+ val = htons(src_as);
+ n = libnet_pblock_append(l, p, (uint8_t *)&val, sizeof(src_as));
+ if (n == -1)
+ {
+ goto bad;
+ }
+
+ val = htons(hold_time);
+ n = libnet_pblock_append(l, p, (uint8_t *)&val, sizeof(hold_time));
+ if (n == -1)
+ {
+ goto bad;
+ }
+
+ n = htonl(bgp_id);
+ n = libnet_pblock_append(l, p, (uint8_t *)&n, sizeof(bgp_id));
+ if (n == -1)
+ {
+ goto bad;
+ }
+
+ n = libnet_pblock_append(l, p, (uint8_t *)&opt_len, sizeof(opt_len));
+ 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_BGP4_OPEN_H));
+bad:
+ libnet_pblock_delete(l, p);
+ return (-1);
+}
+
+libnet_ptag_t
+libnet_build_bgp4_update(uint16_t unfeasible_rt_len, const uint8_t *withdrawn_rt,
+uint16_t total_path_attr_len, const uint8_t *path_attributes, uint16_t info_len,
+uint8_t *reachability_info, const uint8_t *payload, uint32_t payload_s,
+libnet_t *l, libnet_ptag_t ptag)
+{
+ uint32_t n, h;
+ libnet_pblock_t *p;
+ uint16_t length;
+
+ if (l == NULL)
+ {
+ return (-1);
+ }
+
+ /* size of memory block */
+ n = LIBNET_BGP4_UPDATE_H + unfeasible_rt_len + total_path_attr_len +
+ info_len + payload_s;
+
+ /* BGP msg have no checksum */
+ h = 0;
+
+ /*
+ * Find the existing protocol block if a ptag is specified, or create
+ * a new one.
+ */
+ p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_BGP4_UPDATE_H);
+ if (p == NULL)
+ {
+ return (-1);
+ }
+
+ /* for memory alignment reason, we need to append each field separately */
+ length = htons(unfeasible_rt_len);
+ n = libnet_pblock_append(l, p, (uint8_t *)&length,
+ sizeof (unfeasible_rt_len));
+ if (n == -1)
+ {
+ goto bad;
+ }
+
+ if (unfeasible_rt_len && withdrawn_rt)
+ {
+ n = libnet_pblock_append(l, p, withdrawn_rt, unfeasible_rt_len);
+ if (n == -1)
+ {
+ goto bad;
+ }
+ }
+
+ length = htons(total_path_attr_len);
+ n = libnet_pblock_append(l, p, (uint8_t *)&length,
+ sizeof (total_path_attr_len));
+ if (n == -1)
+ {
+ goto bad;
+ }
+
+ if (total_path_attr_len && path_attributes)
+ {
+ n = libnet_pblock_append(l, p, path_attributes, total_path_attr_len);
+ if (n == -1)
+ {
+ goto bad;
+ }
+ }
+
+ if (info_len && reachability_info)
+ {
+ n = libnet_pblock_append(l, p, reachability_info, info_len);
+ 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_BGP4_UPDATE_H));
+bad:
+ libnet_pblock_delete(l, p);
+ return (-1);
+}
+
+libnet_ptag_t
+libnet_build_bgp4_notification(uint8_t err_code, uint8_t err_subcode,
+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_bgp4_notification_hdr bgp4_hdr;
+
+ if (l == NULL)
+ {
+ return (-1);
+ }
+
+ n = LIBNET_BGP4_NOTIFICATION_H + + payload_s; /* size of memory block */
+ h = 0;
+
+ /*
+ * Find the existing protocol block if a ptag is specified, or create
+ * a new one.
+ */
+ p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_BGP4_NOTIFICATION_H);
+ if (p == NULL)
+ {
+ return (-1);
+ }
+
+ memset(&bgp4_hdr, 0, sizeof(bgp4_hdr));
+ bgp4_hdr.err_code = err_code;
+ bgp4_hdr.err_subcode = err_subcode;
+
+ n = libnet_pblock_append(l, p, (uint8_t *)&bgp4_hdr,
+ LIBNET_BGP4_NOTIFICATION_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_BGP4_NOTIFICATION_H));
+bad:
+ libnet_pblock_delete(l, p);
+ return (-1);
+}
+
+/* EOF */