githubmirror/libnet

sample/stp.c
225 строк7 KB
Joachim Nilsson
Drop gratuitous EOF and end of file
06 окт 2019, 09:27
06 окт 2019, 09:2797ff452
/*
 *  $Id: stp.c,v 1.3 2004/01/21 19:01:29 mike Exp $
 *
 *  libnet 1.1
 *  Build an STP frame
 *
 *  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
#include "./libnet_test.h"

#define CONF    1
#define TCN     2

int
main(int argc, char *argv[])
{
    int c, len, type;
    libnet_t *l;
    libnet_ptag_t t;
    u_char *dst, *src;
    u_char rootid[8], bridgeid[8];
    char *device = NULL;
    char errbuf[LIBNET_ERRBUF_SIZE];

    printf("libnet 1.1 packet shaping: [STP]\n"); 

    device = NULL;
    src = dst = NULL;
    type = CONF;
    while ((c = getopt(argc, argv, "cd:i:s:t")) != EOF)
    {
        switch (c)
        {
            case 'c':
                type = CONF;
                break;
            case 'd':
                dst = libnet_hex_aton(optarg, &len);
                break;
            case 'i':
                device = optarg;
                break;
            case 's':
                src = libnet_hex_aton(optarg, &len);
                break;
            case 't':
                type = TCN;
                break;
            default:
                usage(argv[0]);
                exit(EXIT_FAILURE);
        }
    }

    if (src == NULL || dst == NULL)
    {
        usage(argv[0]);
        exit(EXIT_FAILURE);
    }

    /*
     *  Initialize the library.  Root priviledges are required.
     */
    l = libnet_init(
            LIBNET_LINK,                            /* injection type */
            device,                                 /* network interface */
            errbuf);                                /* errbuf */

    if (l == NULL)
    {
        fprintf(stderr, "libnet_init() failed: %s", errbuf);
        exit(EXIT_FAILURE);
    }

    if (type == CONF)
    {
        rootid[0] = 0x80;
        rootid[1] = 0x00;
        rootid[2] = 0x00;
        rootid[3] = 0x07;
        rootid[4] = 0xec;
        rootid[5] = 0xae;
        rootid[6] = 0x30;
        rootid[7] = 0x41;

        bridgeid[0] = 0x80;
        bridgeid[1] = 0x00;
        bridgeid[2] = 0x00;
        bridgeid[3] = 0x07;
        bridgeid[4] = 0xec;
        bridgeid[5] = 0xae;
        bridgeid[6] = 0x30;
        bridgeid[7] = 0x41;

        t = libnet_build_stp_conf(
            0x0000,                             /* protocol id */
            0x00,                               /* protocol version */
            0x00,                               /* BPDU type */
            0x00,                               /* BPDU flags */
            rootid,                             /* root id */
            0x00000001,                         /* root path cost */
            bridgeid,                           /* bridge id */
            0x8002,                             /* port id */
            0x00,                               /* message age */
            0x0014,                             /* max age */
            0x0002,                             /* hello time */
            0x000f,                             /* forward delay */
            NULL,                               /* payload */
            0,                                  /* payload size */
            l,                                  /* libnet handle */
            0);                                 /* libnet id */
        if (t == -1)
        {
            fprintf(stderr, "Can't build STP conf header: %s\n",
                    libnet_geterror(l));
            goto bad;
        }
    }
    else
    {
        t = libnet_build_stp_tcn(
            0x0000,                             /* protocol id */
            0x00,                               /* protocol version */
            0x80,                               /* BPDU type */
            NULL,                               /* payload */
            0,                                  /* payload size */
            l,                                  /* libnet handle */
            0);                                 /* libnet id */
        if (t == -1)
        {
            fprintf(stderr, "Can't build STP tcn header: %s\n",
                    libnet_geterror(l));
            goto bad;
        }
    }

    t = libnet_build_802_2(
        LIBNET_SAP_STP,                         /* DSAP */   
        LIBNET_SAP_STP,                         /* SSAP */
        0x03,                                   /* control */
        NULL,                                   /* payload */  
        0,                                      /* payload size */
        l,                                      /* libnet handle */
        0);                                     /* libnet id */
    if (t == -1) 
    {
        fprintf(stderr, "Can't build ethernet header: %s\n",
                libnet_geterror(l));
        goto bad;
    }  

    t = libnet_build_802_3(
        dst,                                    /* ethernet destination */
        src,                                    /* ethernet source */
        LIBNET_802_2_H + ((type == CONF) ? LIBNET_STP_CONF_H : 
        LIBNET_STP_TCN_H),                       /* frame size */
        NULL,                                   /* payload */
        0,                                      /* payload size */
        l,                                      /* libnet handle */
        0);                                     /* libnet id */
    if (t == -1)
    {
        fprintf(stderr, "Can't build ethernet header: %s\n",
                libnet_geterror(l));
        goto bad;
    }
    /*
     *  Write it to the wire.
     */
    c = libnet_write(l);

    if (c == -1)
    {
        fprintf(stderr, "Write error: %s\n", libnet_geterror(l));
        goto bad;
    }
    else
    {
        fprintf(stderr, "Wrote %d byte STP packet; check the wire.\n", c);
    }
    free(dst);
    free(src);
    libnet_destroy(l);
    return (EXIT_SUCCESS);
bad:
    free(dst);
    free(src);
    libnet_destroy(l);
    return (EXIT_FAILURE);
}


void
usage(char *name)
{
    fprintf(stderr, "usage %s -d dst -s src -t -c [-i interface]\n",
                name);
}