diff options
Diffstat (limited to 'libnet/sample/stp.c')
| -rw-r--r-- | libnet/sample/stp.c | 227 |
1 files changed, 227 insertions, 0 deletions
diff --git a/libnet/sample/stp.c b/libnet/sample/stp.c new file mode 100644 index 0000000..16498b3 --- /dev/null +++ b/libnet/sample/stp.c @@ -0,0 +1,227 @@ +/* + * $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); +} + +/* EOF */ |