text2pcap.c

   1 /**-*-C-*-**********************************************************************
   2  *
   3  * text2pcap.c
   4  *
   5  * Utility to convert an ASCII hexdump into a libpcap-format capture file
   6  *
   7  * (c) Copyright 2001 Ashok Narayanan <ashokn@cisco.com>
   8  *
   9  * $Id$
  10  *
  11  * Wireshark - Network traffic analyzer
  12  * By Gerald Combs <gerald@wireshark.org>
  13  * Copyright 1998 Gerald Combs
  14  *
  15  * This program is free software; you can redistribute it and/or
  16  * modify it under the terms of the GNU General Public License
  17  * as published by the Free Software Foundation; either version 2
  18  * of the License, or (at your option) any later version.
  19  *
  20  * This program is distributed in the hope that it will be useful,
  21  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  22  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  23  * GNU General Public License for more details.
  24  *
  25  * You should have received a copy of the GNU General Public License
  26  * along with this program; if not, write to the Free Software
  27  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
  28  *
  29  *******************************************************************************/
  30
  31 /*******************************************************************************
  32  *
  33  * This utility reads in an ASCII hexdump of this common format:
  34  *
  35  * 00000000  00 E0 1E A7 05 6F 00 10 5A A0 B9 12 08 00 46 00 .....o..Z.....F.
  36  * 00000010  03 68 00 00 00 00 0A 2E EE 33 0F 19 08 7F 0F 19 .h.......3...\7f..
  37  * 00000020  03 80 94 04 00 00 10 01 16 A2 0A 00 03 50 00 0C .............P..
  38  * 00000030  01 01 0F 19 03 80 11 01 1E 61 00 0C 03 01 0F 19 .........a......
  39  *
  40  * Each bytestring line consists of an offset, one or more bytes, and
  41  * text at the end. An offset is defined as a hex string of more than
  42  * two characters. A byte is defined as a hex string of exactly two
  43  * characters. The text at the end is ignored, as is any text before
  44  * the offset. Bytes read from a bytestring line are added to the
  45  * current packet only if all the following conditions are satisfied:
  46  *
  47  * - No text appears between the offset and the bytes (any bytes appearing after
  48  *   such text would be ignored)
  49  *
  50  * - The offset must be arithmetically correct, i.e. if the offset is 00000020, then
  51  *   exactly 32 bytes must have been read into this packet before this. If the offset
  52  *   is wrong, the packet is immediately terminated
  53  *
  54  * A packet start is signaled by a zero offset.
  55  *
  56  * Lines starting with #TEXT2PCAP are directives. These allow the user
  57  * to embed instructions into the capture file which allows text2pcap
  58  * to take some actions (e.g. specifying the encapsulation
  59  * etc.). Currently no directives are implemented.
  60  *
  61  * Lines beginning with # which are not directives are ignored as
  62  * comments. Currently all non-hexdump text is ignored by text2pcap;
  63  * in the future, text processing may be added, but lines prefixed
  64  * with '#' will still be ignored.
  65  *
  66  * The output is a libpcap packet containing Ethernet frames by
  67  * default. This program takes options which allow the user to add
  68  * dummy Ethernet, IP and UDP or TCP headers to the packets in order
  69  * to allow dumps of L3 or higher protocols to be decoded.
  70  *
  71  * Considerable flexibility is built into this code to read hexdumps
  72  * of slightly different formats. For example, any text prefixing the
  73  * hexdump line is dropped (including mail forwarding '>'). The offset
  74  * can be any hex number of four digits or greater.
  75  *
  76  * This converter cannot read a single packet greater than 64K. Packet
  77  * snaplength is automatically set to 64K.
  78  */
  79
  80 #ifdef HAVE_CONFIG_H
  81 # include "config.h"
  82 #endif
  83
  84 /*
  85  * Just make sure we include the prototype for strptime as well
  86  * (needed for glibc 2.2) but make sure we do this only if not
  87  * yet defined.
  88  */
  89 #ifndef __USE_XOPEN
  90 #  define __USE_XOPEN
  91 #endif
  92 #ifndef _XOPEN_SOURCE
  93 #  define _XOPEN_SOURCE
  94 #endif
  95
  96 /*
  97  * Defining _XOPEN_SOURCE is needed on some platforms, e.g. platforms
  98  * using glibc, to expand the set of things system header files define.
  99  *
 100  * Unfortunately, on other platforms, such as some versions of Solaris
 101  * (including Solaris 10), it *reduces* that set as well, causing
 102  * strptime() not to be declared, presumably because the version of the
 103  * X/Open spec that _XOPEN_SOURCE implies doesn't include strptime() and
 104  * blah blah blah namespace pollution blah blah blah.
 105  *
 106  * So we define __EXTENSIONS__ so that "strptime()" is declared.
 107  */
 108 #ifndef __EXTENSIONS__
 109 #  define __EXTENSIONS__
 110 #endif
 111
 112 #include <ctype.h>
 113 #include <stdio.h>
 114 #include <stdlib.h>
 115 #include <string.h>
 116 #include <wsutil/file_util.h>
 117
 118 #include <time.h>
 119 #include <glib.h>
 120
 121 #ifdef HAVE_UNISTD_H
 122 # include <unistd.h>
 123 #endif
 124
 125 #include <errno.h>
 126 #include <assert.h>
 127
 128 #ifndef HAVE_GETOPT
 129 #include "wsutil/wsgetopt.h"
 130 #endif
 131
 132 #ifdef NEED_STRPTIME_H
 133 # include "wsutil/strptime.h"
 134 #endif
 135
 136 #include "text2pcap.h"
 137 #include "svnversion.h"
 138
 139 #ifdef _WIN32
 140 #include <wsutil/unicode-utils.h>
 141 #endif /* _WIN32 */
 142
 143 /*--- Options --------------------------------------------------------------------*/
 144
 145 /* Debug level */
 146 static int debug = 0;
 147 /* Be quiet */
 148 static int quiet = FALSE;
 149
 150 /* Dummy Ethernet header */
 151 static int hdr_ethernet = FALSE;
 152 static unsigned long hdr_ethernet_proto = 0;
 153
 154 /* Dummy IP header */
 155 static int hdr_ip = FALSE;
 156 static long hdr_ip_proto = 0;
 157
 158 /* Dummy UDP header */
 159 static int hdr_udp = FALSE;
 160 static unsigned long hdr_dest_port = 0;
 161 static unsigned long hdr_src_port = 0;
 162
 163 /* Dummy TCP header */
 164 static int hdr_tcp = FALSE;
 165
 166 /* Dummy SCTP header */
 167 static int hdr_sctp = FALSE;
 168 static unsigned long hdr_sctp_src  = 0;
 169 static unsigned long hdr_sctp_dest = 0;
 170 static unsigned long hdr_sctp_tag  = 0;
 171
 172 /* Dummy DATA chunk header */
 173 static int hdr_data_chunk = FALSE;
 174 static unsigned char  hdr_data_chunk_type = 0;
 175 static unsigned char  hdr_data_chunk_bits = 3;
 176 static unsigned long  hdr_data_chunk_tsn  = 0;
 177 static unsigned short hdr_data_chunk_sid  = 0;
 178 static unsigned short hdr_data_chunk_ssn  = 0;
 179 static unsigned long  hdr_data_chunk_ppid = 0;
 180
 181
 182 /*--- Local date -----------------------------------------------------------------*/
 183
 184 /* This is where we store the packet currently being built */
 185 #define MAX_PACKET 64000
 186 static unsigned char packet_buf[MAX_PACKET];
 187 static unsigned long curr_offset = 0;
 188 static unsigned long max_offset = MAX_PACKET;
 189 static unsigned long packet_start = 0;
 190 static void start_new_packet (void);
 191
 192 /* This buffer contains strings present before the packet offset 0 */
 193 #define PACKET_PREAMBLE_MAX_LEN 2048
 194 static unsigned char packet_preamble[PACKET_PREAMBLE_MAX_LEN+1];
 195 static int packet_preamble_len = 0;
 196
 197 /* Number of packets read and written */
 198 static unsigned long num_packets_read = 0;
 199 static unsigned long num_packets_written = 0;
 200
 201 /* Time code of packet, derived from packet_preamble */
 202 static time_t ts_sec  = 0;
 203 static guint32 ts_usec = 0;
 204 static char *ts_fmt = NULL;
 205 static struct tm timecode_default;
 206
 207 /* Input file */
 208 static const char *input_filename;
 209 static FILE *input_file = NULL;
 210 /* Output file */
 211 static const char *output_filename;
 212 static FILE *output_file = NULL;
 213
 214 /* Offset base to parse */
 215 static unsigned long offset_base = 16;
 216
 217 extern FILE *yyin;
 218
 219 /* ----- State machine -----------------------------------------------------------*/
 220
 221 /* Current state of parser */
 222 typedef enum {
 223     INIT,             /* Waiting for start of new packet */
 224     START_OF_LINE,    /* Starting from beginning of line */
 225     READ_OFFSET,      /* Just read the offset */
 226     READ_BYTE,        /* Just read a byte */
 227     READ_TEXT         /* Just read text - ignore until EOL */
 228 } parser_state_t;
 229 static parser_state_t state = INIT;
 230
 231 static const char *state_str[] = {"Init",
 232                            "Start-of-line",
 233                            "Offset",
 234                            "Byte",
 235                            "Text"
 236 };
 237
 238 static const char *token_str[] = {"",
 239                            "Byte",
 240                            "Offset",
 241                            "Directive",
 242                            "Text",
 243                            "End-of-line"
 244 };
 245
 246 /* ----- Skeleton Packet Headers --------------------------------------------------*/
 247
 248 typedef struct {
 249     guint8  dest_addr[6];
 250     guint8  src_addr[6];
 251     guint16 l3pid;
 252 } hdr_ethernet_t;
 253
 254 static hdr_ethernet_t HDR_ETHERNET = {
 255     {0x0a, 0x02, 0x02, 0x02, 0x02, 0x02},
 256     {0x0a, 0x01, 0x01, 0x01, 0x01, 0x01},
 257     0};
 258
 259 typedef struct {
 260     guint8  ver_hdrlen;
 261     guint8  dscp;
 262     guint16 packet_length;
 263     guint16 identification;
 264     guint8  flags;
 265     guint8  fragment;
 266     guint8  ttl;
 267     guint8  protocol;
 268     guint16 hdr_checksum;
 269     guint32 src_addr;
 270     guint32 dest_addr;
 271 } hdr_ip_t;
 272
 273 static hdr_ip_t HDR_IP = {0x45, 0, 0, 0x3412, 0, 0, 0xff, 0, 0, 0x0101010a, 0x0202020a};
 274
 275 static struct {                 /* pseudo header for checksum calculation */
 276         guint32 src_addr;
 277         guint32 dest_addr;
 278         guint8  zero;
 279         guint8  protocol;
 280         guint16 length;
 281 } pseudoh;
 282
 283 typedef struct {
 284     guint16 source_port;
 285     guint16 dest_port;
 286     guint16 length;
 287     guint16 checksum;
 288 } hdr_udp_t;
 289
 290 static hdr_udp_t HDR_UDP = {0, 0, 0, 0};
 291
 292 typedef struct {
 293     guint16 source_port;
 294     guint16 dest_port;
 295     guint32 seq_num;
 296     guint32 ack_num;
 297     guint8  hdr_length;
 298     guint8  flags;
 299     guint16 window;
 300     guint16 checksum;
 301     guint16 urg;
 302 } hdr_tcp_t;
 303
 304 static hdr_tcp_t HDR_TCP = {0, 0, 0, 0, 0x50, 0, 0, 0, 0};
 305
 306 typedef struct {
 307     guint16 src_port;
 308     guint16 dest_port;
 309     guint32 tag;
 310     guint32 checksum;
 311 } hdr_sctp_t;
 312
 313 static hdr_sctp_t HDR_SCTP = {0, 0, 0, 0};
 314
 315 typedef struct {
 316     guint8  type;
 317     guint8  bits;
 318     guint16 length;
 319     guint32 tsn;
 320     guint16 sid;
 321     guint16 ssn;
 322     guint32 ppid;
 323 } hdr_data_chunk_t;
 324
 325 static hdr_data_chunk_t HDR_DATA_CHUNK = {0, 0, 0, 0, 0, 0, 0};
 326
 327 static char tempbuf[64];
 328
 329 /*----------------------------------------------------------------------
 330  * Stuff for writing a PCap file
 331  */
 332 #define PCAP_MAGIC                      0xa1b2c3d4
 333
 334 /* "libpcap" file header (minus magic number). */
 335 struct pcap_hdr {
 336     guint32     magic;          /* magic */
 337     guint16     version_major;  /* major version number */
 338     guint16     version_minor;  /* minor version number */
 339     guint32     thiszone;       /* GMT to local correction */
 340     guint32     sigfigs;        /* accuracy of timestamps */
 341     guint32     snaplen;        /* max length of captured packets, in octets */
 342     guint32     network;        /* data link type */
 343 };
 344
 345 /* "libpcap" record header. */
 346 struct pcaprec_hdr {
 347     guint32     ts_sec;         /* timestamp seconds */
 348     guint32     ts_usec;        /* timestamp microseconds */
 349     guint32     incl_len;       /* number of octets of packet saved in file */
 350     guint32     orig_len;       /* actual length of packet */
 351 };
 352
 353 /* Link-layer type; see net/bpf.h for details */
 354 static unsigned long pcap_link_type = 1;   /* Default is DLT-EN10MB */
 355
 356 /*----------------------------------------------------------------------
 357  * Parse a single hex number
 358  * Will abort the program if it can't parse the number
 359  * Pass in TRUE if this is an offset, FALSE if not
 360  */
 361 static unsigned long
 362 parse_num (const char *str, int offset)
 363 {
 364     unsigned long num;
 365     char *c;
 366
 367     num = strtoul(str, &c, offset ? offset_base : 16);
 368     if (c==str) {
 369         fprintf(stderr, "FATAL ERROR: Bad hex number? [%s]\n", str);
 370         exit(-1);
 371     }
 372     return num;
 373 }
 374
 375 /*----------------------------------------------------------------------
 376  * Write this byte into current packet
 377  */
 378 static void
 379 write_byte (const char *str)
 380 {
 381     unsigned long num;
 382
 383     num = parse_num(str, FALSE);
 384     packet_buf[curr_offset] = (unsigned char) num;
 385     curr_offset ++;
 386     if (curr_offset >= max_offset) /* packet full */
 387             start_new_packet();
 388 }
 389
 390 /*----------------------------------------------------------------------
 391  * Remove bytes from the current packet
 392  */
 393 static void
 394 unwrite_bytes (unsigned long nbytes)
 395 {
 396     curr_offset -= nbytes;
 397 }
 398
 399 /*----------------------------------------------------------------------
 400  * Compute one's complement checksum (from RFC1071)
 401  */
 402 static guint16
 403 in_checksum (void *buf, unsigned long count)
 404 {
 405     unsigned long sum = 0;
 406     guint16 *addr = buf;
 407
 408     while( count > 1 )  {
 409         /*  This is the inner loop */
 410         sum += g_ntohs(* (guint16 *) addr);
 411         addr++;
 412         count -= 2;
 413     }
 414
 415     /*  Add left-over byte, if any */
 416     if( count > 0 )
 417         sum += g_ntohs(* (guint8 *) addr);
 418
 419     /*  Fold 32-bit sum to 16 bits */
 420     while (sum>>16)
 421         sum = (sum & 0xffff) + (sum >> 16);
 422
 423     sum = ~sum;
 424     return g_htons(sum);
 425 }
 426
 427 /* The CRC32C code is taken from draft-ietf-tsvwg-sctpcsum-01.txt.
 428  * That code is copyrighted by D. Otis and has been modified.
 429  */
 430
 431 #define CRC32C(c,d) (c=(c>>8)^crc_c[(c^(d))&0xFF])
 432 static guint32 crc_c[256] =
 433 {
 434 0x00000000L, 0xF26B8303L, 0xE13B70F7L, 0x1350F3F4L,
 435 0xC79A971FL, 0x35F1141CL, 0x26A1E7E8L, 0xD4CA64EBL,
 436 0x8AD958CFL, 0x78B2DBCCL, 0x6BE22838L, 0x9989AB3BL,
 437 0x4D43CFD0L, 0xBF284CD3L, 0xAC78BF27L, 0x5E133C24L,
 438 0x105EC76FL, 0xE235446CL, 0xF165B798L, 0x030E349BL,
 439 0xD7C45070L, 0x25AFD373L, 0x36FF2087L, 0xC494A384L,
 440 0x9A879FA0L, 0x68EC1CA3L, 0x7BBCEF57L, 0x89D76C54L,
 441 0x5D1D08BFL, 0xAF768BBCL, 0xBC267848L, 0x4E4DFB4BL,
 442 0x20BD8EDEL, 0xD2D60DDDL, 0xC186FE29L, 0x33ED7D2AL,
 443 0xE72719C1L, 0x154C9AC2L, 0x061C6936L, 0xF477EA35L,
 444 0xAA64D611L, 0x580F5512L, 0x4B5FA6E6L, 0xB93425E5L,
 445 0x6DFE410EL, 0x9F95C20DL, 0x8CC531F9L, 0x7EAEB2FAL,
 446 0x30E349B1L, 0xC288CAB2L, 0xD1D83946L, 0x23B3BA45L,
 447 0xF779DEAEL, 0x05125DADL, 0x1642AE59L, 0xE4292D5AL,
 448 0xBA3A117EL, 0x4851927DL, 0x5B016189L, 0xA96AE28AL,
 449 0x7DA08661L, 0x8FCB0562L, 0x9C9BF696L, 0x6EF07595L,
 450 0x417B1DBCL, 0xB3109EBFL, 0xA0406D4BL, 0x522BEE48L,
 451 0x86E18AA3L, 0x748A09A0L, 0x67DAFA54L, 0x95B17957L,
 452 0xCBA24573L, 0x39C9C670L, 0x2A993584L, 0xD8F2B687L,
 453 0x0C38D26CL, 0xFE53516FL, 0xED03A29BL, 0x1F682198L,
 454 0x5125DAD3L, 0xA34E59D0L, 0xB01EAA24L, 0x42752927L,
 455 0x96BF4DCCL, 0x64D4CECFL, 0x77843D3BL, 0x85EFBE38L,
 456 0xDBFC821CL, 0x2997011FL, 0x3AC7F2EBL, 0xC8AC71E8L,
 457 0x1C661503L, 0xEE0D9600L, 0xFD5D65F4L, 0x0F36E6F7L,
 458 0x61C69362L, 0x93AD1061L, 0x80FDE395L, 0x72966096L,
 459 0xA65C047DL, 0x5437877EL, 0x4767748AL, 0xB50CF789L,
 460 0xEB1FCBADL, 0x197448AEL, 0x0A24BB5AL, 0xF84F3859L,
 461 0x2C855CB2L, 0xDEEEDFB1L, 0xCDBE2C45L, 0x3FD5AF46L,
 462 0x7198540DL, 0x83F3D70EL, 0x90A324FAL, 0x62C8A7F9L,
 463 0xB602C312L, 0x44694011L, 0x5739B3E5L, 0xA55230E6L,
 464 0xFB410CC2L, 0x092A8FC1L, 0x1A7A7C35L, 0xE811FF36L,
 465 0x3CDB9BDDL, 0xCEB018DEL, 0xDDE0EB2AL, 0x2F8B6829L,
 466 0x82F63B78L, 0x709DB87BL, 0x63CD4B8FL, 0x91A6C88CL,
 467 0x456CAC67L, 0xB7072F64L, 0xA457DC90L, 0x563C5F93L,
 468 0x082F63B7L, 0xFA44E0B4L, 0xE9141340L, 0x1B7F9043L,
 469 0xCFB5F4A8L, 0x3DDE77ABL, 0x2E8E845FL, 0xDCE5075CL,
 470 0x92A8FC17L, 0x60C37F14L, 0x73938CE0L, 0x81F80FE3L,
 471 0x55326B08L, 0xA759E80BL, 0xB4091BFFL, 0x466298FCL,
 472 0x1871A4D8L, 0xEA1A27DBL, 0xF94AD42FL, 0x0B21572CL,
 473 0xDFEB33C7L, 0x2D80B0C4L, 0x3ED04330L, 0xCCBBC033L,
 474 0xA24BB5A6L, 0x502036A5L, 0x4370C551L, 0xB11B4652L,
 475 0x65D122B9L, 0x97BAA1BAL, 0x84EA524EL, 0x7681D14DL,
 476 0x2892ED69L, 0xDAF96E6AL, 0xC9A99D9EL, 0x3BC21E9DL,
 477 0xEF087A76L, 0x1D63F975L, 0x0E330A81L, 0xFC588982L,
 478 0xB21572C9L, 0x407EF1CAL, 0x532E023EL, 0xA145813DL,
 479 0x758FE5D6L, 0x87E466D5L, 0x94B49521L, 0x66DF1622L,
 480 0x38CC2A06L, 0xCAA7A905L, 0xD9F75AF1L, 0x2B9CD9F2L,
 481 0xFF56BD19L, 0x0D3D3E1AL, 0x1E6DCDEEL, 0xEC064EEDL,
 482 0xC38D26C4L, 0x31E6A5C7L, 0x22B65633L, 0xD0DDD530L,
 483 0x0417B1DBL, 0xF67C32D8L, 0xE52CC12CL, 0x1747422FL,
 484 0x49547E0BL, 0xBB3FFD08L, 0xA86F0EFCL, 0x5A048DFFL,
 485 0x8ECEE914L, 0x7CA56A17L, 0x6FF599E3L, 0x9D9E1AE0L,
 486 0xD3D3E1ABL, 0x21B862A8L, 0x32E8915CL, 0xC083125FL,
 487 0x144976B4L, 0xE622F5B7L, 0xF5720643L, 0x07198540L,
 488 0x590AB964L, 0xAB613A67L, 0xB831C993L, 0x4A5A4A90L,
 489 0x9E902E7BL, 0x6CFBAD78L, 0x7FAB5E8CL, 0x8DC0DD8FL,
 490 0xE330A81AL, 0x115B2B19L, 0x020BD8EDL, 0xF0605BEEL,
 491 0x24AA3F05L, 0xD6C1BC06L, 0xC5914FF2L, 0x37FACCF1L,
 492 0x69E9F0D5L, 0x9B8273D6L, 0x88D28022L, 0x7AB90321L,
 493 0xAE7367CAL, 0x5C18E4C9L, 0x4F48173DL, 0xBD23943EL,
 494 0xF36E6F75L, 0x0105EC76L, 0x12551F82L, 0xE03E9C81L,
 495 0x34F4F86AL, 0xC69F7B69L, 0xD5CF889DL, 0x27A40B9EL,
 496 0x79B737BAL, 0x8BDCB4B9L, 0x988C474DL, 0x6AE7C44EL,
 497 0xBE2DA0A5L, 0x4C4623A6L, 0x5F16D052L, 0xAD7D5351L,
 498 };
 499
 500 static guint32
 501 crc32c(const guint8* buf, unsigned int len, guint32 crc32_init)
 502 {
 503   unsigned int i;
 504   guint32 crc32;
 505
 506   crc32 = crc32_init;
 507   for (i = 0; i < len; i++)
 508     CRC32C(crc32, buf[i]);
 509
 510   return ( crc32 );
 511 }
 512
 513 static guint32
 514 finalize_crc32c(guint32 crc32)
 515 {
 516   guint32 result;
 517   guint8 byte0,byte1,byte2,byte3;
 518
 519   result = ~crc32;
 520   byte0 = result & 0xff;
 521   byte1 = (result>>8) & 0xff;
 522   byte2 = (result>>16) & 0xff;
 523   byte3 = (result>>24) & 0xff;
 524   result = ((byte0 << 24) | (byte1 << 16) | (byte2 << 8) | byte3);
 525   return ( result );
 526 }
 527
 528 static unsigned long
 529 number_of_padding_bytes (unsigned long length)
 530 {
 531   unsigned long remainder;
 532
 533   remainder = length % 4;
 534
 535   if (remainder == 0)
 536     return 0;
 537   else
 538     return 4 - remainder;
 539 }
 540
 541 /*----------------------------------------------------------------------
 542  * Write current packet out
 543  */
 544 static void
 545 write_current_packet (void)
 546 {
 547     int length = 0;
 548     int proto_length = 0;
 549     int ip_length = 0;
 550     int eth_trailer_length = 0;
 551     int i, padding_length;
 552     guint32 u;
 553     struct pcaprec_hdr ph;
 554
 555     if (curr_offset > 0) {
 556         /* Write the packet */
 557
 558         /* Compute packet length */
 559         length = curr_offset;
 560         if (hdr_data_chunk) { length += sizeof(HDR_DATA_CHUNK) + number_of_padding_bytes(curr_offset); }
 561         if (hdr_sctp) { length += sizeof(HDR_SCTP); }
 562         if (hdr_udp) { length += sizeof(HDR_UDP); proto_length = length; }
 563         if (hdr_tcp) { length += sizeof(HDR_TCP); proto_length = length; }
 564         if (hdr_ip) { length += sizeof(HDR_IP); ip_length = length; }
 565         if (hdr_ethernet) {
 566             length += sizeof(HDR_ETHERNET);
 567             /* Pad trailer */
 568             if (length < 60) {
 569                 eth_trailer_length = 60 - length;
 570                 length = 60;
 571             }
 572         }
 573
 574         /* Write PCAP header */
 575         ph.ts_sec = (guint32)ts_sec;
 576         ph.ts_usec = ts_usec;
 577         if (ts_fmt == NULL) { ts_usec++; }      /* fake packet counter */
 578         ph.incl_len = length;
 579         ph.orig_len = length;
 580         if (fwrite(&ph, sizeof(ph), 1, output_file) != 1)
 581             goto write_current_packet_err;
 582
 583         /* Write Ethernet header */
 584         if (hdr_ethernet) {
 585             HDR_ETHERNET.l3pid = g_htons(hdr_ethernet_proto);
 586             if (fwrite(&HDR_ETHERNET, sizeof(HDR_ETHERNET), 1, output_file) != 1)
 587                 goto write_current_packet_err;
 588         }
 589
 590         /* Write IP header */
 591         if (hdr_ip) {
 592             HDR_IP.packet_length = g_htons(ip_length);
 593             HDR_IP.protocol = (guint8) hdr_ip_proto;
 594             HDR_IP.hdr_checksum = 0;
 595             HDR_IP.hdr_checksum = in_checksum(&HDR_IP, sizeof(HDR_IP));
 596             if (fwrite(&HDR_IP, sizeof(HDR_IP), 1, output_file) != 1)
 597                 goto write_current_packet_err;
 598         }
 599
 600         /* initialize pseudo header for checksum calculation */
 601         pseudoh.src_addr    = HDR_IP.src_addr;
 602         pseudoh.dest_addr   = HDR_IP.dest_addr;
 603         pseudoh.zero        = 0;
 604         pseudoh.protocol    = (guint8) hdr_ip_proto;
 605         pseudoh.length      = g_htons(proto_length);
 606
 607         /* Write UDP header */
 608         if (hdr_udp) {
 609             guint16 x16;
 610             HDR_UDP.source_port = g_htons(hdr_src_port);
 611             HDR_UDP.dest_port = g_htons(hdr_dest_port);
 612             HDR_UDP.length = g_htons(proto_length);
 613
 614             /* Note: g_ntohs()/g_htons() macro arg may be eval'd twice so calc value before invoking macro */
 615             HDR_UDP.checksum = 0;
 616             x16  = in_checksum(&pseudoh, sizeof(pseudoh));
 617             u    = g_ntohs(x16);
 618             x16  = in_checksum(&HDR_UDP, sizeof(HDR_UDP));
 619             u   += g_ntohs(x16);
 620             x16  = in_checksum(packet_buf, curr_offset);
 621             u   += g_ntohs(x16);
 622             x16  = (u & 0xffff) + (u>>16);
 623             HDR_UDP.checksum = g_htons(x16);
 624             if (HDR_UDP.checksum == 0) /* differentiate between 'none' and 0 */
 625                     HDR_UDP.checksum = g_htons(1);
 626
 627             if (fwrite(&HDR_UDP, sizeof(HDR_UDP), 1, output_file) != 1)
 628                 goto write_current_packet_err;
 629         }
 630
 631         /* Write TCP header */
 632         if (hdr_tcp) {
 633             guint16 x16;
 634             HDR_TCP.source_port = g_htons(hdr_src_port);
 635             HDR_TCP.dest_port = g_htons(hdr_dest_port);
 636             /* HDR_TCP.seq_num already correct */
 637             HDR_TCP.window = g_htons(0x2000);
 638
 639             /* Note: g_ntohs()/g_htons() macro arg may be eval'd twice so calc value before invoking macro */
 640             HDR_TCP.checksum = 0;
 641             x16  = in_checksum(&pseudoh, sizeof(pseudoh));
 642             u    = g_ntohs(x16);
 643             x16  = in_checksum(&HDR_TCP, sizeof(HDR_TCP));
 644             u   += g_ntohs(x16);
 645             x16  = in_checksum(packet_buf, curr_offset);
 646             u   += g_ntohs(x16);
 647             x16  = (u & 0xffff) + (u>>16);
 648             HDR_TCP.checksum = g_htons(x16);
 649             if (HDR_TCP.checksum == 0) /* differentiate between 'none' and 0 */
 650                 HDR_TCP.checksum = g_htons(1);
 651
 652             if (fwrite(&HDR_TCP, sizeof(HDR_TCP), 1, output_file) != 1)
 653                 goto write_current_packet_err;
 654         }
 655
 656         /* Compute DATA chunk header and append padding */
 657         if (hdr_data_chunk) {
 658             HDR_DATA_CHUNK.type   = hdr_data_chunk_type;
 659             HDR_DATA_CHUNK.bits   = hdr_data_chunk_bits;
 660             HDR_DATA_CHUNK.length = g_htons(curr_offset + sizeof(HDR_DATA_CHUNK));
 661             HDR_DATA_CHUNK.tsn    = g_htonl(hdr_data_chunk_tsn);
 662             HDR_DATA_CHUNK.sid    = g_htons(hdr_data_chunk_sid);
 663             HDR_DATA_CHUNK.ssn    = g_htons(hdr_data_chunk_ssn);
 664             HDR_DATA_CHUNK.ppid   = g_htonl(hdr_data_chunk_ppid);
 665
 666             padding_length = number_of_padding_bytes(curr_offset);
 667             for (i=0; i<padding_length; i++)
 668               write_byte("0");
 669         }
 670
 671         /* Write SCTP header */
 672         if (hdr_sctp) {
 673             guint32 x32;
 674             HDR_SCTP.src_port  = g_htons(hdr_sctp_src);
 675             HDR_SCTP.dest_port = g_htons(hdr_sctp_dest);
 676             HDR_SCTP.tag       = g_htonl(hdr_sctp_tag);
 677             HDR_SCTP.checksum  = g_htonl(0);
 678             HDR_SCTP.checksum  = crc32c((guint8 *)&HDR_SCTP, sizeof(HDR_SCTP), ~0L);
 679             if (hdr_data_chunk)
 680               HDR_SCTP.checksum  = crc32c((guint8 *)&HDR_DATA_CHUNK, sizeof(HDR_DATA_CHUNK), HDR_SCTP.checksum);
 681             /* Note: g_ntohl() macro arg may be eval'd twice so calc value before invoking macro */
 682             x32 = finalize_crc32c(crc32c(packet_buf, curr_offset, HDR_SCTP.checksum));
 683             HDR_SCTP.checksum  = g_htonl(x32);
 684
 685             if (fwrite(&HDR_SCTP, sizeof(HDR_SCTP), 1, output_file) != 1)
 686                 goto write_current_packet_err;
 687         }
 688
 689         /* Write DATA chunk header */
 690         if (hdr_data_chunk) {
 691             if (fwrite(&HDR_DATA_CHUNK, sizeof(HDR_DATA_CHUNK), 1, output_file) != 1)
 692                 goto write_current_packet_err;
 693         }
 694         /* Write packet */
 695         if (fwrite(packet_buf, curr_offset, 1, output_file) != 1)
 696             goto write_current_packet_err;
 697
 698         /* Write Ethernet trailer */
 699         if (hdr_ethernet && eth_trailer_length > 0) {
 700             memset(tempbuf, 0, eth_trailer_length);
 701             if (fwrite(tempbuf, eth_trailer_length, 1, output_file) != 1)
 702                 goto write_current_packet_err;
 703         }
 704
 705         if (!quiet)
 706             fprintf(stderr, "Wrote packet of %lu bytes at %u\n", curr_offset, g_ntohl(HDR_TCP.seq_num));
 707         num_packets_written ++;
 708     }
 709     HDR_TCP.seq_num = g_ntohl(HDR_TCP.seq_num) + curr_offset;
 710     HDR_TCP.seq_num = g_htonl(HDR_TCP.seq_num);
 711
 712     packet_start += curr_offset;
 713     curr_offset = 0;
 714     return;
 715
 716 write_current_packet_err:
 717     fprintf(stderr, "File write error [%s] : %s\n",
 718             output_filename, g_strerror(errno));
 719     exit(-1);
 720 }
 721
 722 /*----------------------------------------------------------------------
 723  * Write the PCap file header
 724  */
 725 static void
 726 write_file_header (void)
 727 {
 728     struct pcap_hdr fh;
 729
 730     fh.magic = PCAP_MAGIC;
 731     fh.version_major = 2;
 732     fh.version_minor = 4;
 733     fh.thiszone = 0;
 734     fh.sigfigs = 0;
 735     fh.snaplen = 102400;
 736     fh.network = pcap_link_type;
 737
 738     if (fwrite(&fh, sizeof(fh), 1, output_file) != 1) {
 739         fprintf(stderr, "File write error [%s] : %s\n",
 740                 output_filename, g_strerror(errno));
 741         exit(-1);
 742     }
 743 }
 744
 745 /*----------------------------------------------------------------------
 746  * Append a token to the packet preamble.
 747  */
 748 static void
 749 append_to_preamble(char *str)
 750 {
 751     size_t toklen;
 752
 753     if (packet_preamble_len != 0) {
 754         if (packet_preamble_len == PACKET_PREAMBLE_MAX_LEN)
 755             return;     /* no room to add more preamble */
 756         /* Add a blank separator between the previous token and this token. */
 757         packet_preamble[packet_preamble_len++] = ' ';
 758     }
 759     toklen = strlen(str);
 760     if (toklen != 0) {
 761         if (packet_preamble_len + toklen > PACKET_PREAMBLE_MAX_LEN)
 762             return;     /* no room to add the token to the preamble */
 763         g_strlcpy(&packet_preamble[packet_preamble_len], str, PACKET_PREAMBLE_MAX_LEN);
 764         packet_preamble_len += (int) toklen;
 765         if (debug >= 2) {
 766                 char *c;
 767                 char xs[PACKET_PREAMBLE_MAX_LEN];
 768                 g_strlcpy(xs, packet_preamble, PACKET_PREAMBLE_MAX_LEN);
 769                 while ((c = strchr(xs, '\r')) != NULL) *c=' ';
 770                 fprintf (stderr, "[[append_to_preamble: \"%s\"]]", xs);
 771         }
 772     }
 773 }
 774
 775 /*----------------------------------------------------------------------
 776  * Parse the preamble to get the timecode.
 777  */
 778
 779 static void
 780 parse_preamble (void)
 781 {
 782         struct tm timecode;
 783         char *subsecs;
 784         char *p;
 785         int  subseclen;
 786         int  i;
 787
 788         /*
 789          * If no "-t" flag was specified, don't attempt to parse a packet
 790          * preamble to extract a time stamp.
 791          */
 792         if (ts_fmt == NULL)
 793             return;
 794
 795         /*
 796          * Initialize to today localtime, just in case not all fields
 797          * of the date and time are specified.
 798          */
 799
 800         timecode = timecode_default;
 801         ts_usec = 0;
 802
 803         /*
 804          * Null-terminate the preamble.
 805          */
 806         packet_preamble[packet_preamble_len] = '\0';
 807
 808         /* Ensure preamble has more than two chars before attempting to parse.
 809          * This should cover line breaks etc that get counted.
 810          */
 811         if ( strlen(packet_preamble) > 2 ) {
 812                 /* Get Time leaving subseconds */
 813                 subsecs = strptime( packet_preamble, ts_fmt, &timecode );
 814                 if (subsecs != NULL) {
 815                         /* Get the long time from the tm structure */
 816                         /*  (will return -1 if failure)            */
 817                         ts_sec  = mktime( &timecode );
 818                 } else
 819                         ts_sec = -1;    /* we failed to parse it */
 820
 821                 /* This will ensure incorrectly parsed dates get set to zero */
 822                 if ( -1 == ts_sec )
 823                 {
 824                         /* Sanitize - remove all '\r' */
 825                         char *c;
 826                         while ((c = strchr(packet_preamble, '\r')) != NULL) *c=' ';
 827                         fprintf (stderr, "Failure processing time \"%s\" using time format \"%s\"\n   (defaulting to Jan 1,1970 00:00:00 GMT)\n",
 828                                  packet_preamble, ts_fmt);
 829                         if (debug >= 2) {
 830                                 fprintf(stderr, "timecode: %02d/%02d/%d %02d:%02d:%02d %d\n",
 831                                         timecode.tm_mday, timecode.tm_mon, timecode.tm_year,
 832                                         timecode.tm_hour, timecode.tm_min, timecode.tm_sec, timecode.tm_isdst);
 833                         }
 834                         ts_sec  = 0;  /* Jan 1,1970: 00:00 GMT; tshark/wireshark will display date/time as adjusted by timezone */
 835                         ts_usec = 0;
 836                 }
 837                 else
 838                 {
 839                         /* Parse subseconds */
 840                         ts_usec = strtol(subsecs, &p, 10);
 841                         if (subsecs == p) {
 842                                 /* Error */
 843                                 ts_usec = 0;
 844                         } else {
 845                                 /*
 846                                  * Convert that number to a number
 847                                  * of microseconds; if it's N digits
 848                                  * long, it's in units of 10^(-N) seconds,
 849                                  * so, to convert it to units of
 850                                  * 10^-6 seconds, we multiply by
 851                                  * 10^(6-N).
 852                                  */
 853                                 subseclen = (int) (p - subsecs);
 854                                 if (subseclen > 6) {
 855                                         /*
 856                                          * *More* than 6 digits; 6-N is
 857                                          * negative, so we divide by
 858                                          * 10^(N-6).
 859                                          */
 860                                         for (i = subseclen - 6; i != 0; i--)
 861                                                 ts_usec /= 10;
 862                                 } else if (subseclen < 6) {
 863                                         for (i = 6 - subseclen; i != 0; i--)
 864                                                 ts_usec *= 10;
 865                                 }
 866                         }
 867                 }
 868         }
 869         if (debug >= 2) {
 870                 char *c;
 871                 while ((c = strchr(packet_preamble, '\r')) != NULL) *c=' ';
 872                 fprintf(stderr, "[[parse_preamble: \"%s\"]]\n", packet_preamble);
 873                 fprintf(stderr, "Format(%s), time(%u), subsecs(%u)\n", ts_fmt, (guint32)ts_sec, ts_usec);
 874         }
 875
 876
 877         /* Clear Preamble */
 878         packet_preamble_len = 0;
 879 }
 880
 881 /*----------------------------------------------------------------------
 882  * Start a new packet
 883  */
 884 static void
 885 start_new_packet (void)
 886 {
 887     if (debug>=1)
 888         fprintf(stderr, "Start new packet\n");
 889
 890     /* Write out the current packet, if required */
 891     write_current_packet();
 892     num_packets_read ++;
 893
 894     /* Ensure we parse the packet preamble as it may contain the time */
 895     parse_preamble();
 896 }
 897
 898 /*----------------------------------------------------------------------
 899  * Process a directive
 900  */
 901 static void
 902 process_directive (char *str)
 903 {
 904     fprintf(stderr, "\n--- Directive [%s] currently unsupported ---\n", str+10);
 905
 906 }
 907
 908 /*----------------------------------------------------------------------
 909  * Parse a single token (called from the scanner)
 910  */
 911 void
 912 parse_token (token_t token, char *str)
 913 {
 914     unsigned long num;
 915
 916     /*
 917      * This is implemented as a simple state machine of five states.
 918      * State transitions are caused by tokens being received from the
 919      * scanner. The code should be self_documenting.
 920      */
 921
 922     if (debug>=2) {
 923         /* Sanitize - remove all '\r' */
 924         char *c;
 925         if (str!=NULL) { while ((c = strchr(str, '\r')) != NULL) *c=' '; }
 926
 927         fprintf(stderr, "(%s, %s \"%s\") -> (",
 928                 state_str[state], token_str[token], str ? str : "");
 929     }
 930
 931     switch(state) {
 932
 933     /* ----- Waiting for new packet -------------------------------------------*/
 934     case INIT:
 935         switch(token) {
 936         case T_TEXT:
 937             append_to_preamble(str);
 938             break;
 939         case T_DIRECTIVE:
 940             process_directive(str);
 941             break;
 942         case T_OFFSET:
 943             num = parse_num(str, TRUE);
 944             if (num==0) {
 945                 /* New packet starts here */
 946                 start_new_packet();
 947                 state = READ_OFFSET;
 948             }
 949             break;
 950         default:
 951             break;
 952         }
 953         break;
 954
 955     /* ----- Processing packet, start of new line -----------------------------*/
 956     case START_OF_LINE:
 957         switch(token) {
 958         case T_TEXT:
 959             append_to_preamble(str);
 960             break;
 961         case T_DIRECTIVE:
 962             process_directive(str);
 963             break;
 964         case T_OFFSET:
 965             num = parse_num(str, TRUE);
 966             if (num==0) {
 967                 /* New packet starts here */
 968                 start_new_packet();
 969                 packet_start = 0;
 970                 state = READ_OFFSET;
 971             } else if ((num - packet_start) != curr_offset) {
 972                 /*
 973                  * The offset we read isn't the one we expected.
 974                  * This may only mean that we mistakenly interpreted
 975                  * some text as byte values (e.g., if the text dump
 976                  * of packet data included a number with spaces around
 977                  * it).  If the offset is less than what we expected,
 978                  * assume that's the problem, and throw away the putative
 979                  * extra byte values.
 980                  */
 981                 if (num < curr_offset) {
 982                     unwrite_bytes(curr_offset - num);
 983                     state = READ_OFFSET;
 984                 } else {
 985                     /* Bad offset; switch to INIT state */
 986                     if (debug>=1)
 987                         fprintf(stderr, "Inconsistent offset. Expecting %0lX, got %0lX. Ignoring rest of packet\n",
 988                                 curr_offset, num);
 989                     write_current_packet();
 990                     state = INIT;
 991                 }
 992             } else
 993                 state = READ_OFFSET;
 994             break;
 995         default:
 996             break;
 997         }
 998         break;
 999
1000     /* ----- Processing packet, read offset -----------------------------------*/
1001     case READ_OFFSET:
1002         switch(token) {
1003         case T_BYTE:
1004             /* Record the byte */
1005             state = READ_BYTE;
1006             write_byte(str);
1007             break;
1008         case T_TEXT:
1009         case T_DIRECTIVE:
1010         case T_OFFSET:
1011             state = READ_TEXT;
1012             break;
1013         case T_EOL:
1014             state = START_OF_LINE;
1015             break;
1016         default:
1017             break;
1018         }
1019         break;
1020
1021     /* ----- Processing packet, read byte -------------------------------------*/
1022     case READ_BYTE:
1023         switch(token) {
1024         case T_BYTE:
1025             /* Record the byte */
1026             write_byte(str);
1027             break;
1028         case T_TEXT:
1029         case T_DIRECTIVE:
1030         case T_OFFSET:
1031             state = READ_TEXT;
1032             break;
1033         case T_EOL:
1034             state = START_OF_LINE;
1035             break;
1036         default:
1037             break;
1038         }
1039         break;
1040
1041     /* ----- Processing packet, read text -------------------------------------*/
1042     case READ_TEXT:
1043         switch(token) {
1044         case T_EOL:
1045             state = START_OF_LINE;
1046             break;
1047         default:
1048             break;
1049         }
1050         break;
1051
1052     default:
1053         fprintf(stderr, "FATAL ERROR: Bad state (%d)", state);
1054         exit(-1);
1055     }
1056
1057     if (debug>=2)
1058         fprintf(stderr, ", %s)\n", state_str[state]);
1059
1060 }
1061
1062 /*----------------------------------------------------------------------
1063  * Print usage string and exit
1064  */
1065 static void
1066 usage (void)
1067 {
1068     fprintf(stderr,
1069             "Text2pcap %s"
1070 #ifdef SVNVERSION
1071             " (" SVNVERSION " from " SVNPATH ")"
1072 #endif
1073             "\n"
1074             "Generate a capture file from an ASCII hexdump of packets.\n"
1075             "See http://www.wireshark.org for more information.\n"
1076             "\n"
1077             "Usage: text2pcap [options] <infile> <outfile>\n"
1078             "\n"
1079             "where  <infile> specifies input  filename (use - for standard input)\n"
1080             "      <outfile> specifies output filename (use - for standard output)\n"
1081             "\n"
1082             "Input:\n"
1083             "  -o hex|oct|dec         parse offsets as (h)ex, (o)ctal or (d)ecimal;\n"
1084             "                         default is hex.\n"
1085             "  -t <timefmt>           treat the text before the packet as a date/time code;\n"
1086             "                         the specified argument is a format string of the sort\n"
1087             "                         supported by strptime.\n"
1088             "                         Example: The time \"10:15:14.5476\" has the format code\n"
1089             "                         \"%%H:%%M:%%S.\"\n"
1090             "                         NOTE: The subsecond component delimiter, '.', must be\n"
1091             "                         given, but no pattern is required; the remaining\n"
1092             "                         number is assumed to be fractions of a second.\n"
1093             "                         NOTE: Date/time fields from the current date/time are\n"
1094             "                         used as the default for unspecified fields.\n"
1095             "\n"
1096             "Output:\n"
1097             "  -l <typenum>           link-layer type number; default is 1 (Ethernet).\n"
1098             "                         See the file net/bpf.h for list of numbers.\n"
1099             "                         Use this option if your dump is a complete hex dump\n"
1100             "                         of an encapsulated packet and you wish to specify\n"
1101             "                         the exact type of encapsulation.\n"
1102             "                         Example: -l 7 for ARCNet packets.\n"
1103             "  -m <max-packet>        max packet length in output; default is %d\n"
1104             "\n"
1105             "Prepend dummy header:\n"
1106             "  -e <l3pid>             prepend dummy Ethernet II header with specified L3PID\n"
1107             "                         (in HEX).\n"
1108             "                         Example: -e 0x806 to specify an ARP packet.\n"
1109             "  -i <proto>             prepend dummy IP header with specified IP protocol\n"
1110             "                         (in DECIMAL).\n"
1111             "                         Automatically prepends Ethernet header as well.\n"
1112             "                         Example: -i 46\n"
1113             "  -u <srcp>,<destp>      prepend dummy UDP header with specified\n"
1114             "                         dest and source ports (in DECIMAL).\n"
1115             "                         Automatically prepends Ethernet & IP headers as well.\n"
1116             "                         Example: -u 1000,69 to make the packets look like\n"
1117             "                         TFTP/UDP packets.\n"
1118             "  -T <srcp>,<destp>      prepend dummy TCP header with specified\n"
1119             "                         dest and source ports (in DECIMAL).\n"
1120             "                         Automatically prepends Ethernet & IP headers as well.\n"
1121             "                         Example: -T 50,60\n"
1122             "  -s <srcp>,<dstp>,<tag> prepend dummy SCTP header with specified\n"
1123             "                         dest/source ports and verification tag (in DECIMAL).\n"
1124             "                         Automatically prepends Ethernet & IP headers as well.\n"
1125             "                         Example: -s 30,40,34\n"
1126             "  -S <srcp>,<dstp>,<ppi> prepend dummy SCTP header with specified\n"
1127             "                         dest/source ports and verification tag 0.\n"
1128             "                         Automatically prepends a dummy SCTP DATA\n"
1129             "                         chunk header with payload protocol identifier ppi.\n"
1130             "                         Example: -S 30,40,34\n"
1131             "\n"
1132             "Miscellaneous:\n"
1133             "  -h                     display this help and exit.\n"
1134             "  -d                     show detailed debug of parser states.\n"
1135             "  -q                     generate no output at all (automatically turns off -d).\n"
1136             "",
1137             VERSION, MAX_PACKET);
1138
1139     exit(-1);
1140 }
1141
1142 /*----------------------------------------------------------------------
1143  * Parse CLI options
1144  */
1145 static void
1146 parse_options (int argc, char *argv[])
1147 {
1148     int c;
1149     char *p;
1150
1151 #ifdef _WIN32
1152     arg_list_utf_16to8(argc, argv);
1153 #endif /* _WIN32 */
1154
1155     /* Scan CLI parameters */
1156     while ((c = getopt(argc, argv, "dhqe:i:l:m:o:u:s:S:t:T:")) != -1) {
1157         switch(c) {
1158         case '?': usage(); break;
1159         case 'h': usage(); break;
1160         case 'd': if (!quiet) debug++; break;
1161         case 'q': quiet = TRUE; debug = FALSE; break;
1162         case 'l': pcap_link_type = strtol(optarg, NULL, 0); break;
1163         case 'm': max_offset = strtol(optarg, NULL, 0); break;
1164         case 'o':
1165             if (optarg[0]!='h' && optarg[0] != 'o' && optarg[0] != 'd') {
1166                 fprintf(stderr, "Bad argument for '-o': %s\n", optarg);
1167                 usage();
1168             }
1169                         switch(optarg[0]) {
1170                         case 'o': offset_base = 8; break;
1171                         case 'h': offset_base = 16; break;
1172                         case 'd': offset_base = 10; break;
1173                         }
1174             break;
1175         case 'e':
1176             hdr_ethernet = TRUE;
1177             if (sscanf(optarg, "%lx", &hdr_ethernet_proto) < 1) {
1178                 fprintf(stderr, "Bad argument for '-e': %s\n", optarg);
1179                 usage();
1180             }
1181             break;
1182
1183         case 'i':
1184             hdr_ip = TRUE;
1185             hdr_ip_proto = strtol(optarg, &p, 10);
1186             if (p == optarg || *p != '\0' || hdr_ip_proto < 0 ||
1187                   hdr_ip_proto > 255) {
1188                 fprintf(stderr, "Bad argument for '-i': %s\n", optarg);
1189                 usage();
1190             }
1191             hdr_ethernet = TRUE;
1192             hdr_ethernet_proto = 0x800;
1193             break;
1194
1195         case 's':
1196             hdr_sctp       = TRUE;
1197             hdr_sctp_src   = strtol(optarg, &p, 10);
1198             if (p == optarg || (*p != ',' && *p != '\0')) {
1199                 fprintf(stderr, "Bad src port for '-%c'\n", c);
1200                 usage();
1201             }
1202             if (*p == '\0') {
1203                 fprintf(stderr, "No dest port specified for '-%c'\n", c);
1204                 usage();
1205             }
1206             p++;
1207             optarg = p;
1208             hdr_sctp_dest = strtol(optarg, &p, 10);
1209             if (p == optarg || (*p != ',' && *p != '\0')) {
1210                 fprintf(stderr, "Bad dest port for '-s'\n");
1211                 usage();
1212             }
1213             if (*p == '\0') {
1214                 fprintf(stderr, "No tag specified for '-%c'\n", c);
1215                 usage();
1216             }
1217             p++;
1218             optarg = p;
1219             hdr_sctp_tag = strtol(optarg, &p, 10);
1220             if (p == optarg || *p != '\0') {
1221                 fprintf(stderr, "Bad tag for '-%c'\n", c);
1222                 usage();
1223             }
1224
1225             hdr_ip = TRUE;
1226             hdr_ip_proto = 132;
1227             hdr_ethernet = TRUE;
1228             hdr_ethernet_proto = 0x800;
1229             break;
1230         case 'S':
1231             hdr_sctp       = TRUE;
1232             hdr_data_chunk = TRUE;
1233             hdr_sctp_src   = strtol(optarg, &p, 10);
1234             if (p == optarg || (*p != ',' && *p != '\0')) {
1235                 fprintf(stderr, "Bad src port for '-%c'\n", c);
1236                 usage();
1237             }
1238             if (*p == '\0') {
1239                 fprintf(stderr, "No dest port specified for '-%c'\n", c);
1240                 usage();
1241             }
1242             p++;
1243             optarg = p;
1244             hdr_sctp_dest = strtol(optarg, &p, 10);
1245             if (p == optarg || (*p != ',' && *p != '\0')) {
1246                 fprintf(stderr, "Bad dest port for '-s'\n");
1247                 usage();
1248             }
1249             if (*p == '\0') {
1250                 fprintf(stderr, "No ppi specified for '-%c'\n", c);
1251                 usage();
1252             }
1253             p++;
1254             optarg = p;
1255             hdr_data_chunk_ppid = strtoul(optarg, &p, 10);
1256             if (p == optarg || *p != '\0') {
1257                 fprintf(stderr, "Bad ppi for '-%c'\n", c);
1258                 usage();
1259             }
1260
1261             hdr_ip = TRUE;
1262             hdr_ip_proto = 132;
1263             hdr_ethernet = TRUE;
1264             hdr_ethernet_proto = 0x800;
1265             break;
1266
1267         case 't':
1268             ts_fmt = optarg;
1269             break;
1270
1271         case 'u':
1272             hdr_udp = TRUE;
1273             hdr_tcp = FALSE;
1274             hdr_src_port = strtol(optarg, &p, 10);
1275             if (p == optarg || (*p != ',' && *p != '\0')) {
1276                 fprintf(stderr, "Bad src port for '-u'\n");
1277                 usage();
1278             }
1279             if (*p == '\0') {
1280                 fprintf(stderr, "No dest port specified for '-u'\n");
1281                 usage();
1282             }
1283             p++;
1284             optarg = p;
1285             hdr_dest_port = strtol(optarg, &p, 10);
1286             if (p == optarg || *p != '\0') {
1287                 fprintf(stderr, "Bad dest port for '-u'\n");
1288                 usage();
1289             }
1290             hdr_ip = TRUE;
1291             hdr_ip_proto = 17;
1292             hdr_ethernet = TRUE;
1293             hdr_ethernet_proto = 0x800;
1294             break;
1295
1296         case 'T':
1297             hdr_tcp = TRUE;
1298             hdr_udp = FALSE;
1299             hdr_src_port = strtol(optarg, &p, 10);
1300             if (p == optarg || (*p != ',' && *p != '\0')) {
1301                 fprintf(stderr, "Bad src port for '-T'\n");
1302                 usage();
1303             }
1304             if (*p == '\0') {
1305                 fprintf(stderr, "No dest port specified for '-u'\n");
1306                 usage();
1307             }
1308             p++;
1309             optarg = p;
1310             hdr_dest_port = strtol(optarg, &p, 10);
1311             if (p == optarg || *p != '\0') {
1312                 fprintf(stderr, "Bad dest port for '-T'\n");
1313                 usage();
1314             }
1315             hdr_ip = TRUE;
1316             hdr_ip_proto = 6;
1317             hdr_ethernet = TRUE;
1318             hdr_ethernet_proto = 0x800;
1319             break;
1320
1321         default:
1322             usage();
1323         }
1324     }
1325
1326     if (optind >= argc || argc-optind < 2) {
1327         fprintf(stderr, "Must specify input and output filename\n");
1328         usage();
1329     }
1330
1331     if (strcmp(argv[optind], "-")) {
1332         input_filename = g_strdup(argv[optind]);
1333         input_file = ws_fopen(input_filename, "rb");
1334         if (!input_file) {
1335             fprintf(stderr, "Cannot open file [%s] for reading: %s\n",
1336                     input_filename, g_strerror(errno));
1337             exit(-1);
1338         }
1339     } else {
1340         input_filename = "Standard input";
1341         input_file = stdin;
1342     }
1343
1344     if (strcmp(argv[optind+1], "-")) {
1345         output_filename = g_strdup(argv[optind+1]);
1346         output_file = ws_fopen(output_filename, "wb");
1347         if (!output_file) {
1348             fprintf(stderr, "Cannot open file [%s] for writing: %s\n",
1349                     output_filename, g_strerror(errno));
1350             exit(-1);
1351         }
1352     } else {
1353         output_filename = "Standard output";
1354         output_file = stdout;
1355     }
1356
1357     /* Some validation */
1358     if (pcap_link_type != 1 && hdr_ethernet) {
1359         fprintf(stderr, "Dummy headers (-e, -i, -u, -s, -S -T) cannot be specified with link type override (-l)\n");
1360         exit(-1);
1361     }
1362
1363     /* Set up our variables */
1364     if (!input_file) {
1365         input_file = stdin;
1366         input_filename = "Standard input";
1367     }
1368     if (!output_file) {
1369         output_file = stdout;
1370         output_filename = "Standard output";
1371     }
1372
1373     ts_sec = time(0);           /* initialize to current time */
1374     timecode_default = *localtime(&ts_sec);
1375     timecode_default.tm_isdst = -1;     /* Unknown for now, depends on time given to the strptime() function */
1376
1377     /* Display summary of our state */
1378     if (!quiet) {
1379         fprintf(stderr, "Input from: %s\n", input_filename);
1380         fprintf(stderr, "Output to: %s\n", output_filename);
1381
1382         if (hdr_ethernet) fprintf(stderr, "Generate dummy Ethernet header: Protocol: 0x%0lX\n",
1383                                   hdr_ethernet_proto);
1384         if (hdr_ip) fprintf(stderr, "Generate dummy IP header: Protocol: %ld\n",
1385                             hdr_ip_proto);
1386         if (hdr_udp) fprintf(stderr, "Generate dummy UDP header: Source port: %ld. Dest port: %ld\n",
1387                              hdr_src_port, hdr_dest_port);
1388         if (hdr_tcp) fprintf(stderr, "Generate dummy TCP header: Source port: %ld. Dest port: %ld\n",
1389                              hdr_src_port, hdr_dest_port);
1390         if (hdr_sctp) fprintf(stderr, "Generate dummy SCTP header: Source port: %ld. Dest port: %ld. Tag: %ld\n",
1391                               hdr_sctp_src, hdr_sctp_dest, hdr_sctp_tag);
1392         if (hdr_data_chunk) fprintf(stderr, "Generate dummy DATA chunk header: TSN: %lu. SID: %d. SSN: %d. PPID: %lu\n",
1393                                     hdr_data_chunk_tsn, hdr_data_chunk_sid, hdr_data_chunk_ssn, hdr_data_chunk_ppid);
1394     }
1395 }
1396
1397 int
1398 main(int argc, char *argv[])
1399 {
1400     parse_options(argc, argv);
1401
1402     assert(input_file != NULL);
1403     assert(output_file != NULL);
1404
1405     write_file_header();
1406
1407     yyin = input_file;
1408     yylex();
1409
1410     write_current_packet();
1411     fclose(input_file);
1412     fclose(output_file);
1413     if (debug)
1414         fprintf(stderr, "\n-------------------------\n");
1415     if (!quiet) {
1416     fprintf(stderr, "Read %ld potential packet%s, wrote %ld packet%s\n",
1417             num_packets_read,    (num_packets_read==1)   ?"":"s",
1418             num_packets_written, (num_packets_written==1)?"":"s");
1419     }
1420     return 0;
1421 }