src/cli_packet.c

   1 /*
   2  * Mausezahn - A fast versatile traffic generator
   3  * Copyright (C) 2008-2010 Herbert Haas
   4  *
   5  * This program is free software; you can redistribute it and/or modify it under
   6  * the terms of the GNU General Public License version 2 as published by the
   7  * Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
  11  * FOR A PARTICULAR PURPOSE. See the GNU General Public License for more
  12  * details.
  13  *
  14  * You should have received a copy of the GNU General Public License along with
  15  * this program; if not, see http://www.gnu.org/licenses/gpl-2.0.html
  16  *
  17 */
  18
  19
  20 #include "mz.h"
  21 #include "cli.h"
  22 #include "mops.h"
  23
  24
  25 int debug_packet (struct cli_def *cli, char *command, char *argv[], int argc)
  26 {
  27    cli_debug = CLI_DEBUG_PACKET;
  28    cli_print (cli, "Packet debugging enabled\n");
  29    return CLI_OK;
  30 }
  31
  32
  33
  34
  35 // Enter packet config mode:
  36 //
  37 //   1) either with an optional packet slot number => modify existing slot
  38 //   2) or without number to allocate a new slot entry
  39 //
  40 int enter_packet (struct cli_def *cli, char *command, char *argv[], int argc)
  41 {
  42         char prompt[16];
  43
  44         if (argc==0) { // Allocate new packet
  45                 if ((clipkt = mops_alloc_packet(mp_head)) == NULL) { // Problem, memory full?
  46                         cli_print(cli, "Holy flying spaghetti monster! Cannot allocate additional memory!\n");
  47                         return CLI_OK;
  48                 }
  49                 // OK, created a new packet
  50                 snprintf(prompt, 16, "pkt-%i",clipkt->id);
  51                 cli_print(cli, "Allocated new packet %s at slot %i",clipkt->packet_name, clipkt->id);
  52                 // mops_set_defaults(clipkt);   //// implicitly done by mops_alloc_packet
  53         } else if ( (strcmp(argv[argc-1],"?")==0) || (argc>1) ) {
  54                 cli_print(cli, "<CR>         create a new packet slot\r");
  55                 cli_print(cli, "NAME         enter packet slot of packet with name NAME\r");
  56                 cli_print(cli, "ID           enter packet slot of packet with number ID\n");
  57                 return CLI_OK;
  58         } else { // user specified a unique packet_name
  59                 if ( (clipkt = mops_search_name (mp_head, argv[0]))==NULL) { // packet name does not exist
  60                         if ( (clipkt = mops_search_id (mp_head, (int) str2int(argv[0])))==NULL) { // packet id does not exist
  61                                 cli_print(cli, "Packet does not exist\n");
  62                                 return CLI_OK;
  63                         }
  64                 }
  65                 if (mops_is_any_active(clipkt)) {  // don't allow to configure packets which are active!
  66                         cli_print(cli, "The selected packet is currently in active state!\r");
  67                         cli_print(cli, "In order to configure this packet, please stop the associated packet process first.\n");
  68                         return CLI_OK;
  69                 }
  70                 snprintf(prompt, 16, "pkt-%i",clipkt->id);
  71                 cli_print(cli, "Modify packet parameters for packet %s [%i]",clipkt->packet_name, clipkt->id);
  72         }
  73         cli_set_configmode(cli, MZ_MODE_PACKET, prompt);
  74         //cli_print(cli, "Packet configuration mode - called %s with %s\r\n", __FUNCTION__, command);
  75         return CLI_OK;
  76 }
  77
  78
  79
  80
  81
  82
  83
  84 // Specify the type and enter the appropriate configuration mode
  85 // NOTE that we also reset and create the p_desc here!
  86 int cmd_packet_type(struct cli_def *cli, char *command, char *argv[], int argc)
  87 {
  88         char prompt[16];
  89         int ret=0;
  90         char wrn[] = "Error: Could not create mops extension handle\n";
  91
  92         if ( (strcmp(argv[argc-1],"?")==0) || (argc!=1) )
  93         {
  94                 cli_print(cli, "Specify a packet type from the following list:\r\n");
  95                 cli_print(cli, " arp\r");
  96                 cli_print(cli, " bpdu\r");
  97 //              cli_print(cli, " cdp       (not supported in this version)\r");
  98 //              cli_print(cli, " icmp      (not supported in this version)\r");
  99                 cli_print(cli, " igmp\r");
 100                 cli_print(cli, " ip\r");
 101                 cli_print(cli, " lldp\r");
 102                 cli_print(cli, " rtp\r");
 103 //              cli_print(cli, " syslog    (not supported in this version)\r");
 104                 cli_print(cli, " tcp\r");
 105                 cli_print(cli, " udp\r");
 106                 return CLI_OK;
 107         }
 108
 109         if (mz_strcmp(argv[0],"arp",3) == 0)
 110         {
 111                 if (mops_ext_add_pdesc (clipkt, MOPS_ARP))
 112                         cli_print(cli, "%s", wrn);
 113                 else
 114                 {
 115                         ret=mops_clear_layers(clipkt,
 116                                               MOPS_SNAP|MOPS_MPLS|MOPS_IP|MOPS_UDP|MOPS_TCP);
 117                         clipkt->use_ETHER = 1;
 118                         clipkt->eth_type = 0x806;
 119                         sprintf(prompt, "pkt-%i-arp",clipkt->id);
 120                         cli_set_configmode(cli, MZ_MODE_PACKET_ARP, prompt);
 121                         mops_update_arp(clipkt);
 122                         mops_set_conf(clipkt);
 123                 }
 124
 125         }
 126         else if (mz_strcmp(argv[0],"dns",3) == 0)
 127         {
 128                 if (mops_ext_add_pdesc (clipkt, MOPS_DNS))
 129                         cli_print(cli, "%s", wrn);
 130                 else
 131                 {
 132                         ret=mops_clear_layers(clipkt, MOPS_SNAP|MOPS_TCP);
 133                         clipkt->use_ETHER = 1;
 134                         clipkt->use_IP= 1;
 135                         clipkt->use_UDP= 1;
 136                         sprintf(prompt, "pkt-%i-dns",clipkt->id);
 137                         cli_set_configmode(cli, MZ_MODE_PACKET_DNS, prompt);
 138                         mops_set_conf(clipkt);
 139                 }
 140         }
 141         else if (mz_strcmp(argv[0],"icmp",3) == 0)
 142         {
 143                 if (mops_ext_add_pdesc (clipkt, MOPS_ICMP))
 144                         cli_print(cli, "%s", wrn);
 145                 else
 146                 {
 147                         ret=mops_clear_layers(clipkt, MOPS_SNAP|MOPS_TCP|MOPS_UDP);
 148                         clipkt->use_ETHER = 1;
 149                         clipkt->use_IP= 1;
 150                         sprintf(prompt, "pkt-%i-icmp",clipkt->id);
 151                         cli_set_configmode(cli, MZ_MODE_PACKET_ICMP, prompt);
 152                         mops_set_conf(clipkt);
 153                 }
 154         }
 155         else if (mz_strcmp(argv[0],"igmp",3) == 0)
 156         {
 157                 if (mops_ext_add_pdesc (clipkt, MOPS_IGMP))
 158                         cli_print(cli, "%s", wrn);
 159                 else
 160                 {
 161                         ret=mops_clear_layers(clipkt, MOPS_SNAP|MOPS_TCP|MOPS_UDP);
 162                         clipkt->use_ETHER = 1;
 163                         clipkt->use_IP= 1;
 164                         clipkt->ip_proto = 2;
 165                         mops_ip_option_ra(clipkt, 0); // add router alert option to IP header
 166                         sprintf(prompt, "pkt-%i-igmp",clipkt->id);
 167                         cli_set_configmode(cli, MZ_MODE_PACKET_IGMP, prompt);
 168                         mops_update_igmp(clipkt);
 169                         mops_set_conf(clipkt);
 170                 }
 171         }
 172
 173         else if (mz_strcmp(argv[0],"cdp",3) == 0)
 174         {
 175                 if (mops_ext_add_pdesc (clipkt, MOPS_CDP))
 176                         cli_print(cli, "%s", wrn);
 177                 else
 178                 {
 179                         ret=mops_clear_layers(clipkt, MOPS_ALL);
 180                         clipkt->use_ETHER = 1;
 181                         sprintf(prompt, "pkt-%i-cdp",clipkt->id);
 182                         cli_set_configmode(cli, MZ_MODE_PACKET_CDP, prompt);
 183                         mops_set_conf(clipkt);
 184                 }
 185         }
 186         else if (mz_strcmp(argv[0],"bpdu",3) == 0)
 187         {
 188                 if (mops_ext_add_pdesc (clipkt, MOPS_BPDU))
 189                         cli_print(cli, "%s", wrn);
 190                 else
 191                 {
 192                         ret=mops_clear_layers(clipkt, MOPS_MPLS|MOPS_IP|MOPS_UDP|MOPS_TCP);
 193                         clipkt->use_ETHER = 1;
 194                         clipkt->use_SNAP  = 1;
 195                         sprintf(prompt, "pkt-%i-bpdu",clipkt->id);
 196                         cli_set_configmode(cli, MZ_MODE_PACKET_BPDU, prompt);
 197                         mops_update_bpdu(clipkt);
 198                         mops_set_conf(clipkt);
 199                 }
 200         }
 201         else if (mz_strcmp(argv[0],"ip",2) == 0)
 202         {
 203                 ret=mops_clear_layers(clipkt, MOPS_TCP|MOPS_UDP);
 204                 clipkt->use_ETHER = 1;
 205                 clipkt->use_IP = 1;
 206                 sprintf(prompt, "pkt-%i-ip",clipkt->id);
 207                 cli_set_configmode(cli, MZ_MODE_PACKET_IP, prompt);
 208                 mops_set_conf(clipkt);
 209         }
 210         else if (mz_strcmp(argv[0],"udp",3) == 0)
 211         {
 212                 ret=mops_clear_layers(clipkt, MOPS_SNAP|MOPS_TCP);
 213                 clipkt->use_ETHER = 1;
 214                 clipkt->use_IP = 1;
 215                 clipkt->use_UDP = 1;
 216                 clipkt->ip_proto = 17;
 217                 sprintf(prompt, "pkt-%i-udp",clipkt->id);
 218                 cli_set_configmode(cli, MZ_MODE_PACKET_UDP, prompt);
 219                 mops_set_conf(clipkt);
 220         }
 221         else if (mz_strcmp(argv[0],"tcp",3) == 0)
 222         {
 223                 ret=mops_clear_layers(clipkt, MOPS_SNAP|MOPS_UDP);
 224                 clipkt->use_ETHER = 1;
 225                 clipkt->use_IP = 1;
 226                 clipkt->use_TCP = 1;
 227                 clipkt->ip_proto = 6;
 228                 sprintf(prompt, "pkt-%i-tcp",clipkt->id);
 229                 cli_set_configmode(cli, MZ_MODE_PACKET_TCP, prompt);
 230                 mops_set_conf(clipkt);
 231         }
 232         else if (mz_strcmp(argv[0],"syslog",3) == 0)
 233         {
 234                 if (mops_ext_add_pdesc (clipkt, MOPS_SYSLOG))
 235                         cli_print(cli, "%s", wrn);
 236                 else
 237                 {
 238                         ret=mops_clear_layers(clipkt, MOPS_SNAP|MOPS_TCP);
 239                         clipkt->use_ETHER = 1;
 240                         clipkt->use_IP = 1;
 241                         clipkt->use_UDP = 1;
 242                         sprintf(prompt, "pkt-%i-syslog",clipkt->id);
 243                         cli_set_configmode(cli, MZ_MODE_PACKET_SYSLOG, prompt);
 244                         mops_set_conf(clipkt);
 245                 }
 246         }
 247         else if (mz_strcmp(argv[0],"lldp",3) == 0)
 248         {
 249                 if (mops_ext_add_pdesc (clipkt, MOPS_LLDP))
 250                         cli_print(cli, "%s", wrn);
 251                 else
 252                 {
 253                         ret=mops_clear_layers(clipkt, MOPS_SNAP|MOPS_IP|MOPS_UDP|MOPS_TCP);
 254                         clipkt->use_ETHER = 1;
 255                         sprintf(prompt, "pkt-%i-lldp",clipkt->id);
 256                         cli_set_configmode(cli, MZ_MODE_PACKET_LLDP, prompt);
 257                         mops_set_conf(clipkt);
 258                 }
 259         }
 260         else if (mz_strcmp(argv[0],"rtp",3) == 0)
 261         {
 262                 if (mops_ext_add_pdesc (clipkt, MOPS_RTP))
 263                         cli_print(cli, "%s", wrn);
 264                 else
 265                 {
 266                         ret=mops_clear_layers(clipkt, MOPS_SNAP|MOPS_TCP);
 267                         clipkt->use_ETHER = 1;
 268                         clipkt->use_IP = 1;
 269                         clipkt->use_UDP = 1;
 270                         sprintf(prompt, "pkt-%i-rtp",clipkt->id);
 271                         cli_set_configmode(cli, MZ_MODE_PACKET_RTP, prompt);
 272                         mops_set_conf(clipkt);
 273                 }
 274         }
 275
 276         else // wrong user input
 277         {
 278                 cli_print(cli, "Unknown type\n");
 279                 return CLI_OK;
 280         }
 281
 282    if (ret) {
 283            cli_print(cli, "Note that the following layer(2) have configured information:\r");
 284            if (ret & 1) cli_print(cli, "  - Ethernet or 802.3\r");
 285            if (ret & 2) cli_print(cli, "  - SNAP\r");
 286            if (ret & 4) cli_print(cli, "  - 802.1Q\r");
 287            if (ret & 8) cli_print(cli, "  - MPLS\r");
 288            if (ret & 16) cli_print(cli, "  - IP\r");
 289            if (ret & 32) cli_print(cli, "  - UDP\r");
 290            if (ret & 64) cli_print(cli, "  - TCP\r");
 291    }
 292
 293         mops_update(clipkt);
 294    return CLI_OK;
 295 }
 296
 297
 298
 299
 300
 301 int cmd_packet_end(struct cli_def *cli, char *command, char *argv[], int argc)
 302 {
 303    cli_set_configmode(cli, MODE_CONFIG, NULL);
 304    return CLI_OK;
 305 }
 306
 307
 308
 309
 310
 311 int cmd_packet_clone (struct cli_def *cli, char *command, char *argv[], int argc)
 312 {
 313    // TODO
 314    return CLI_OK;
 315 }
 316
 317
 318 // Reserved words: "all", "slot"
 319 int cmd_packet_name (struct cli_def *cli, char *command, char *argv[], int argc)
 320 {
 321    if (strncmp(argv[0], "?", 2) == 0)
 322      {
 323         cli_print(cli, "Assign a packet name (max 16 chars)\n");
 324         return CLI_OK;
 325      }
 326
 327    if (argc>1)
 328      {
 329         cli_print(cli, "Packet name must not contain spaces\n");
 330         return CLI_OK;
 331      }
 332
 333    if (strlen(argv[0])>MAX_MOPS_PACKET_NAME_LEN)
 334        {
 335           cli_print(cli, "Packet name is limited to %i chars. You might use the 'description' command.\n",MAX_MOPS_PACKET_NAME_LEN);
 336           return CLI_OK;
 337        }
 338
 339    if (mz_strcmp(argv[0], "all", 3)==0)
 340        {
 341           cli_print(cli, "This is a reserved word. Please choose another\n");
 342           return CLI_OK;
 343        }
 344
 345    strncpy(clipkt->packet_name, argv[0], MAX_MOPS_PACKET_NAME_LEN);
 346    clipkt->packet_name[MAX_MOPS_PACKET_NAME_LEN-1] = 0x00;
 347 // cli_print(cli, "Changed packet name to '%s'\n", clipkt->packet_name);
 348
 349    return CLI_OK;
 350 }
 351
 352 int cmd_packet_description (struct cli_def *cli, char *command, char *argv[], int argc)
 353 {
 354    if (strncmp(argv[argc-1], "?", 2) == 0)
 355      {
 356         cli_print(cli, "Assign a packet description (max %i chars)\n", MAX_MOPS_DESCRIPTION_LEN);
 357         return CLI_OK;
 358      }
 359
 360    if (mops_pdesc_mstrings (clipkt->description, argv, argc, MAX_MOPS_DESCRIPTION_LEN))
 361      {
 362         cli_print(cli, "String too long. Currently the description is limited to %i characters.\n",
 363                   MAX_MOPS_DESCRIPTION_LEN);
 364         cli_print(cli, "Current description is:\n%s\n", clipkt->description);
 365      }
 366
 367    return CLI_OK;
 368 }
 369
 370 int cmd_packet_count (struct cli_def *cli, char *command, char *argv[], int argc)
 371 {
 372
 373    if (strncmp(argv[argc-1], "?", 2) == 0)
 374      {
 375         cli_print(cli,"Specify the packet count. Zero means infinity.\n");
 376         return CLI_OK;
 377      }
 378    else if (argc)
 379      {
 380         clipkt->count = (unsigned long) str2int(argv[0]);
 381         if (clipkt->count)
 382           {
 383              clipkt->cntx = clipkt->count; // count is finite: cntx will count down
 384           }
 385         else
 386           {
 387              clipkt->cntx = 0;  // infinity: cntx will count up
 388           }
 389         return CLI_OK;
 390      }
 391    cli_print(cli,"Specify a packet count.\n");
 392    return CLI_OK;
 393 }
 394
 395
 396 int cmd_packet_delay (struct cli_def *cli, char *command, char *argv[], int argc)
 397 {
 398         int ret=0;
 399         char str[100];
 400
 401         if (strncmp(argv[argc-1], "?", 2) == 0) {
 402                 cli_print(cli, "delay <value> [hour | min | sec | msec | usec | nsec]\n");
 403                 cli_print(cli, "Specify the inter-packet delay in hours, minutes, seconds, milliseconds, microseconds,\r");
 404                 cli_print(cli, "or nanoseconds. The default unit is milliseconds (i. e. when no unit is given).\n");
 405                 return CLI_OK;
 406         }
 407
 408         switch (argc) {
 409          case 1:  // only one argument, but may contain an unit (such as '314sec')
 410                 ret = delay_parse(&clipkt->ndelay, argv[0], NULL);
 411                 break;
 412
 413          case 2: // user specified two arguments such as '100 msec'
 414                 ret = delay_parse(&clipkt->ndelay, argv[0], argv[1]);
 415                 break;
 416          default:
 417                 cli_print(cli, "Too many arguments! Expected delay value and unit, such as '10 msec'\n");
 418                 return CLI_OK;
 419         }
 420
 421         switch (ret) {
 422          case 1:
 423                 cli_print(cli, "Invalid unit! Use one of {nsec, usec, msec, sec, min, hours}\n");
 424                 return CLI_OK;
 425                 break;
 426          case 2:
 427                 cli_print(cli, "Value too large! Supported range is from 0 to 999999999\n");
 428                 return CLI_OK;
 429                 break;
 430         }
 431         sprintf(str, "Inter-packet delay set to %lu sec and %lu nsec", clipkt->ndelay.tv_sec, clipkt->ndelay.tv_nsec);
 432         cli_print(cli, "%s\n", str);
 433
 434         return CLI_OK;
 435 }
 436
 437
 438
 439 int cmd_packet_bind (struct cli_def *cli, char *command, char *argv[], int argc)
 440 {
 441    int i;
 442
 443    if (strncmp(argv[argc-1], "?", 2) == 0)
 444      {
 445         cli_print(cli,"<DEVICE>    Change the packet's network interface\r");
 446         cli_print(cli,"default     Use interface settings as packet default\n");
 447         return CLI_OK;
 448      }
 449    else if (argc)
 450      {
 451         if (mz_strcmp(argv[0], "default", 3)==0)
 452           {
 453              i = mops_get_device_index(clipkt->device);
 454              // Copy device_list[i].ip_mops and .mac_mops to clipkt->ip_src and ->eth_src
 455              memcpy((void *) &clipkt->eth_src, (void *) &device_list[i].mac_mops[0], 6);
 456              memcpy((void *) &clipkt->ip_src, (void *) &device_list[i].ip_mops[0], 4);
 457           }
 458         else
 459           {
 460              i = mops_get_device_index(argv[0]);
 461
 462              if (i != -1)
 463                {
 464                   strncpy(clipkt->device, argv[0], 16); // assign device to this mops
 465                   mops_use_device(clipkt, i);
 466                }
 467              else
 468                cli_print(cli, "Unknown device, will stick on %s\n", clipkt->device);
 469           }
 470      }
 471    else
 472      cli_print(cli, "Nothing specified, will stick on %s\n", clipkt->device);
 473
 474    return CLI_OK;
 475 }
 476
 477
 478
 479
 480
 481
 482
 483 // FORMAT: <VLAN>:<CoS> such as: "100:3  17:5 ..."
 484 // NOTE: LEFTMOST TAG = OUTER TAG IN FRAME
 485 // CFI is set/unset separately (see ? below)
 486 // Transmission format: 0x8100 plus CoS (3) CFI(1) VLAN(12)
 487 int cmd_packet_dot1q (struct cli_def *cli, char *command, char *argv[], int argc)
 488 {
 489    int i, j, k=0;
 490    int n;
 491    char Vlan[64], CoS[64];
 492    u_int16_t v,c;
 493
 494    if (strcmp(argv[argc-1],"?")==0)
 495      {
 496         cli_print(cli, "Configure 802.1Q tags:\n");
 497         cli_print(cli, "  VLAN[:CoS] [VLAN[:CoS]] ...   The leftmost tag is the outer tag in the frame\r");
 498         cli_print(cli, "  remove <tag-nr> | all         Remove one or more tags (<tag-nr> starts with 1),\r");
 499         cli_print(cli, "                                by default the first (=leftmost,outer) tag is removed,\r");
 500         cli_print(cli, "                                keyword 'all' can be used instead of tag numbers.\r");
 501         cli_print(cli, "  cfi | nocfi [<tag-nr>]        Set or unset the CFI-bit in any tag (by default\r");
 502         cli_print(cli, "                                assuming the first tag).\n");
 503         return CLI_OK;
 504      }
 505
 506    if (argc==0)
 507      {
 508         cli_print(cli, "Specify one or more VLAN-IDs, optionally with CoS values\n");
 509         return CLI_OK;
 510      }
 511
 512    n = clipkt->dot1Q_s/4; // n = number of tags
 513
 514 //////////////////////////////////////////
 515    if (mz_strcmp(argv[0], "remove", 2)==0)
 516      {
 517
 518         if (argc>2)
 519           {
 520              cli_print(cli, "Too many arguments!\n");
 521              return CLI_OK;
 522           }
 523
 524         if (n==0)
 525           {
 526              cli_print(cli, "No 802.1Q tags present. None to be removed.\n");
 527              return CLI_OK;
 528           }
 529
 530         if ((argc==2) && (mz_strcmp(argv[1], "all", 1)==0))
 531           {
 532              mops_dot1Q_remove(clipkt, 0);
 533              return CLI_OK;
 534           }
 535
 536         if (argc==1) // no tag-nr specified => assume first tag
 537           {
 538              j=1;
 539           }
 540         else
 541           {
 542              j = (unsigned int) str2int(argv[1]); // take first argument
 543              if (j==0)
 544                {
 545                   cli_print(cli, "The tag-nr must be within {1..%i}\n", n);
 546                   return CLI_OK;
 547                }
 548           }
 549
 550         // now remove tag
 551         if (mops_dot1Q_remove(clipkt, j))
 552           {
 553              cli_print(cli, "The packet only consists of %i tag(s)!\n", n);
 554           }
 555         return CLI_OK;
 556      }
 557
 558
 559 /////////////////////////////////////////
 560    if (mz_strcmp(argv[0], "nocfi", 2)==0)
 561      {
 562         if (n==0)
 563           {
 564              cli_print(cli, "There are no 802.1Q tags yet!\n");
 565              return CLI_OK;
 566           }
 567
 568         if (argc>2)
 569           {
 570              cli_print(cli, "Invalid format!\n");
 571              return CLI_OK;
 572           }
 573
 574         if (argc==1) // no tag-nr specified => assume first tag
 575           {
 576              j=1;
 577           }
 578         else
 579           {
 580              j = (unsigned int) str2int(argv[1]);
 581           }
 582
 583         if (mops_dot1Q_nocfi(clipkt, j))
 584           {
 585              cli_print(cli, "The packet only consists of %i tags!\n",k);
 586           }
 587         return CLI_OK;
 588      }
 589
 590 ///////////////////////////////////////
 591    if (mz_strcmp(argv[0], "cfi", 2)==0)
 592      {
 593         if (n==0)
 594           {
 595              cli_print(cli, "There are no 802.1Q tags yet!\n");
 596              return CLI_OK;
 597           }
 598
 599         if (argc>2)
 600           {
 601              cli_print(cli, "Invalid format!\n");
 602              return CLI_OK;
 603           }
 604
 605         if (argc==1) // no tag-nr specified => assume first tag
 606           {
 607              j=1;
 608           }
 609         else
 610           {
 611              j = (unsigned int) str2int(argv[1]);
 612           }
 613
 614         if (mops_dot1Q_cfi(clipkt, j))
 615           {
 616              cli_print(cli, "The packet only consists of %i tags!\n",k);
 617           }
 618         return CLI_OK;
 619      }
 620
 621
 622 /////////////////////////
 623    for (i=0; i<argc; i++) // scan through all user tokens
 624      {
 625         v=0;c=0; k=0;
 626
 627         if (mz_tok(argv[i],":",2, Vlan, CoS) == -1)
 628           {
 629              cli_print(cli, "Invalid format. Correct format: VLAN[:CoS] [VLAN[:CoS] ...]\n");
 630              return CLI_OK;
 631           }
 632
 633         if (Vlan[0]==0x00)
 634           {
 635              cli_print(cli, "[tag %i] Missing VLAN number\n", i+1);
 636              return CLI_OK;
 637           }
 638         else
 639           {
 640              v = (u_int16_t) str2int(Vlan);
 641              if (v>4095)
 642                {
 643                   cli_print(cli, "[tag %i] VLAN number must not exceed 4095.\n", i+1);
 644                   return CLI_OK;
 645                }
 646           }
 647
 648         if (CoS[0]==0x00)
 649           {
 650              c=0;
 651           }
 652         else
 653           {
 654              c = (u_int16_t) str2int(CoS);
 655              if (c>7)
 656                {
 657                   cli_print(cli, "[tag %i] CoS must not exceed 7.\n", i+1);
 658                   return CLI_OK;
 659                }
 660           }
 661
 662         mops_dot1Q (clipkt, i, 1, v, c);  // 3rd param '1' means 'new stack, also set dot1Q_s'
 663      }
 664    return CLI_OK;
 665 }
 666
 667
 668 // MPLS transmission format: Label(20) EXP(3) BoS(1) TTL(8)
 669 //    -- where BoS=0 indicate MORE labels, BoS=1 means last (bottom) label
 670 //
 671 // NOTE: The EtherType must be 0x8847 which identifies 'IP over MPLS' that is
 672 //       we do NOT need to set 0x800 for IP somewhere! Instead, mops_update()
 673 //       will always correctly set the single EtherType, if necessary after
 674 //       802.1Q tags. For example when VLAN tags are present, the frame looks
 675 //       like this:----------------------------------vvvv-----------------------
 676 //       DMAC-SMAC-8100VLAN1-...-8100VLANn-EtherType(8847)-MPLS1-...-MPLSn-IP...
 677 //
 678 //       MPLS Multicast packets are indicated by EtherType 8848 (!)
 679 //       See also RFC 5332 which allows both 'Codepoints' to carry MPLS multicast
 680 //       while 0x8848 only indicates multiaccess media.
 681 //
 682 // NOTE: If all MPLS labels are removed again, the original EtherType is restored again!
 683 //       The original EtherType is stored in mp->eth_type_backup
 684 int cmd_packet_mpls (struct cli_def *cli, char *command, char *argv[], int argc)
 685 {
 686    int a=0,i,j=0,k;
 687    char LabelS[64], ExpS[64], TTLS[64];
 688    u_int32_t Label;
 689    u_int8_t Exp;
 690    u_int8_t TTL;
 691
 692
 693    if ( (strcmp(argv[argc-1],"?")==0) || (argc==0) )
 694      {
 695         cli_print(cli, "Configure one or more MPLS labels:\r");
 696         cli_print(cli, "  LABEL[:EXP[:TTL]] [LABEL[:EXP[:TTL]]] ... The leftmost tag is the outer tag in frame\r");
 697         cli_print(cli, "  remove <tag-nr> | all         Remove tag with number <tag-nr> (starts with 1) or all.\r");
 698         cli_print(cli, "  bos | nobos [<tag-nr>]        Set/unset BoS flag, by default in last (rightmost) label\r");
 699         cli_print(cli, "  unicast|multicast             Choose EtherType 0x8847 or 0x8848 respectively\n");
 700         cli_print(cli, "Examples:\r");
 701         cli_print(cli, "  tag mpls 100 200 300          Specify three tags, 100,200,300 \r");
 702         cli_print(cli, "  tag mpls 100:5 200:5:1        Let first tag have CoS 5, second tag additionally uses TTL=1\r");
 703         cli_print(cli, "  tag mpls 100::8               Let first tag have TTL=8\n");
 704         cli_print(cli, "Reserved label numbers:\r");
 705         cli_print(cli, "  0 ... explicit NULL (IPv4)\r");
 706         cli_print(cli, "  1 ... Router Alert\r");
 707         cli_print(cli, "  2 ... explicit NULL (IPv6)\r");
 708         cli_print(cli, "  3 ... implicit NULL (only announced within LDP)\r");
 709         cli_print(cli, " 14 ... OAM Alert (ITU-T Y.1711, RFC 3429)\n");
 710         return CLI_OK;
 711      }
 712
 713 ///////////////////////////////////////////
 714    if (mz_strcmp(argv[0], "unicast", 2)==0)
 715      {
 716         if (clipkt->use_MPLS==0)
 717           {
 718              cli_print(cli, "First configure an MPLS label stack.");
 719              return CLI_OK;
 720           }
 721
 722         if (argc>1)
 723           {
 724              cli_print(cli, "This command does not support any argument.\n");
 725           }
 726
 727         clipkt->eth_type = 0x8847;
 728         return CLI_OK;
 729      }
 730
 731 /////////////////////////////////////////////
 732    if (mz_strcmp(argv[0], "multicast", 2)==0)
 733      {
 734         if (clipkt->use_MPLS==0)
 735           {
 736              cli_print(cli, "First configure an MPLS label stack.");
 737              return CLI_OK;
 738           }
 739
 740         if (argc>1)
 741           {
 742              cli_print(cli, "This command does not support any argument.\n");
 743           }
 744
 745         clipkt->eth_type = 0x8848;
 746         return CLI_OK;
 747      }
 748
 749    k = clipkt->mpls_s/4; // number of available tags
 750
 751 //////////////////////////////////////////
 752    if (mz_strcmp(argv[0], "remove", 2)==0)
 753      {
 754         if (argc>2)
 755           {
 756              cli_print(cli, "Too many arguments!\n");
 757              return CLI_OK;
 758           }
 759
 760         if ((argc==2) && (mz_strcmp(argv[1], "all", 1)==0))
 761           {
 762              if (mops_mpls_remove(clipkt, 0))
 763                   cli_print(cli, "No MPLS label stack present. Nothing removed\n");
 764              return CLI_OK;
 765           }
 766
 767         if (argc==1) // no tag-nr specified => assume first tag
 768           {
 769              if (k==0)
 770                cli_print(cli, "Currently the packet has no tag that can be removed.\n");
 771              else
 772                j=1;
 773           }
 774         else
 775           {
 776              j = (unsigned int) str2int(argv[1]); // take first argument
 777           }
 778         if (mops_mpls_remove(clipkt, j))
 779           cli_print(cli, "The tag number must be within 1..%i\n",k);
 780
 781         return CLI_OK;
 782      }
 783
 784 ///////////////////////////////////////
 785    if (mz_strcmp(argv[0], "bos", 2)==0)
 786      {
 787         if (argc>2)
 788           {
 789              cli_print(cli, "Too many arguments\n");
 790              return CLI_OK;
 791           }
 792         if (argc==2)
 793           {
 794              i = (int) str2int(argv[1]);
 795              if (i>k)
 796                {
 797                   cli_print(cli, "Tag number exceeds actual number of tags (%i)\n",a);
 798                   return CLI_OK;
 799                }
 800           }
 801         else // argc==1 (no tag number specified)
 802           {
 803              i = k; // default: last tag!
 804           }
 805
 806         mops_mpls_bos (clipkt, i);
 807         return CLI_OK;
 808      }
 809
 810    if (mz_strcmp(argv[0], "nobos", 2)==0)
 811      {
 812         if (argc>2)
 813           {
 814              cli_print(cli, "Too many arguments\n");
 815              return CLI_OK;
 816           }
 817         if (argc==2)
 818           {
 819              i = (int) str2int(argv[1]);
 820              if (i>k)
 821                {
 822                   cli_print(cli, "Tag number exceeds actual number of tags (%i)\n",k);
 823                   return CLI_OK;
 824                }
 825           }
 826         else // argc==1 (no tag number specified)
 827           {
 828              i = k; // default: last tag!
 829           }
 830         mops_mpls_nobos (clipkt, i);
 831         return CLI_OK;
 832      }
 833
 834
 835 ////////////////////////////////////////////
 836    for (i=0;i<argc;i++)    // Get all labels
 837      {
 838         if (mz_tok(argv[i], ":", 3, LabelS, ExpS, TTLS) < 0)
 839           {
 840              cli_print(cli, "[Tag %i]Incorrect label specification! Use format LABEL[:EXP[:TTL]]\n", i+1);
 841              return CLI_OK;
 842           }
 843
 844         // Get Label
 845         if (LabelS[0]==0x00)
 846           {
 847              cli_print(cli, "[Tag %i] Invalid label value!\n", i+1);
 848              return CLI_OK;
 849           }
 850         else
 851           {
 852              Label = (u_int32_t) str2int (LabelS);
 853              if (Label > 1048575)
 854                {
 855                   cli_print(cli, "[Tag %i] Label value cannot exceed 1048575\n", i+1);
 856                   return CLI_OK;
 857                }
 858           }
 859         // Get EXP
 860         if (ExpS[0]==0x00)
 861           {
 862              Exp=0;
 863           }
 864         else
 865           {
 866              Exp = (u_int8_t) str2int(ExpS);
 867              if (Exp>7)
 868                {
 869                   cli_print(cli, "[Tag %i] EXP value must be within range 0..7\n", i+1);
 870                   return CLI_OK;
 871                }
 872           }
 873
 874         // Get TTL
 875         if (TTLS[0]==0x00)
 876           {
 877              TTL=255;
 878           }
 879         else
 880           {
 881              if (str2int(TTLS)>255)
 882                {
 883                   cli_print(cli, "[Tag%i] TTL value must be within range 0..255\n", i+1);
 884                   return CLI_OK;
 885                }
 886              TTL = (u_int8_t) str2int(TTLS);
 887           }
 888
 889         // Now add MPLS tag:
 890         mops_mpls(clipkt, i, argc, Label, Exp, TTL);
 891      }
 892
 893    return CLI_OK;
 894 }
 895
 896
 897 // SYNTAX:
 898 //
 899 //   payload hex ff:00:01:02:aa:bb:cc:dd aa:bb:cc
 900 //   payload hex file tmp/dump.dat
 901 //
 902 int cmd_packet_payload_hex (struct cli_def *cli, char *command, char *argv[], int argc)
 903 {
 904    char str[MAX_MOPS_MSG_SIZE*3];
 905    int len, i;
 906
 907    if (strncmp(argv[argc-1], "?", 2)==0)
 908      {
 909         cli_print(cli, "Specify a payload in hexadecimal format:\n");
 910         cli_print(cli, "   XX:XX:XX:...       Either directly as sequence of digits, separated by colon or space\r");
 911         cli_print(cli, "   file <filename>    Or specify a filename with hexadecimal digits as content\r");
 912         cli_print(cli, "                      (Also in the file the separator can be either a colon or a space)\n");
 913         cli_print(cli, "Example: \r");
 914         cli_print(cli, "payload hex ff:ff:ff:ff:ff:ff 00:12:34:56:67:89 08:00 ca:fe:ba:be\n");
 915         return CLI_OK;
 916      }
 917
 918    if (argc==0)
 919      {
 920         cli_print(cli, "Specify an ascii payload\n");
 921         return CLI_OK;
 922      }
 923
 924
 925    if (mz_strcmp(argv[0],"file", 2)==0)
 926      {
 927         // > > > > > ******* TODO: Open file and configure mops with filepointer ******** < < < < < < < <
 928         cli_print(cli, "This feature is currently not supported.\n");
 929         return CLI_OK;
 930      }
 931
 932    // Get byte sequence - first copy into str
 933    if (mops_pdesc_mstrings (str, argv, argc, MAX_MOPS_MSG_SIZE*3))
 934      {
 935         cli_print(cli, "Payload too long (limited to %i bytes).\n", MAX_MOPS_MSG_SIZE);
 936      }
 937    else // str contains byte sequence now - convert into msg and set msg_s
 938      {
 939         len = strlen(str);
 940         for (i=0; i<len; i++)
 941           {
 942              if (str[i]=='?')
 943                {
 944                   cli_print(cli, "Specify hexadecimal digits {1234567890abcdef} or separators\n");
 945                   return CLI_OK;
 946                }
 947
 948              if ( (!isxdigit(str[i])) &&   // Only allow "1234567890abcdefABCDEF", ":", ".", "-", and SPACE.
 949                   (!isspace(str[i])) &&
 950                   (str[i]!=':') &&
 951                   (str[i]!='.') &&
 952                   (str[i]!='-'))
 953                {
 954                   cli_print(cli, "Invalid character at position %i\n", i+1);
 955                   return CLI_OK;
 956                }
 957           }
 958
 959         len = str2hex (str, clipkt->msg, MAX_MOPS_MSG_SIZE);
 960         if (len==-1)
 961           {
 962              cli_print(cli, "Invalid byte sequence. Each byte must be specified with two hexadecimal digits.\n");
 963              return CLI_OK;
 964           }
 965
 966         clipkt->msg_s = (u_int32_t) len;
 967      }
 968
 969    return CLI_OK;
 970 }
 971
 972
 973
 974 int cmd_packet_payload_ascii (struct cli_def *cli, char *command, char *argv[], int argc)
 975 {
 976    char str[MAX_MOPS_MSG_SIZE*3];
 977    int len, i;
 978
 979    if (strncmp(argv[argc-1], "?", 2)==0)
 980      {
 981         cli_print(cli, "Specify a payload in ascii format.\r");
 982         cli_print(cli, "Note that multiple white spaces are replaced by a single white space. If you\r");
 983         cli_print(cli, "really want to specify multiple white spaces then use a dash '-' instead of\r");
 984         cli_print(cli, "a white space. If you want to specify a dash then use a caret '^' as escape\r");
 985         cli_print(cli, "character.\n");
 986
 987         return CLI_OK;
 988      }
 989
 990    if (argc==0)
 991      {
 992         cli_print(cli, "Specify an ascii payload\n");
 993         return CLI_OK;
 994      }
 995
 996
 997    if (mz_strcmp(argv[0],"file", 2)==0)
 998      {
 999         // > > > > > ******* TODO: Open file and configure mops with filepointer ******** < < < < < < < <
1000         cli_print(cli, "This feature is currently not supported.\n");
1001         return CLI_OK;
1002      }
1003
1004       // Get byte sequence - first copy into str
1005    if (mops_pdesc_mstrings (str, argv, argc, MAX_MOPS_MSG_SIZE))
1006      {
1007         cli_print(cli, "Payload too long (limited to %i bytes).\n", MAX_MOPS_MSG_SIZE);
1008      }
1009    else // str contains byte sequence now - convert into msg and set msg_s
1010      {
1011         len = strlen(str);
1012         for (i=0; i<len; i++) // Replace
1013           {
1014             if (str[i]=='-')
1015                {
1016                   if ((i>0) && (str[i-1]=='^'))
1017                     {
1018                        memcpy((void*) &str[i-1], (void*) &str[i], len-i+1);
1019                        i--; len--;
1020                     }
1021                   else
1022                     {
1023                        str[i]=' ';
1024                     }
1025                }
1026           }
1027         len--; // to eliminate the trailing space (created by mops_pdesc_mstring)
1028         memcpy((void*) clipkt->msg, (void*) str, len);
1029         clipkt->msg_s = len;
1030      }
1031    return CLI_OK;
1032 }
1033
1034
1035 int cmd_packet_payload_raw (struct cli_def *cli, char *command, char *argv[], int argc)
1036 {
1037
1038    return CLI_OK;
1039 }
1040
1041
1042
1043 int cmd_packet_interval (struct cli_def *cli, char *command, char *argv[], int argc)
1044 {
1045         unsigned long long iv, tv_sec=0;
1046
1047         if (strncmp(argv[argc-1], "?", 1)==0) {
1048                 cli_print(cli, "Configure a greater packet interval in days, hours, minutes, or seconds\n");
1049                 cli_print(cli, "Arguments: <value>  <days | hours | minutes | seconds>\n");
1050                 cli_print(cli, "Use a zero value to disable an interval.\n");
1051                 return CLI_OK;
1052         }
1053
1054         if (argc!=2) {
1055                 cli_print(cli,"Enter a value and an unit\n");
1056                 return CLI_OK;
1057         }
1058
1059
1060         if (mz_strisnum(argv[0])==0) {
1061                 cli_print(cli,"Invalid value\n");
1062                 return CLI_OK;
1063         }
1064
1065         iv = str2lint(argv[0]);
1066
1067         if (iv==0) {
1068                 cli_print(cli,"Interval disabled.\n");
1069                 clipkt->interval_used = 0;
1070                 return CLI_OK;
1071         }
1072
1073         if (mz_strcmp(argv[1], "days", 1)==0) {
1074                 if (iv>365) {
1075                         cli_print(cli, "Supported range: 1..365 days\n");
1076                         return CLI_OK;
1077                 }
1078                 tv_sec = 86400 * iv;
1079         }
1080
1081         if (mz_strcmp(argv[1], "hours", 1)==0) {
1082                 if (iv>1000) {
1083                         cli_print(cli, "Supported range: 1..1000 hours\n");
1084                         return CLI_OK;
1085                 }
1086                 tv_sec = 3600 * iv;
1087         }
1088
1089         if (mz_strcmp(argv[1], "minutes", 1)==0) {
1090                 if (iv>1000) {
1091                         cli_print(cli, "Supported range: 1..1000 minutes\n");
1092                         return CLI_OK;
1093                 }
1094                 tv_sec = 60 * iv;
1095         }
1096
1097         if (mz_strcmp(argv[1], "seconds", 1)==0) {
1098                 if (iv>999999) {
1099                         cli_print(cli, "Supported range: 1..999999 seconds\n");
1100                         return CLI_OK;
1101                 }
1102                 tv_sec = iv;
1103         }
1104
1105         if (clipkt->count==0) {
1106                 cli_print(cli, "Note: reconfigured count value from 0 (infinity) to 1.\n");
1107                 clipkt->count=1;
1108         }
1109
1110         if ((clipkt->count * clipkt->ndelay.tv_sec)>tv_sec) {
1111                 cli_print(cli, "Error: intervals are smaller than packet trains.\r");
1112                 cli_print(cli, "Reduce either count or delay, or both\n");
1113                 return CLI_OK;
1114         }
1115
1116         clipkt->interval.tv_sec = tv_sec;
1117         clipkt->interval_used = 1;
1118
1119    return CLI_OK;
1120 }
1121