libnet4r 0.1

data/libnet/src/libnet_build_dhcp.c

@@ -0,0 +1,156 @@
+/*
+ *  $Id: libnet_build_dhcp.c,v 1.10 2004/03/01 20:26:12 mike Exp $
+ *
+ *  libnet
+ *  libnet_build_dhcp.c - DHCP/BOOTP 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.
+ *
+ */
+
+#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_dhcpv4(u_int8_t opcode, u_int8_t htype, u_int8_t hlen, 
+u_int8_t hopcount, u_int32_t xid, u_int16_t secs, u_int16_t flags,
+u_int32_t cip, u_int32_t yip, u_int32_t sip, u_int32_t gip, u_int8_t *chaddr,
+u_int8_t *sname, u_int8_t *file, u_int8_t *payload, u_int32_t payload_s,
+libnet_t *l, libnet_ptag_t ptag)
+{
+    u_int32_t n, h;
+    libnet_pblock_t *p; 
+    struct libnet_dhcpv4_hdr dhcp_hdr;
+
+    if (l == NULL)
+    { 
+        return (-1);
+    } 
+
+    n = LIBNET_DHCPV4_H + payload_s;
+    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_DHCPV4_H);
+    if (p == NULL)
+    {
+        return (-1);
+    }
+
+    memset(&dhcp_hdr, 0, sizeof(dhcp_hdr));
+    dhcp_hdr.dhcp_opcode    = opcode;
+    dhcp_hdr.dhcp_htype     = htype;
+    dhcp_hdr.dhcp_hlen      = hlen;
+    dhcp_hdr.dhcp_hopcount  = hopcount;
+    dhcp_hdr.dhcp_xid       = htonl(xid);
+    dhcp_hdr.dhcp_secs      = htons(secs);
+    dhcp_hdr.dhcp_flags     = htons(flags);
+    dhcp_hdr.dhcp_cip       = htonl(cip);
+    dhcp_hdr.dhcp_yip       = htonl(yip);
+    dhcp_hdr.dhcp_sip       = htonl(sip);
+    dhcp_hdr.dhcp_gip       = htonl(gip);
+
+    if (chaddr)
+    { 
+        memcpy(dhcp_hdr.dhcp_chaddr, chaddr, sizeof (dhcp_hdr.dhcp_chaddr));
+        dhcp_hdr.dhcp_chaddr[sizeof(dhcp_hdr.dhcp_chaddr) - 1] = 0;
+    }
+    else
+    {
+        memset(dhcp_hdr.dhcp_chaddr, 0, sizeof (dhcp_hdr.dhcp_chaddr));
+    }
+ 
+    if (sname)
+    { 
+        memcpy(dhcp_hdr.dhcp_sname, sname, sizeof (dhcp_hdr.dhcp_sname));
+        dhcp_hdr.dhcp_sname[sizeof(dhcp_hdr.dhcp_sname) - 1] = 0;
+    }
+    else
+    {
+        memset(dhcp_hdr.dhcp_sname, 0, sizeof (dhcp_hdr.dhcp_sname));
+    }
+
+    if (file)
+    {
+        memcpy(dhcp_hdr.dhcp_file, file, sizeof (dhcp_hdr.dhcp_file));
+        dhcp_hdr.dhcp_file[sizeof(dhcp_hdr.dhcp_file) - 1] = 0;
+    }
+    else
+    {
+        memset(dhcp_hdr.dhcp_file, 0, sizeof(dhcp_hdr.dhcp_file));
+    }
+    dhcp_hdr.dhcp_magic = htonl(DHCP_MAGIC);    /* should this be tunable? */
+
+    n = libnet_pblock_append(l, p, (u_int8_t *)&dhcp_hdr, LIBNET_DHCPV4_H);
+    if (n == -1)
+    {
+        goto bad;
+    }
+
+    if ((payload && !payload_s) || (!payload && payload_s))
+    {
+         snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
+                 "%s(): payload inconsistency\n", __func__);
+        goto bad;
+    }
+ 
+    if (payload && payload_s)
+    {
+        n = libnet_pblock_append(l, p, payload, payload_s);
+        if (n == -1)
+        {
+            goto bad;
+        }
+    }
+ 
+    return (ptag ? ptag : libnet_pblock_update(l, p, h, 
+            LIBNET_PBLOCK_DHCPV4_H));
+bad:
+    libnet_pblock_delete(l, p);
+    return (-1);
+}
+
+libnet_ptag_t
+libnet_build_bootpv4(u_int8_t opcode, u_int8_t htype, u_int8_t hlen,
+u_int8_t hopcount, u_int32_t xid, u_int16_t secs, u_int16_t flags,
+u_int32_t cip, u_int32_t yip, u_int32_t sip, u_int32_t gip, u_int8_t *chaddr,
+u_int8_t *sname, u_int8_t *file, u_int8_t *payload, u_int32_t payload_s,
+libnet_t *l, libnet_ptag_t ptag)
+{
+    return (libnet_build_dhcpv4(opcode, htype, hlen, hopcount, xid, secs,
+        flags, cip, yip, sip, gip, chaddr, sname, file, payload, payload_s, 
+        l, ptag));
+}
+
+/* EOF */

data/libnet/src/libnet_build_dns.c

@@ -0,0 +1,129 @@
+/*
+ *  $Id: libnet_build_dns.c,v 1.9 2004/01/03 20:31:01 mike Exp $
+ *
+ *  libnet
+ *  libnet_build_dns.c - DNS 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.
+ *
+ */
+
+#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_dnsv4(u_int16_t h_len, u_int16_t id, u_int16_t flags,
+            u_int16_t num_q, u_int16_t num_anws_rr, u_int16_t num_auth_rr,
+            u_int16_t num_addi_rr, u_int8_t *payload, u_int32_t payload_s,
+            libnet_t *l, libnet_ptag_t ptag)
+{
+
+    u_int32_t n, h;
+    u_int offset;
+    libnet_pblock_t *p;
+    struct libnet_dnsv4_hdr dns_hdr;
+
+    if (l == NULL)
+    { 
+        return (-1);
+    } 
+
+    if (h_len != LIBNET_UDP_DNSV4_H && h_len != LIBNET_TCP_DNSV4_H)
+    {
+        snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
+                "%s(): invalid header length: %d", __func__, h_len);
+       return (-1);
+    }
+    offset = (h_len == LIBNET_UDP_DNSV4_H ? sizeof(dns_hdr.h_len) : 0);
+    n = h_len + payload_s;
+    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_DNSV4_H);
+    if (p == NULL)
+    {
+        return (-1);
+    }
+    /*
+     * The sizeof(dns_hdr.h_len) is not counted is the packet size
+     * for TCP packet.
+     * And since this will be ignored for udp packets, let's compute it 
+     * anyway.
+     */
+
+	memset(&dns_hdr, 0, sizeof(dns_hdr));
+	dns_hdr.h_len       = htons(n - sizeof (dns_hdr.h_len));
+    dns_hdr.id          = htons(id);
+    dns_hdr.flags       = htons(flags);
+    dns_hdr.num_q       = htons(num_q);
+    dns_hdr.num_answ_rr = htons(num_anws_rr);
+    dns_hdr.num_auth_rr = htons(num_auth_rr);
+    dns_hdr.num_addi_rr = htons(num_addi_rr);
+
+    /*
+     * A dirty trick: DNS can be either TCP or UDP based, and depending on
+     * that, the header changes. A 'length' field is present in TCP packets,
+     * but not in UDP packets. As they are the first 2 bytes of the header,
+     * they are skipped if the packet is UDP...
+     */
+    n = libnet_pblock_append(l, p, ((u_int8_t *)&dns_hdr)+ offset, h_len);
+    if (n == -1)
+    {
+        goto bad;
+    }
+
+    if ((payload && !payload_s) || (!payload && payload_s))
+    {
+         snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
+			     "%s(): payload inconsistency\n", __func__);
+        goto bad;
+    }
+ 
+    if (payload && payload_s)
+    {
+        n = libnet_pblock_append(l, p, payload, payload_s);
+        if (n == -1)
+        {
+            goto bad; 
+        }
+    }
+ 
+    return (ptag ? ptag : libnet_pblock_update(l, p, h, LIBNET_PBLOCK_DNSV4_H));
+bad:
+    libnet_pblock_delete(l, p);
+    return (-1);
+}
+
+/* EOF */

data/libnet/src/libnet_build_ethernet.c

@@ -0,0 +1,173 @@
+/*
+ *  $Id: libnet_build_ethernet.c,v 1.8 2004/01/03 20:31:01 mike Exp $
+ *
+ *  libnet
+ *  libnet_build_ethernet.c - ethernet 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.
+ *
+ */
+
+#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_ethernet(u_int8_t *dst, u_int8_t *src, u_int16_t type, u_int8_t *payload,
+            u_int32_t payload_s, libnet_t *l, libnet_ptag_t ptag)
+{
+    u_int32_t n, h;
+    libnet_pblock_t *p;
+    struct libnet_ethernet_hdr eth_hdr;
+
+    if (l == NULL)
+    { 
+        return (-1);
+    } 
+
+    /* sanity check injection type if we're not in advanced mode */
+    if (l->injection_type != LIBNET_LINK &&
+            !(((l->injection_type) & LIBNET_ADV_MASK)))
+    {
+         snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
+            "%s(): called with non-link layer wire injection primitive",
+                    __func__);
+        p = NULL;
+        goto bad;
+    }
+
+    n = LIBNET_ETH_H + payload_s;
+    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_ETH_H);
+    if (p == NULL)
+    {
+        return (-1);
+    }
+
+	memset(&eth_hdr, 0, sizeof(eth_hdr));
+	memcpy(eth_hdr.ether_dhost, dst, ETHER_ADDR_LEN);  /* destination address */
+    memcpy(eth_hdr.ether_shost, src, ETHER_ADDR_LEN);  /* source address */
+    eth_hdr.ether_type = htons(type);                  /* packet type */
+
+    n = libnet_pblock_append(l, p, (u_int8_t *)&eth_hdr, LIBNET_ETH_H);
+    if (n == -1)
+    {
+        goto bad;
+    }
+
+    if ((payload && !payload_s) || (!payload && payload_s))
+    {
+         snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
+			     "%s(): payload inconsistency\n", __func__);
+        goto bad;
+    }
+ 
+    if (payload && payload_s)
+    {
+        n = libnet_pblock_append(l, p, payload, payload_s);
+        if (n == -1)
+        {
+            goto bad;
+        }
+    }
+ 
+    return (ptag ? ptag : libnet_pblock_update(l, p, h, LIBNET_PBLOCK_ETH_H));
+bad:
+    libnet_pblock_delete(l, p);
+    return (-1);
+}
+
+
+libnet_ptag_t
+libnet_autobuild_ethernet(u_int8_t *dst, u_int16_t type, libnet_t *l)
+{
+    u_int32_t n, h;
+    struct libnet_ether_addr *src;
+    libnet_pblock_t *p;
+    libnet_ptag_t ptag;
+    struct libnet_ethernet_hdr eth_hdr;
+
+    if (l == NULL)
+    { 
+        return (-1);
+    } 
+
+    /* sanity check injection type if we're not in advanced mode */
+    if (l->injection_type != LIBNET_LINK &&
+            !(((l->injection_type) & LIBNET_ADV_MASK)))
+    {
+         snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
+            "libnet_autobuild_ethernet() called with non-link layer wire"
+            " injection primitive");
+        p = NULL;
+        goto bad;
+    }
+
+    n = LIBNET_ETH_H;
+    h = 0;
+    ptag = LIBNET_PTAG_INITIALIZER;
+    src = libnet_get_hwaddr(l);
+    if (src == NULL)
+    {
+        /* err msg set in libnet_get_hwaddr() */
+        return (-1);
+    }
+
+    /*
+     *  Create a new pblock. 
+     */
+    p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_ETH_H);
+    if (p == NULL)
+    {
+        return (-1);
+    }
+
+	memset(&eth_hdr, 0, sizeof(eth_hdr));
+	memcpy(eth_hdr.ether_dhost, dst, ETHER_ADDR_LEN);  /* destination address */
+    memcpy(eth_hdr.ether_shost, src, ETHER_ADDR_LEN);  /* source address */
+    eth_hdr.ether_type = htons(type);                  /* packet type */
+
+    n = libnet_pblock_append(l, p, (u_int8_t *)&eth_hdr, LIBNET_ETH_H);
+    if (n == -1)
+    {
+        goto bad;
+    }
+
+    return (libnet_pblock_update(l, p, h, LIBNET_PBLOCK_ETH_H));
+bad:
+    libnet_pblock_delete(l, p);
+    return (-1); 
+}
+/* EOF */

data/libnet/src/libnet_build_fddi.c

@@ -0,0 +1,191 @@
+/*
+ *  libnet
+ *  libnet_build_fddi.c - Fiber Distributed Data Interface packet assembler
+ *
+ *  Copyright (c) 1998 - 2004 Mike D. Schiffman <mike@infonexus.com>
+ *                            Jason Damron      <jsdamron@hushmail.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.
+ *
+ */
+
+#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_fddi(u_int8_t fc, u_int8_t *dst, u_int8_t *src, u_int8_t dsap,
+u_int8_t ssap, u_int8_t cf, u_int8_t *org, u_int16_t type, u_int8_t *payload,
+u_int32_t payload_s, libnet_t *l, libnet_ptag_t ptag)
+{
+    u_int32_t n, h;
+    u_int16_t protocol_type;
+    libnet_pblock_t *p;
+    struct libnet_fddi_hdr fddi_hdr;
+
+    if (l == NULL)
+    { 
+        return (-1);
+    } 
+
+    /* sanity check injection type if we're not in advanced mode */
+    if (l->injection_type != LIBNET_LINK &&
+            !(((l->injection_type) & LIBNET_ADV_MASK)))
+    {
+         snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
+            "%s(): called with non-link layer wire injection primitive",
+                    __func__);
+        p = NULL;
+        goto bad;
+    }
+
+    n = LIBNET_FDDI_H + payload_s;
+    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_FDDI_H);
+    if (p == NULL)
+    {
+        return (-1);
+    }
+
+    memset(&fddi_hdr, 0, sizeof(fddi_hdr));
+    fddi_hdr.fddi_frame_control     = fc;            /* Class/Format/Priority */
+    memcpy(fddi_hdr.fddi_dhost, dst, FDDI_ADDR_LEN);  /* dst fddi address */
+    memcpy(fddi_hdr.fddi_shost, src, FDDI_ADDR_LEN);  /* source fddi address */
+    fddi_hdr.fddi_llc_dsap          = dsap;           /* */
+    fddi_hdr.fddi_llc_ssap          = ssap;           /* */
+    fddi_hdr.fddi_llc_control_field = cf;             /* Class/Format/Priority */
+    memcpy(&fddi_hdr.fddi_llc_org_code, org, LIBNET_ORG_CODE_SIZE); 
+
+    /* Deal with unaligned int16_t for type */
+    protocol_type = htons(type);
+    memcpy(&fddi_hdr.fddi_type, &protocol_type, sizeof(int16_t));   /* Protocol Type */
+
+    n = libnet_pblock_append(l, p, (u_int8_t *)&fddi_hdr, LIBNET_FDDI_H);
+    if (n == -1)
+    {
+        goto bad;
+    }
+ 
+    if ((payload && !payload_s) || (!payload && payload_s))
+    {
+         snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
+			     "%s(): payload inconsistency\n", __func__);
+        goto bad;
+    }
+
+    if (payload && payload_s)
+    {
+        n = libnet_pblock_append(l, p, payload, payload_s);
+        if (n == -1)
+        {
+            goto bad;
+        }
+    }
+ 
+    return (ptag ? ptag : libnet_pblock_update(l, p, h, LIBNET_PBLOCK_FDDI_H));
+bad:
+    libnet_pblock_delete(l, p);
+    return (-1);
+}
+
+
+libnet_ptag_t
+libnet_autobuild_fddi(u_int8_t fc, u_int8_t *dst, u_int8_t dsap, u_int8_t ssap,
+                      u_int8_t cf, u_int8_t *org, u_int16_t type, libnet_t *l)
+{
+    u_int32_t n, h;
+    u_int16_t protocol_type;
+    struct libnet_fddi_addr *src;
+    libnet_pblock_t *p;
+    libnet_ptag_t ptag;
+    struct libnet_fddi_hdr fddi_hdr;
+
+    if (l == NULL)
+    { 
+        return (-1);
+    } 
+
+    /* sanity check injection type if we're not in advanced mode */
+    if (l->injection_type != LIBNET_LINK &&
+            !(((l->injection_type) & LIBNET_ADV_MASK)))
+    {
+         snprintf(l->err_buf, LIBNET_ERRBUF_SIZE,
+            "%s(): called with non-link layer wire injection primitive",
+                    __func__);
+        p = NULL;
+        goto bad;
+    }
+
+    n = LIBNET_FDDI_H;
+    h = 0;
+    ptag = LIBNET_PTAG_INITIALIZER;
+
+    /* FDDI and Ethernet have the same address size - so just typecast */
+    src = (struct libnet_fddi_addr *) libnet_get_hwaddr(l);
+    if (src == NULL)
+    {
+        /* err msg set in libnet_get_hwaddr() */
+        return (-1);
+    }
+
+    p = libnet_pblock_probe(l, ptag, n, LIBNET_PBLOCK_FDDI_H);
+    if (p == NULL)
+    {
+        return (-1);
+    }
+
+	memset(&fddi_hdr, 0, sizeof(fddi_hdr));
+	fddi_hdr.fddi_frame_control     = fc;             /* Class/Format/Priority */
+    memcpy(fddi_hdr.fddi_dhost, dst, FDDI_ADDR_LEN);  /* destination fddi address */
+    memcpy(fddi_hdr.fddi_shost, src, FDDI_ADDR_LEN);  /* source fddi address */
+    fddi_hdr.fddi_llc_dsap          = dsap;           /* */
+    fddi_hdr.fddi_llc_ssap          = ssap;           /* */
+    fddi_hdr.fddi_llc_control_field = cf;             /* Class/Format/Priority */
+    memcpy(&fddi_hdr.fddi_llc_org_code, org, LIBNET_ORG_CODE_SIZE); 
+
+    /* Deal with unaligned int16_t for type */
+    protocol_type = htons(type);
+    memcpy(&fddi_hdr.fddi_type, &protocol_type, sizeof(int16_t));   /* Protocol Type */
+
+    n = libnet_pblock_append(l, p, (u_int8_t *)&fddi_hdr, LIBNET_FDDI_H);
+    if (n == -1)
+    {
+        goto bad;
+    }
+
+    return (libnet_pblock_update(l, p, h, LIBNET_PBLOCK_FDDI_H));
+bad:
+    libnet_pblock_delete(l, p);
+    return (-1); 
+}
+/* EOF */