Annotation of embedaddon/libnet/sample/mpls.c, revision 1.1
1.1 ! misho 1: /*
! 2: * $Id: mpls.c,v 1.3 2004/03/01 20:26:12 mike Exp $
! 3: *
! 4: * libnet 1.1
! 5: * Build an MPLS packet
! 6: *
! 7: * Copyright (c) 1998 - 2004 Mike D. Schiffman <mike@infonexus.com>
! 8: * All rights reserved.
! 9: *
! 10: * Redistribution and use in source and binary forms, with or without
! 11: * modification, are permitted provided that the following conditions
! 12: * are met:
! 13: * 1. Redistributions of source code must retain the above copyright
! 14: * notice, this list of conditions and the following disclaimer.
! 15: * 2. Redistributions in binary form must reproduce the above copyright
! 16: * notice, this list of conditions and the following disclaimer in the
! 17: * documentation and/or other materials provided with the distribution.
! 18: *
! 19: * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
! 20: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
! 21: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
! 22: * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
! 23: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
! 24: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
! 25: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
! 26: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
! 27: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
! 28: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
! 29: * SUCH DAMAGE.
! 30: *
! 31: */
! 32:
! 33: #if (HAVE_CONFIG_H)
! 34: #include "../include/config.h"
! 35: #endif
! 36: #include "./libnet_test.h"
! 37:
! 38: int
! 39: main(int argc, char *argv[])
! 40: {
! 41: int c;
! 42: u_char *cp;
! 43: libnet_t *l;
! 44: libnet_ptag_t t;
! 45: u_char *payload;
! 46: u_long payload_s;
! 47: u_long src_ip, dst_ip;
! 48: u_short src_prt, dst_prt;
! 49: char errbuf[LIBNET_ERRBUF_SIZE];
! 50:
! 51: printf("libnet 1.1 packet shaping: MPLS[link]\n");
! 52:
! 53: /*
! 54: * Initialize the library. Root priviledges are required.
! 55: */
! 56: l = libnet_init(
! 57: LIBNET_LINK_ADV, /* injection type */
! 58: NULL, /* network interface */
! 59: errbuf); /* error buffer */
! 60:
! 61: if (l == NULL)
! 62: {
! 63: fprintf(stderr, "libnet_init() failed: %s", errbuf);
! 64: exit(EXIT_FAILURE);
! 65: }
! 66:
! 67: src_ip = 0;
! 68: dst_ip = 0;
! 69: src_prt = 0;
! 70: dst_prt = 0;
! 71: payload = NULL;
! 72: payload_s = 0;
! 73: while ((c = getopt(argc, argv, "d:s:p:")) != EOF)
! 74: {
! 75: switch (c)
! 76: {
! 77: /*
! 78: * We expect the input to be of the form `ip.ip.ip.ip.port`. We
! 79: * point cp to the last dot of the IP address/port string and
! 80: * then seperate them with a NULL byte. The optarg now points to
! 81: * just the IP address, and cp points to the port.
! 82: */
! 83: case 'd':
! 84: if (!(cp = strrchr(optarg, '.')))
! 85: {
! 86: usage(argv[0]);
! 87: }
! 88: *cp++ = 0;
! 89: dst_prt = (u_short)atoi(cp);
! 90: if ((dst_ip = libnet_name2addr4(l, optarg, LIBNET_RESOLVE)) == -1)
! 91: {
! 92: fprintf(stderr, "Bad destination IP address: %s\n", optarg);
! 93: exit(EXIT_FAILURE);
! 94: }
! 95: break;
! 96: case 's':
! 97: if (!(cp = strrchr(optarg, '.')))
! 98: {
! 99: usage(argv[0]);
! 100: }
! 101: *cp++ = 0;
! 102: src_prt = (u_short)atoi(cp);
! 103: if ((src_ip = libnet_name2addr4(l, optarg, LIBNET_RESOLVE)) == -1)
! 104: {
! 105: fprintf(stderr, "Bad source IP address: %s\n", optarg);
! 106: exit(EXIT_FAILURE);
! 107: }
! 108: break;
! 109: case 'p':
! 110: payload = optarg;
! 111: payload_s = strlen(payload);
! 112: break;
! 113: default:
! 114: exit(EXIT_FAILURE);
! 115: }
! 116: }
! 117:
! 118: if (!src_ip || !src_prt || !dst_ip || !dst_prt)
! 119: {
! 120: usage(argv[0]);
! 121: exit(EXIT_FAILURE);
! 122: }
! 123:
! 124: t = libnet_build_tcp(
! 125: src_prt, /* source port */
! 126: dst_prt, /* destination port */
! 127: 0xffffffff, /* sequence number */
! 128: 0x00000000, /* acknowledgement num */
! 129: TH_SYN, /* control flags */
! 130: 32767, /* window size */
! 131: 0, /* checksum */
! 132: 0, /* urgent pointer */
! 133: LIBNET_TCP_H + payload_s, /* TCP packet size */
! 134: payload, /* payload */
! 135: payload_s, /* payload size */
! 136: l, /* libnet handle */
! 137: 0); /* libnet id */
! 138: if (t == -1)
! 139: {
! 140: fprintf(stderr, "Can't build TCP header: %s\n", libnet_geterror(l));
! 141: goto bad;
! 142: }
! 143:
! 144: t = libnet_build_ipv4(
! 145: LIBNET_IPV4_H + LIBNET_TCP_H + payload_s, /* length */
! 146: 0, /* TOS */
! 147: 242, /* IP ID */
! 148: 0, /* IP Frag */
! 149: 64, /* TTL */
! 150: IPPROTO_TCP, /* protocol */
! 151: 0, /* checksum */
! 152: src_ip, /* source IP */
! 153: dst_ip, /* destination IP */
! 154: NULL, /* payload */
! 155: 0, /* payload size */
! 156: l, /* libnet handle */
! 157: 0); /* libnet id */
! 158: if (t == -1)
! 159: {
! 160: fprintf(stderr, "Can't build IP header: %s\n", libnet_geterror(l));
! 161: goto bad;
! 162: }
! 163:
! 164:
! 165: t = libnet_build_mpls(
! 166: 29, /* label */
! 167: 4, /* experimental */
! 168: LIBNET_MPLS_BOS_ON, /* bottom of stack */
! 169: 0xff, /* ttl */
! 170: NULL, /* payload */
! 171: 0, /* payload size */
! 172: l, /* libnet handle */
! 173: 0); /* libnet id */
! 174: if (t == -1)
! 175: {
! 176: fprintf(stderr, "Can't build MPLS header: %s\n", libnet_geterror(l));
! 177: goto bad;
! 178: }
! 179: t = libnet_build_mpls(
! 180: 39, /* label */
! 181: 5, /* experimental */
! 182: LIBNET_MPLS_BOS_ON, /* bottom of stack */
! 183: 0xef, /* ttl */
! 184: NULL, /* payload */
! 185: 0, /* payload size */
! 186: l, /* libnet handle */
! 187: 0); /* libnet id */
! 188: if (t == -1)
! 189: {
! 190: fprintf(stderr, "Can't build MPLS header: %s\n", libnet_geterror(l));
! 191: goto bad;
! 192: }
! 193: t = libnet_build_mpls(
! 194: 59, /* label */
! 195: 6, /* experimental */
! 196: LIBNET_MPLS_BOS_ON, /* bottom of stack */
! 197: 0x0f, /* ttl */
! 198: NULL, /* payload */
! 199: 0, /* payload size */
! 200: l, /* libnet handle */
! 201: 0); /* libnet id */
! 202: if (t == -1)
! 203: {
! 204: fprintf(stderr, "Can't build MPLS header: %s\n", libnet_geterror(l));
! 205: goto bad;
! 206: }
! 207:
! 208: t = libnet_build_ethernet(
! 209: enet_dst, /* ethernet destination */
! 210: enet_src, /* ethernet source */
! 211: ETHERTYPE_MPLS, /* protocol type */
! 212: NULL, /* payload */
! 213: 0, /* payload size */
! 214: l, /* libnet handle */
! 215: 0); /* libnet id */
! 216: if (t == -1)
! 217: {
! 218: fprintf(stderr, "Can't build ethernet header: %s\n", libnet_geterror(l));
! 219: goto bad;
! 220: }
! 221:
! 222: /*
! 223: * Write it to the wire.
! 224: */
! 225: c = libnet_write(l);
! 226: if (c == -1)
! 227: {
! 228: fprintf(stderr, "Write error: %s\n", libnet_geterror(l));
! 229: goto bad;
! 230: }
! 231: else
! 232: {
! 233: fprintf(stderr, "Wrote %d byte MPLS frame; check the wire.\n", c);
! 234: }
! 235: libnet_destroy(l);
! 236: return (EXIT_SUCCESS);
! 237: bad:
! 238: libnet_destroy(l);
! 239: return (EXIT_FAILURE);
! 240: }
! 241:
! 242: void
! 243: usage(char *name)
! 244: {
! 245: fprintf(stderr,
! 246: "usage: %s -s source_ip.source_port -d destination_ip.destination_port"
! 247: " [-p payload]\n",
! 248: name);
! 249: }
! 250:
! 251: /* EOF */
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>