src/trafgen.c

   1 /*
   2  * netsniff-ng - the packet sniffing beast
   3  * By Daniel Borkmann <daniel@netsniff-ng.org>
   4  * Copyright 2011 Daniel Borkmann <dborkma@tik.ee.ethz.ch>,
   5  * Swiss federal institute of technology (ETH Zurich)
   6  * Subject to the GPL, version 2.
   7  *
   8  * A high-performance network traffic generator that uses the zero-copy
   9  * kernelspace TX_RING for network I/O. On comodity Gigabit hardware up
  10  * to 1,488,095 pps 64 Byte pps have been achieved with 2 trafgen instances
  11  * bound to different CPUs from the userspace and turned off pause frames,
  12  * ask Ronald from NST (Network Security Toolkit) for more details. ;-)
  13  * So, this line-rate result is the very same as pktgen from kernelspace!
  14  *
  15  *   Who can now hold the fords when the King of the Nine Riders comes? And
  16  *   other armies will come. I am too late. All is lost. I tarried on the
  17  *   way. All is lost. Even if my errand is performed, no one will ever
  18  *   know. There will be no one I can tell. It will be in vain.
  19  *
  20  *     -- The Lord of the Rings, Frodo thinking,
  21  *        Chapter 'The Stairs of Cirith Ungol'.
  22  */
  23
  24 /*
  25
  26 =head1 NAME
  27
  28 trafgen - a high-performance zero-copy network packet generator
  29
  30 =head1 SYNOPSIS
  31
  32 trafgen -d|--dev <netdev> -c|--conf <file> [-J|--jumbo-support][-n|--num <uint>]
  33         [-r|--rand][-t|--gap <usec>][-S|--ring-size <size>]
  34         [-k|--kernel-pull <usec>][-b|--bind-cpu <cpu>][-B|--unbind-cpu <cpu>]
  35         [-H|--prio-high][-Q|--notouch-irq][-v|--version][-h|--help]
  36
  37 =head1 DESCRIPTION
  38
  39 A high-performance network traffic generator that uses the zero-copy TX_RING
  40 for network I/O. For instance, on comodity Gigabit hardware up to 1,488,095 pps
  41 64 Byte pps have been achieved with trafgen.
  42
  43 =head1 OPTIONS
  44
  45 =over
  46
  47 =item trafgen --dev eth0 --conf trafgen.txf --bind-cpu 0
  48
  49 Use packet configuration trafgen.txf, eth0 as transmission device and CPU0
  50 for binding the process.
  51
  52 =back
  53
  54 =head1 OPTIONS
  55
  56 =over
  57
  58 =item -h|--help
  59
  60 Print help text and lists all options.
  61
  62 =item -v|--version
  63
  64 Print version.
  65
  66 =item -d|--dev <netdev>
  67
  68 Device for transmission i.e., eth0.
  69
  70 =item -c|--conf <conf>
  71
  72 Path to packet configuration file.
  73
  74 =item -J|--jumbo-support
  75
  76 Support for 64KB Super Jumbo Frames
  77
  78 =item -n|--num <uint>
  79
  80 Number of packets to generate before exiting.
  81 0 means forever until SIGINT.
  82
  83 =item -r|--rand
  84
  85 Randomize packet selection process instead of round-robin.
  86
  87 =item -t|--gap <uint>
  88
  89 Interpacket gap in microseconds.
  90
  91 =item -S|--ring-size <size>
  92
  93 Manually set ring size to <size>: mmap space in KB/MB/GB.
  94
  95 =item -k|--kernel-pull <uint>
  96
  97 Kernel pull from user interval in microseconds.
  98 Default value is 10 microseconds.
  99
 100 =item -b|--bind-cpu <cpu>
 101
 102 Bind to specific CPU (or CPU-range).
 103
 104 =item -B|--unbind-cpu <cpu>
 105
 106 Forbid to use specific CPU (or CPU-range).
 107
 108 =item -H|--prio-high
 109
 110 Make this high priority process.
 111
 112 =item -Q|--notouch-irq
 113
 114 Do not touch IRQ CPU affinity of NIC.
 115
 116 =back
 117
 118 =head1 EXAMPLES
 119
 120 =over
 121
 122 =item Generate traffic defined in trafgen.txf on eth0 using CPU 0
 123
 124 trafgen --dev eth0 --conf trafgen.txf --bind-cpu 0
 125
 126 =item Generate traffic on eth0 using CPU 0, wait 100 us between packets
 127
 128 trafgen --dev eth0 --conf trafgen.txf --bind-cpu 0 --gap 100
 129
 130 =item Generate 100,000 packet on eth0 using CPU 0
 131
 132 trafgen --dev eth0 --conf trafgen.txf --bind-cpu 0 --num 100000
 133
 134 =back
 135
 136 =head1 AUTHOR
 137
 138 Written by Daniel Borkmann <daniel@netsniff-ng.org>
 139
 140 =head1 DOCUMENTATION
 141
 142 Documentation by Emmanuel Roullit <emmanuel@netsniff-ng.org>
 143
 144 =head1 BUGS
 145
 146 Please report bugs to <bugs@netsniff-ng.org>
 147
 148 =cut
 149
 150 */
 151
 152 #include <stdio.h>
 153 #include <string.h>
 154 #include <getopt.h>
 155 #include <ctype.h>
 156 #include <stdbool.h>
 157 #include <sys/socket.h>
 158 #include <sys/types.h>
 159 #include <sys/stat.h>
 160 #include <sys/time.h>
 161 #include <signal.h>
 162 #include <stdint.h>
 163 #include <stdlib.h>
 164 #include <assert.h>
 165 #include <fcntl.h>
 166 #include <time.h>
 167 #include <net/ethernet.h>
 168
 169 #include "xmalloc.h"
 170 #include "opt_memcpy.h"
 171 #include "strlcpy.h"
 172 #include "parser.h"
 173 #include "die.h"
 174 #include "netdev.h"
 175 #include "psched.h"
 176 #include "xio.h"
 177 #include "tty.h"
 178 #include "timespec.h"
 179 #include "mtrand.h"
 180 #include "signals.h"
 181 #include "ring_tx.h"
 182
 183 struct counter {
 184         uint16_t id;
 185         uint8_t min;
 186         uint8_t max;
 187         uint8_t inc;
 188         uint8_t val;
 189         off_t off;
 190 };
 191
 192 struct randomizer {
 193         uint8_t val;
 194         off_t off;
 195 };
 196
 197 struct packet {
 198         uint8_t *payload;
 199         size_t plen;
 200         struct counter *cnt;
 201         size_t clen;
 202         struct randomizer *rnd;
 203         size_t rlen;
 204 };
 205
 206 struct pktconf {
 207         unsigned long num;
 208         unsigned long gap;
 209         struct packet *pkts;
 210         size_t len;
 211 };
 212
 213 struct stats {
 214         unsigned long tx_bytes;
 215         unsigned long tx_packets;
 216 };
 217
 218 struct mode {
 219         struct stats stats;
 220         char *device;
 221         int cpu;
 222         int rand;
 223         unsigned long kpull;
 224         /* 0 for automatic, > 0 for manual */
 225         unsigned int reserve_size;
 226         int jumbo_support;
 227 };
 228
 229 #define CPU_UNKNOWN  -1
 230 #define CPU_NOTOUCH  -2
 231
 232 sig_atomic_t sigint = 0;
 233
 234 static const char *short_options = "d:c:n:t:vJhS:HQb:B:rk:";
 235
 236 static struct option long_options[] = {
 237         {"dev", required_argument, 0, 'd'},
 238         {"conf", required_argument, 0, 'c'},
 239         {"num", required_argument, 0, 'n'},
 240         {"gap", required_argument, 0, 't'},
 241         {"ring-size", required_argument, 0, 'S'},
 242         {"bind-cpu", required_argument, 0, 'b'},
 243         {"unbind-cpu", required_argument, 0, 'B'},
 244         {"kernel-pull", required_argument, 0, 'k'},
 245         {"jumbo-support", no_argument, 0, 'J'},
 246         {"rand", no_argument, 0, 'r'},
 247         {"prio-high", no_argument, 0, 'H'},
 248         {"notouch-irq", no_argument, 0, 'Q'},
 249         {"version", no_argument, 0, 'v'},
 250         {"help", no_argument, 0, 'h'},
 251         {0, 0, 0, 0}
 252 };
 253
 254 static struct itimerval itimer;
 255 static int sock;
 256 static unsigned long interval = TX_KERNEL_PULL_INT;
 257
 258 static inline uint8_t lcrand(uint8_t val)
 259 {
 260         return  0xFF & (3 * val + 3);
 261 }
 262
 263 static void signal_handler(int number)
 264 {
 265         switch (number) {
 266         case SIGINT:
 267                 sigint = 1;
 268                 break;
 269         case SIGHUP:
 270                 break;
 271         default:
 272                 break;
 273         }
 274 }
 275
 276 static void timer_elapsed(int number)
 277 {
 278         itimer.it_interval.tv_sec = 0;
 279         itimer.it_interval.tv_usec = interval;
 280         itimer.it_value.tv_sec = 0;
 281         itimer.it_value.tv_usec = interval;
 282
 283         pull_and_flush_tx_ring(sock);
 284         setitimer(ITIMER_REAL, &itimer, NULL);
 285 }
 286
 287 static void header(void)
 288 {
 289         printf("%s%s%s\n", colorize_start(bold), "trafgen "
 290                VERSION_STRING, colorize_end());
 291 }
 292
 293 static void help(void)
 294 {
 295         printf("\ntrafgen %s, high-perf zero-copy network packet generator\n",
 296                VERSION_STRING);
 297         printf("http://www.netsniff-ng.org\n\n");
 298         printf("Usage: trafgen [options]\n");
 299         printf("Options:\n");
 300         printf("  -d|--dev <netdev>      Networking Device i.e., eth0\n");
 301         printf("  -c|--conf <file>       Packet configuration file\n");
 302         printf("  -J|--jumbo-support     Support for 64KB Super Jumbo Frames\n");
 303         printf("                         Default TX slot: 2048Byte\n");
 304         printf("  -n|--num <uint>        Number of packets until exit\n");
 305         printf("  `--     0              Loop until interrupt (default)\n");
 306         printf("   `-     n              Send n packets and done\n");
 307         printf("  -r|--rand              Randomize packet selection process\n");
 308         printf("                         Instead of a round robin selection\n");
 309         printf("  -t|--gap <uint>        Interpacket gap in us (approx)\n");
 310         printf("  -S|--ring-size <size>  Manually set ring size to <size>:\n");
 311         printf("                         mmap space in KB/MB/GB, e.g. \'10MB\'\n");
 312         printf("  -k|--kernel-pull <uint>Kernel pull from user interval in us\n");
 313         printf("                         Default is 10us where the TX_RING\n");
 314         printf("                         is populated with payload from uspace\n");
 315         printf("  -b|--bind-cpu <cpu>    Bind to specific CPU (or CPU-range)\n");
 316         printf("  -B|--unbind-cpu <cpu>  Forbid to use specific CPU (or CPU-range)\n");
 317         printf("  -H|--prio-high         Make this high priority process\n");
 318         printf("  -Q|--notouch-irq       Do not touch IRQ CPU affinity of NIC\n");
 319         printf("  -v|--version           Show version\n");
 320         printf("  -h|--help              Guess what?!\n");
 321         printf("\n");
 322         printf("Examples:\n");
 323         printf("  See trafgen.txf for configuration file examples.\n");
 324         printf("  trafgen --dev eth0 --conf trafgen.txf --bind-cpu 0\n");
 325         printf("  trafgen --dev eth0 --conf trafgen.txf --rand --gap 1000\n");
 326         printf("  trafgen --dev eth0 --conf trafgen.txf --bind-cpu 0 --num 10 --rand\n");
 327         printf("\n");
 328         printf("Note:\n");
 329         printf("  This tool is targeted for network developers! You should\n");
 330         printf("  be aware of what you are doing and what these options above\n");
 331         printf("  mean! Only use this tool in an isolated LAN that you own!\n");
 332         printf("\n");
 333         printf("Please report bugs to <bugs@netsniff-ng.org>\n");
 334         printf("Copyright (C) 2011 Daniel Borkmann <dborkma@tik.ee.ethz.ch>,\n");
 335         printf("Swiss federal institute of technology (ETH Zurich)\n");
 336         printf("License: GNU GPL version 2\n");
 337         printf("This is free software: you are free to change and redistribute it.\n");
 338         printf("There is NO WARRANTY, to the extent permitted by law.\n\n");
 339
 340         die();
 341 }
 342
 343 static void version(void)
 344 {
 345         printf("\ntrafgen %s, high-perf zero-copy network packet generator\n",
 346                VERSION_STRING);
 347         printf("http://www.netsniff-ng.org\n\n");
 348         printf("Please report bugs to <bugs@netsniff-ng.org>\n");
 349         printf("Copyright (C) 2011 Daniel Borkmann <dborkma@tik.ee.ethz.ch>,\n");
 350         printf("Swiss federal institute of technology (ETH Zurich)\n");
 351         printf("License: GNU GPL version 2\n");
 352         printf("This is free software: you are free to change and redistribute it.\n");
 353         printf("There is NO WARRANTY, to the extent permitted by law.\n\n");
 354
 355         die();
 356 }
 357
 358 /*
 359  * TX_RING doen't allow us to specify inter-packet gaps, see
 360  * http://lingrok.org/source/xref/linux-2.6-linus/net/packet/af_packet.c,
 361  * function tpacket_fill_skb(), so instead, we use sendto(2). Since
 362  * this is also not high-perf, copying between address spaces is okay.
 363  */
 364 static void tx_tgap_or_die(struct mode *mode, struct pktconf *cfg)
 365 {
 366         int ifindex, mtu, ret;
 367         size_t l, c, r;
 368         struct sockaddr_ll s_addr;
 369         unsigned long num = 1;
 370         char *pkt;
 371         struct counter *cnt;
 372         struct randomizer *rnd;
 373
 374         if (!mode || !cfg)
 375                 panic("Panic over invalid args for TX trigger!\n");
 376         if (cfg->len == 0)
 377                 panic("Panic over invalid args for TX trigger!\n");
 378         if (!device_up_and_running(mode->device))
 379                 panic("Device not up and running!\n");
 380
 381         mtu = device_mtu(mode->device);
 382         for (l = 0; l < cfg->len; ++l) {
 383                 /* eth src + eth dst + type == 14, fcs added by driver */
 384                 if (cfg->pkts[l].plen > mtu + 14)
 385                         panic("Device MTU < than your packet size!\n");
 386                 if (cfg->pkts[l].plen <= 14)
 387                         panic("Device packet size too short!\n");
 388         }
 389
 390         set_memcpy();
 391         sock = pf_socket();
 392         pkt = xmalloc_aligned(mtu, 64);
 393         memset(pkt, 0, mtu);
 394         ifindex = device_ifindex(mode->device);
 395
 396         if (cfg->num > 0)
 397                 num = cfg->num;
 398
 399         printf("MD: TX %s %luus\n\n", mode->rand ? "RND" : "RR", cfg->gap);
 400         printf("Running! Hang up with ^C!\n\n");
 401
 402         memset(&s_addr, 0, sizeof(s_addr));
 403         s_addr.sll_family = PF_PACKET;
 404         s_addr.sll_halen = ETH_ALEN;
 405         s_addr.sll_ifindex = ifindex;
 406
 407         l = 0;
 408         while (likely(sigint == 0) && likely(num > 0)) {
 409                 for (c = 0; c < cfg->pkts[l].clen; ++c) {
 410                         cnt = &(cfg->pkts[l].cnt[c]);
 411                         cnt->val -= cnt->min;
 412                         cnt->val = (cnt->val + cnt->inc) %
 413                                    (cnt->max - cnt->min + 1);
 414                         cnt->val += cnt->min;
 415                         cfg->pkts[l].payload[cnt->off] = cnt->val;
 416                 }
 417
 418                 for (r = 0; r < cfg->pkts[l].rlen; ++r) {
 419                         rnd = &(cfg->pkts[l].rnd[r]);
 420                         rnd->val = lcrand(rnd->val);
 421                         cfg->pkts[l].payload[rnd->off] = rnd->val;
 422                 }
 423
 424                 __memcpy(pkt, cfg->pkts[l].payload, cfg->pkts[l].plen);
 425                 mode->stats.tx_bytes += cfg->pkts[l].plen;
 426                 mode->stats.tx_packets++;
 427
 428                 ret = sendto(sock, pkt, cfg->pkts[l].plen, 0,
 429                              (struct sockaddr *) &s_addr, sizeof(s_addr));
 430                 if (ret < 0)
 431                         whine("sendto error!\n");
 432                 if (mode->rand)
 433                         l = mt_rand_int32() % cfg->len;
 434                 else {
 435                         l++;
 436                         if (l >= cfg->len)
 437                                 l = 0;
 438                 }
 439                 if (cfg->num > 0)
 440                         num--;
 441
 442                 xusleep2(cfg->gap);
 443         }
 444
 445         close(sock);
 446         xfree(pkt);
 447
 448         fflush(stdout);
 449         printf("\n");
 450         printf("\r%12lu frames outgoing\n", mode->stats.tx_packets);
 451         printf("\r%12lu bytes outgoing\n", mode->stats.tx_bytes);
 452 }
 453
 454 static void tx_fire_or_die(struct mode *mode, struct pktconf *cfg)
 455 {
 456         int irq, ifindex, mtu;
 457         unsigned int size, it = 0;
 458         unsigned long num = 1;
 459         uint8_t *out = NULL;
 460         size_t l , c, r;
 461         struct ring tx_ring;
 462         struct frame_map *hdr;
 463         struct counter *cnt;
 464         struct randomizer *rnd;
 465
 466         if (!mode || !cfg)
 467                 panic("Panic over invalid args for TX trigger!\n");
 468         if (cfg->len == 0)
 469                 panic("Panic over invalid args for TX trigger!\n");
 470         if (!device_up_and_running(mode->device))
 471                 panic("Device not up and running!\n");
 472
 473         mtu = device_mtu(mode->device);
 474         for (l = 0; l < cfg->len; ++l) {
 475                 /* eth src + eth dst + type == 14, fcs added by driver */
 476                 if (cfg->pkts[l].plen > mtu + 14)
 477                         panic("Device MTU < than your packet size!\n");
 478                 if (cfg->pkts[l].plen <= 14)
 479                         panic("Device packet size too short!\n");
 480         }
 481
 482         set_memcpy();
 483         sock = pf_socket();
 484
 485         memset(&tx_ring, 0, sizeof(tx_ring));
 486
 487         ifindex = device_ifindex(mode->device);
 488         size = ring_size(mode->device, mode->reserve_size);
 489
 490         set_packet_loss_discard(sock);
 491         setup_tx_ring_layout(sock, &tx_ring, size, mode->jumbo_support);
 492         create_tx_ring(sock, &tx_ring);
 493         mmap_tx_ring(sock, &tx_ring);
 494         alloc_tx_ring_frames(&tx_ring);
 495         bind_tx_ring(sock, &tx_ring, ifindex);
 496         mt_init_by_seed_time();
 497
 498         if (mode->cpu >= 0 && ifindex > 0) {
 499                 irq = device_irq_number(mode->device);
 500                 device_bind_irq_to_cpu(mode->cpu, irq);
 501                 printf("IRQ: %s:%d > CPU%d\n", mode->device, irq,
 502                        mode->cpu);
 503         }
 504
 505         if (mode->kpull)
 506                 interval = mode->kpull;
 507         if (cfg->num > 0)
 508                 num = cfg->num;
 509
 510         printf("MD: FIRE %s %luus\n\n", mode->rand ? "RND" : "RR", interval);
 511         printf("Running! Hang up with ^C!\n\n");
 512
 513         itimer.it_interval.tv_sec = 0;
 514         itimer.it_interval.tv_usec = interval;
 515         itimer.it_value.tv_sec = 0;
 516         itimer.it_value.tv_usec = interval;
 517         setitimer(ITIMER_REAL, &itimer, NULL);
 518
 519         l = 0;
 520         while (likely(sigint == 0) && likely(num > 0)) {
 521                 while (user_may_pull_from_tx(tx_ring.frames[it].iov_base) &&
 522                        likely(num > 0)) {
 523                         hdr = tx_ring.frames[it].iov_base;
 524                         /* Kernel assumes: data = ph.raw + po->tp_hdrlen -
 525                          *                        sizeof(struct sockaddr_ll); */
 526                         out = ((uint8_t *) hdr) + TPACKET_HDRLEN -
 527                               sizeof(struct sockaddr_ll);
 528
 529                         hdr->tp_h.tp_snaplen = cfg->pkts[l].plen;
 530                         hdr->tp_h.tp_len = cfg->pkts[l].plen;
 531
 532                         for (c = 0; c < cfg->pkts[l].clen; ++c) {
 533                                 cnt = &(cfg->pkts[l].cnt[c]);
 534                                 cnt->val -= cnt->min;
 535                                 cnt->val = (cnt->val + cnt->inc) %
 536                                            (cnt->max - cnt->min + 1);
 537                                 cnt->val += cnt->min;
 538                                 cfg->pkts[l].payload[cnt->off] = cnt->val;
 539                         }
 540
 541                         for (r = 0; r < cfg->pkts[l].rlen; ++r) {
 542                                 rnd = &(cfg->pkts[l].rnd[r]);
 543                                 rnd->val = lcrand(rnd->val);
 544                                 cfg->pkts[l].payload[rnd->off] = rnd->val;
 545                         }
 546
 547                         __memcpy(out, cfg->pkts[l].payload, cfg->pkts[l].plen);
 548                         mode->stats.tx_bytes += cfg->pkts[l].plen;
 549                         mode->stats.tx_packets++;
 550
 551                         if (mode->rand)
 552                                 l = mt_rand_int32() % cfg->len;
 553                         else {
 554                                 l++;
 555                                 if (l >= cfg->len)
 556                                         l = 0;
 557                         }
 558
 559                         kernel_may_pull_from_tx(&hdr->tp_h);
 560                         next_slot(&it, &tx_ring);
 561
 562                         if (cfg->num > 0)
 563                                 num--;
 564                         if (unlikely(sigint == 1))
 565                                 break;
 566                 }
 567         }
 568
 569         destroy_tx_ring(sock, &tx_ring);
 570         close(sock);
 571
 572         fflush(stdout);
 573         printf("\n");
 574         printf("\r%12lu frames outgoing\n", mode->stats.tx_packets);
 575         printf("\r%12lu bytes outgoing\n", mode->stats.tx_bytes);
 576 }
 577
 578 #define TYPE_NUM 0
 579 #define TYPE_CNT 1
 580 #define TYPE_RND 2
 581 #define TYPE_EOL 3
 582
 583 static inline char *getuint_or_obj(char *in, uint32_t *out, int *type)
 584 {
 585         if (*in == '\n') {
 586                 *type = TYPE_EOL;
 587         } else if (*in == '$') {
 588                 in++;
 589                 if (!strncmp("II", in, strlen("II"))) {
 590                         in += 2;
 591                         in = getuint(in, out);
 592                         *type = TYPE_CNT;
 593                 } else if (!strncmp("PRB", in, strlen("PRB"))) {
 594                         *type = TYPE_RND;
 595                         in += 3;
 596                 } else
 597                         panic("Syntax error!\n");
 598         } else {
 599                 in = getuint(in, out);
 600                 *type = TYPE_NUM;
 601         }
 602
 603         return in;
 604 }
 605
 606 static void dump_conf(struct pktconf *cfg)
 607 {
 608         size_t i, j;
 609
 610         info("n %lu, gap %lu us, pkts %zu\n", cfg->num, cfg->gap, cfg->len);
 611         if (cfg->len == 0)
 612                 return;
 613
 614         for (i = 0; i < cfg->len; ++i) {
 615                 info("[%zu] pkt\n", i);
 616                 info(" len %zu cnts %zu rnds %zu\n", cfg->pkts[i].plen,
 617                      cfg->pkts[i].clen, cfg->pkts[i].rlen);
 618                 info(" payload ");
 619                 for (j = 0; j < cfg->pkts[i].plen; ++j)
 620                         info("%02x ", cfg->pkts[i].payload[j]);
 621                 info("\n");
 622                 for (j = 0; j < cfg->pkts[i].clen; ++j)
 623                         info(" cnt%zu [%u,%u], inc %u, off %zu\n",
 624                              j, cfg->pkts[i].cnt[j].min,
 625                              cfg->pkts[i].cnt[j].max,
 626                              cfg->pkts[i].cnt[j].inc,
 627                              cfg->pkts[i].cnt[j].off);
 628                 for (j = 0; j < cfg->pkts[i].rlen; ++j)
 629                         info(" rnd%zu off %zu\n",
 630                              j, cfg->pkts[i].rnd[j].off);
 631         }
 632 }
 633
 634 /* Seems to need a rewrite later ;-) */
 635 static void parse_conf_or_die(char *file, struct pktconf *cfg)
 636 {
 637         unsigned int withinpkt = 0;
 638         unsigned long line = 0;
 639         char *pb, buff[1024];
 640         FILE *fp;
 641         struct counter *cnts = NULL;
 642         size_t l = 0;
 643         off_t offset = 0;
 644
 645         if (!file || !cfg)
 646                 panic("Panic over invalid args for the parser!\n");
 647
 648         fp = fopen(file, "r");
 649         if (!fp)
 650                 panic("Cannot open config file!\n");
 651         memset(buff, 0, sizeof(buff));
 652
 653         info("CFG:\n");
 654         srand(time(NULL));
 655
 656         while (fgets(buff, sizeof(buff), fp) != NULL) {
 657                 line++;
 658                 buff[sizeof(buff) - 1] = 0;
 659                 pb = skips(buff);
 660
 661                 /* A comment or junk. Skip this line */
 662                 if (*pb == '#' || *pb == '\n') {
 663                         memset(buff, 0, sizeof(buff));
 664                         continue;
 665                 }
 666
 667                 if (!withinpkt && *pb == '$') {
 668                         pb++;
 669                         if (!strncmp("II", pb, strlen("II"))) {
 670                                 uint32_t id, min = 0, max = 0xFF, inc = 1;
 671                                 pb += 2;
 672                                 pb = getuint(pb, &id);
 673                                 pb = skipchar(pb, ':');
 674                                 pb = skips(pb);
 675                                 pb = getuint(pb, &min);
 676                                 pb = skipchar(pb, ',');
 677                                 pb = getuint(pb, &max);
 678                                 pb = skipchar(pb, ',');
 679                                 pb = getuint(pb, &inc);
 680                                 l++;
 681                                 cnts = xrealloc(cnts, 1, l * sizeof(*cnts));
 682                                 cnts[l - 1].id = 0xFF & id;
 683                                 cnts[l - 1].min = 0xFF & min;
 684                                 cnts[l - 1].max = 0xFF & max;
 685                                 cnts[l - 1].inc = 0xFF & inc;
 686                                 if (cnts[l - 1].min >= cnts[l - 1].max)
 687                                         panic("Counter min >= max!\n");
 688                                 if (cnts[l - 1].inc >= cnts[l - 1].max)
 689                                         panic("Counter inc >= max!\n");
 690                         } else if (!strncmp("P", pb, strlen("P"))) {
 691                                 uint32_t id;
 692                                 pb++;
 693                                 pb = getuint(pb, &id);
 694                                 pb = skips(pb);
 695                                 pb = skipchar(pb, '{');
 696                                 withinpkt = 1;
 697                                 cfg->len++;
 698                                 cfg->pkts = xrealloc(cfg->pkts, 1,
 699                                                      cfg->len * sizeof(*cfg->pkts));
 700                                 memset(&cfg->pkts[cfg->len - 1], 0,
 701                                        sizeof(cfg->pkts[cfg->len - 1]));
 702                                 offset = 0;
 703                         } else
 704                                 panic("Unknown instruction! Syntax error "
 705                                       "on line %lu!\n", line);
 706                 } else if (withinpkt && *pb == '}') {
 707                                 withinpkt = 0;
 708                 } else if (withinpkt) {
 709                         int type, i, found;
 710                         uint32_t val = 0;
 711                         while (1) {
 712                                 found = 0;
 713                                 pb = getuint_or_obj(pb, &val, &type);
 714                                 if (type == TYPE_EOL)
 715                                         break;
 716                                 if (type == TYPE_CNT) {
 717                                         size_t z;
 718                                         struct counter *new;
 719                                         for (i = 0; i < l; ++i) {
 720                                                 if (val == cnts[i].id) {
 721                                                         found = 1;
 722                                                         break;
 723                                                 }
 724                                         }
 725                                         if (!found)
 726                                                 panic("Counter %u not found!\n");
 727
 728                                         val = cnts[i].min;
 729                                         z = ++(cfg->pkts[cfg->len - 1].clen);
 730                                         cfg->pkts[cfg->len - 1].cnt =
 731                                                 xrealloc(cfg->pkts[cfg->len - 1].cnt,
 732                                                          1, z * sizeof(struct counter));
 733                                         new = &cfg->pkts[cfg->len - 1].cnt[z - 1];
 734                                         new->min = cnts[i].min;
 735                                         new->max = cnts[i].max;
 736                                         new->inc = cnts[i].inc;
 737                                         new->off = offset;
 738                                         new->val = val;
 739                                 } else if (type == TYPE_RND) {
 740                                         size_t z;
 741                                         struct randomizer *new;
 742
 743                                         val = 0xFF & rand();
 744                                         z = ++(cfg->pkts[cfg->len - 1].rlen);
 745                                         cfg->pkts[cfg->len - 1].rnd =
 746                                                 xrealloc(cfg->pkts[cfg->len - 1].rnd,
 747                                                          1, z * sizeof(struct randomizer));
 748                                         new = &cfg->pkts[cfg->len - 1].rnd[z - 1];
 749                                         new->val = val;
 750                                         new->off = offset;
 751                                 }
 752
 753                                 cfg->pkts[cfg->len - 1].plen++;
 754                                 cfg->pkts[cfg->len - 1].payload =
 755                                         xrealloc(cfg->pkts[cfg->len - 1].payload,
 756                                                  1, cfg->pkts[cfg->len - 1].plen);
 757                                 cfg->pkts[cfg->len - 1].payload[cfg->pkts[cfg->len - 1].plen - 1] =
 758                                         0xFF & val;
 759                                 offset++;
 760                                 pb = skipchar_s(pb, ',');
 761                         }
 762                 } else
 763                         panic("Syntax error!\n");
 764                 memset(buff, 0, sizeof(buff));
 765         }
 766
 767         fclose(fp);
 768         if (cnts)
 769                 xfree(cnts);
 770         dump_conf(cfg);
 771 }
 772
 773 static void cleanup_cfg(struct pktconf *cfg)
 774 {
 775         size_t l;
 776
 777         for (l = 0; l < cfg->len; ++l) {
 778                 if (cfg->pkts[l].plen > 0)
 779                         xfree(cfg->pkts[l].payload);
 780                 if (cfg->pkts[l].clen > 0)
 781                         xfree(cfg->pkts[l].cnt);
 782                 if (cfg->pkts[l].rlen > 0)
 783                         xfree(cfg->pkts[l].rnd);
 784         }
 785
 786         if (cfg->len > 0)
 787                 xfree(cfg->pkts);
 788 }
 789
 790 static int main_loop(struct mode *mode, char *confname, unsigned long pkts,
 791                      unsigned long gap)
 792 {
 793         struct pktconf cfg = {
 794                 .num = pkts,
 795                 .gap = gap,
 796                 .len = 0,
 797         };
 798
 799         parse_conf_or_die(confname, &cfg);
 800         if (gap > 0)
 801                 tx_tgap_or_die(mode, &cfg);
 802         else
 803                 tx_fire_or_die(mode, &cfg);
 804         cleanup_cfg(&cfg);
 805
 806         return 0;
 807 }
 808
 809 int main(int argc, char **argv)
 810 {
 811         int c, opt_index, ret, i, j;
 812         char *confname = NULL, *ptr;
 813         unsigned long pkts = 0, gap = 0;
 814         bool prio_high = false;
 815         struct mode mode;
 816
 817         check_for_root_maybe_die();
 818
 819         memset(&mode, 0, sizeof(mode));
 820         mode.cpu = CPU_UNKNOWN;
 821
 822         while ((c = getopt_long(argc, argv, short_options, long_options,
 823                &opt_index)) != EOF) {
 824                 switch (c) {
 825                 case 'h':
 826                         help();
 827                         break;
 828                 case 'v':
 829                         version();
 830                         break;
 831                 case 'd':
 832                         mode.device = xstrndup(optarg, IFNAMSIZ);
 833                         break;
 834                 case 'r':
 835                         mode.rand = 1;
 836                         break;
 837                 case 'J':
 838                         mode.jumbo_support = 1;
 839                         break;
 840                 case 'c':
 841                         confname = xstrdup(optarg);
 842                         break;
 843                 case 'k':
 844                         mode.kpull = atol(optarg);
 845                         break;
 846                 case 'n':
 847                         pkts = atol(optarg);
 848                         break;
 849                 case 't':
 850                         gap = atol(optarg);
 851                         break;
 852                 case 'S':
 853                         ptr = optarg;
 854                         mode.reserve_size = 0;
 855
 856                         for (j = i = strlen(optarg); i > 0; --i) {
 857                                 if (!isdigit(optarg[j - i]))
 858                                         break;
 859                                 ptr++;
 860                         }
 861
 862                         if (!strncmp(ptr, "KB", strlen("KB")))
 863                                 mode.reserve_size = 1 << 10;
 864                         else if (!strncmp(ptr, "MB", strlen("MB")))
 865                                 mode.reserve_size = 1 << 20;
 866                         else if (!strncmp(ptr, "GB", strlen("GB")))
 867                                 mode.reserve_size = 1 << 30;
 868                         else
 869                                 panic("Syntax error in ring size param!\n");
 870
 871                         *ptr = 0;
 872                         mode.reserve_size *= atoi(optarg);
 873                         break;
 874                 case 'b':
 875                         set_cpu_affinity(optarg, 0);
 876                         /* Take the first CPU for rebinding the IRQ */
 877                         if (mode.cpu != CPU_NOTOUCH)
 878                                 mode.cpu = atoi(optarg);
 879                         break;
 880                 case 'B':
 881                         set_cpu_affinity(optarg, 1);
 882                         break;
 883                 case 'H':
 884                         prio_high = true;
 885                         break;
 886                 case 'Q':
 887                         mode.cpu = CPU_NOTOUCH;
 888                         break;
 889                 case '?':
 890                         switch (optopt) {
 891                         case 'd':
 892                         case 'c':
 893                         case 'n':
 894                         case 'S':
 895                         case 'b':
 896                         case 'k':
 897                         case 'B':
 898                         case 't':
 899                                 panic("Option -%c requires an argument!\n",
 900                                       optopt);
 901                         default:
 902                                 if (isprint(optopt))
 903                                         whine("Unknown option character "
 904                                               "`0x%X\'!\n", optopt);
 905                                 die();
 906                         }
 907                 default:
 908                         break;
 909                 }
 910         }
 911
 912         if (argc < 5)
 913                 help();
 914         if (mode.device == NULL)
 915                 panic("No networking device given!\n");
 916         if (confname == NULL)
 917                 panic("No configuration file given!\n");
 918         if (device_mtu(mode.device) == 0)
 919                 panic("This is no networking device!\n");
 920         if (device_up_and_running(mode.device) == 0)
 921                 panic("Networking device not running!\n");
 922
 923         register_signal(SIGINT, signal_handler);
 924         register_signal(SIGHUP, signal_handler);
 925         register_signal_f(SIGALRM, timer_elapsed, SA_SIGINFO);
 926
 927         header();
 928
 929         if (prio_high == true) {
 930                 set_proc_prio(get_default_proc_prio());
 931                 set_sched_status(get_default_sched_policy(),
 932                                  get_default_sched_prio());
 933         }
 934
 935         ret = main_loop(&mode, confname, pkts, gap);
 936
 937         xfree(mode.device);
 938         xfree(confname);
 939         return ret;
 940 }
 941