packet-wcp.c

   1 /* packet-wcp.c
   2  * Routines for Wellfleet Compression frame disassembly
   3  * Copyright 2001, Jeffrey C. Foster <jfoste@woodward.com>
   4  *
   5  * $Id: packet-wcp.c,v 1.31 2003/01/31 03:17:47 guy Exp $
   6  *
   7  * Ethereal - Network traffic analyzer
   8  * By Gerald Combs <gerald@ethereal.com>
   9  * Copyright 1998
  10  *
  11  * This program is free software; you can redistribute it and/or
  12  * modify it under the terms of the GNU General Public License
  13  * as published by the Free Software Foundation; either version 2
  14  * of the License, or (at your option) any later version.
  15  *
  16  * This program is distributed in the hope that it will be useful,
  17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19  * GNU General Public License for more details.
  20  *
  21  * You should have received a copy of the GNU General Public License
  22  * along with this program; if not, write to the Free Software
  23  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
  24  *
  25  * ToDo:
  26  *      Add preference to allow/disallow decompression
  27  *      Calculate and verify check byte (last byte), if only we knew how!
  28  *      Handle Wellfleet compression over PPP links.
  29  *              - This will require changing the sub-dissector call
  30  *                routine to determine if layer 2 is frame relay or
  31  *                or PPP and different sub-dissector routines for each.
  32  *
  33  * Based upon information in the Nortel TCL based Pcaptap code.
  34  *http://www.mynetworkforum.com/tools/PCAPTAP/pcaptap-Win32-3.00.exe
  35  *
  36  * And lzss algorithm
  37  *http://www.rasip.fer.hr/research/compress/algorithms/fund/lz/lzss.html
  38  */
  39
  40 /*
  41  * Wellfleet compression is a variation on LZSS encoding.
  42  *
  43  * Compression is done by keeping a sliding window of previous
  44  * data transmited. The sender will use a pattern match to
  45  * encode repeated data as a data pointer field. Then a stream
  46  * of pointers and actual data bytes. The pointer values include
  47  * an offset to previous data in the stream and the length of the
  48  *  matching data.
  49  *
  50  * The data pattern matching is done on the octects.
  51  *
  52  * The data is encoded as 8 field blocks with a compression flag
  53  * byte at the beginning.  If the bit is set in the compression
  54  * flag, then that field has a compression field. If it isn't set
  55  * then the byte is raw data.
  56  *
  57  * The compression field is either 2 or 3 bytes long. The length
  58  * is determined by the length of the matching data, for short
  59  * matches the match length is encoded in the high nibble of the
  60  * first byte. Otherwise the third byte of the field contains
  61  * the match length.
  62  *
  63  * First byte -
  64  * lower 4 bits:
  65  *              High order nibble of the offset
  66  *
  67  * upper 4 bits:
  68  *              1   = length is in 3rd byte
  69  *              2-F = length of matching data - 1
  70  *
  71  * Second byte -
  72  *  Lower byte of the source offset.
  73  *
  74  * Third byte -
  75  *  Length of match - 1 if First byte upper nibble = 1, otherwise
  76  *  this byte isn't added to data stream.
  77  *
  78  * Example:
  79  *      Uncompressed data (hex):  11 22 22 22 22 33 44 55 66 77
  80  *
  81  *
  82  *      Compression data :
  83  *                      Flag bits:      0x20 (third field is compressed)
  84  *                      Data:   11 22 20 00 33 44 55
  85  *                              /  /  /  /
  86  *              raw data ------+--+  /  /
  87  *              (Comp length - 1)<<4+  /
  88  *              Data offset ----------+
  89  *
  90  *      Output data (hex):  20 11 22 20 00 33 44 55 66 77
  91  *
  92  * In this example the copy src is one byte behind the copy destination
  93  * so if appears as if output is being loaded with the source byte.
  94  *
  95  */
  96
  97
  98
  99 #ifdef HAVE_CONFIG_H
 100 # include "config.h"
 101 #endif
 102
 103 #include <stdio.h>
 104 #include <glib.h>
 105 #include <string.h>
 106 #include <epan/packet.h>
 107 #include "packet-frame.h"
 108 #include <epan/circuit.h>
 109 #include "etypes.h"
 110 #include "nlpid.h"
 111
 112 #define MAX_WIN_BUF_LEN 0x7fff          /* storage size for decompressed data */
 113 #define MAX_WCP_BUF_LEN 2048            /* storage size for decompressed data */
 114 #define FROM_DCE        0x80            /* for direction setting */
 115
 116 typedef struct {
 117
 118         guint8  *buf_cur;
 119         guint8  buffer[MAX_WIN_BUF_LEN];
 120
 121 }wcp_window_t;
 122
 123 typedef struct {
 124         wcp_window_t recv;
 125         wcp_window_t send;
 126 } wcp_circuit_data_t;
 127
 128 /*XXX do I really want the length in here  */
 129 typedef struct {
 130
 131         guint16  len;
 132         guint8  buffer[MAX_WCP_BUF_LEN];
 133
 134 }wcp_pdata_t;
 135
 136
 137 #define wcp_win_init_count 4
 138 #define wcp_packet_init_count 10
 139
 140 #define wcp_circuit_length (sizeof(wcp_circuit_data_t))
 141 #define wcp_packet_length (sizeof(wcp_pdata_t))
 142
 143 static GMemChunk *wcp_circuit = NULL;
 144 static GMemChunk *wcp_pdata = NULL;
 145
 146 static int proto_wcp = -1;
 147 static int hf_wcp_cmd = -1;
 148 static int hf_wcp_ext_cmd = -1;
 149 static int hf_wcp_seq = -1;
 150 static int hf_wcp_chksum = -1;
 151 static int hf_wcp_tid = -1;
 152 static int hf_wcp_rev = -1;
 153 static int hf_wcp_init = -1;
 154 static int hf_wcp_seq_size = -1;
 155 static int hf_wcp_alg = -1;
 156 static int hf_wcp_alg_cnt = -1;
 157 static int hf_wcp_alg_a = -1;
 158 static int hf_wcp_alg_b = -1;
 159 static int hf_wcp_alg_c = -1;
 160 static int hf_wcp_alg_d = -1;
 161 static int hf_wcp_rexmit = -1;
 162
 163 static int hf_wcp_hist_size = -1;
 164 static int hf_wcp_ppc = -1;
 165 static int hf_wcp_pib = -1;
 166
 167 static int hf_wcp_comp_bits = -1;
 168 static int hf_wcp_comp_marker = -1;
 169 static int hf_wcp_short_len = -1;
 170 static int hf_wcp_long_len = -1;
 171 static int hf_wcp_short_run = -1;
 172 static int hf_wcp_long_run = -1;
 173 static int hf_wcp_offset = -1;
 174
 175 static gint ett_wcp = -1;
 176 static gint ett_wcp_field = -1;
 177
 178 static dissector_handle_t fr_uncompressed_handle;
 179
 180 /*
 181  * Bits in the address field.
 182  */
 183 #define WCP_CMD                 0xf0    /* WCP Command */
 184 #define WCP_EXT_CMD             0x0f    /* WCP Extended Command */
 185 #define WCP_SEQ                 0x0fff  /* WCP Sequence number */
 186 #define WCP_OFFSET_MASK         0x0fff  /* WCP Pattern source offset */
 187
 188 #define PPC_COMPRESSED_IND              0x0
 189 #define PPC_UNCOMPRESSED_IND            0x1
 190 #define PPC_TPPC_COMPRESSED_IND         0x2
 191 #define PPC_TPPC_UNCOMPRESSED_IND       0x3
 192 #define CONNECT_REQ                     0x4
 193 #define CONNECT_ACK                     0x5
 194 #define CONNECT_NAK                     0x6
 195 #define DISCONNECT_REQ                  0x7
 196 #define DISCONNECT_ACK                  0x8
 197 #define INIT_REQ                        0x9
 198 #define INIT_ACK                        0xa
 199 #define RESET_REQ                       0xb
 200 #define RESET_ACK                       0xc
 201 #define REXMIT_NAK                      0xd
 202
 203
 204 static const value_string cmd_string[] = {
 205         {0, "Compressed Data"},
 206         {1, "Uncompressed Data"},
 207         {15, "Extended"},
 208         { 0,       NULL }
 209         };
 210
 211 static const value_string ext_cmd_string[] = {
 212         {0, "Per Packet Compression"},
 213         {4, "Connect Req"},
 214         {5, "Connect Ack"},
 215         {9, "Init Req"},
 216         {0x0a, "Init Ack"},
 217
 218         { 0,       NULL }
 219         };
 220
 221
 222
 223 static tvbuff_t *wcp_uncompress( tvbuff_t *src_tvb, int offset, packet_info *pinfo, proto_tree *tree);
 224 static wcp_window_t *get_wcp_window_ptr( packet_info *pinfo);
 225
 226 static void
 227 dissect_wcp_con_req(tvbuff_t *tvb, int offset, proto_tree *tree) {
 228
 229 /* WCP connector request message */
 230
 231         guint alg_cnt = tvb_get_guint8(tvb, 5);
 232
 233         proto_tree_add_uint(tree, hf_wcp_tid, tvb, offset, 2, tvb_get_ntohs(tvb, offset));
 234         proto_tree_add_uint(tree, hf_wcp_rev, tvb, offset + 2, 1, tvb_get_guint8(tvb, offset + 2));
 235         proto_tree_add_uint(tree, hf_wcp_init, tvb, offset + 3, 1, tvb_get_guint8(tvb, offset + 3));
 236         proto_tree_add_uint(tree, hf_wcp_seq_size, tvb, offset + 4, 1, tvb_get_guint8(tvb, offset + 4));
 237         proto_tree_add_uint(tree, hf_wcp_alg_cnt, tvb, offset + 5, 1, alg_cnt);
 238         proto_tree_add_uint(tree, hf_wcp_alg_a, tvb, offset + 6, 1, tvb_get_guint8(tvb, offset + 6));
 239         if ( alg_cnt > 1)
 240                 proto_tree_add_uint(tree, hf_wcp_alg_b, tvb, offset + 7, 1, tvb_get_guint8(tvb, offset + 7));
 241         if ( alg_cnt > 2)
 242                 proto_tree_add_uint(tree, hf_wcp_alg_c, tvb, offset + 8, 1, tvb_get_guint8(tvb, offset + 8));
 243         if ( alg_cnt > 3)
 244                 proto_tree_add_uint(tree, hf_wcp_alg_d, tvb, offset + 9, 1, tvb_get_guint8(tvb, offset + 9));
 245 }
 246
 247 static void
 248 dissect_wcp_con_ack( tvbuff_t *tvb, int offset, proto_tree *tree){
 249
 250 /* WCP connector ack message */
 251
 252         proto_tree_add_uint(tree, hf_wcp_tid, tvb, offset, 2, tvb_get_ntohs(tvb, offset));
 253         proto_tree_add_uint(tree, hf_wcp_rev, tvb, offset + 2, 1, tvb_get_guint8(tvb, offset + 2));
 254         proto_tree_add_uint(tree, hf_wcp_seq_size, tvb, offset + 3, 1, tvb_get_guint8(tvb, offset + 3));
 255         proto_tree_add_uint(tree, hf_wcp_alg, tvb, offset + 4, 1, tvb_get_guint8(tvb, offset + 4));
 256 }
 257
 258 static void
 259 dissect_wcp_init( tvbuff_t *tvb, int offset, proto_tree *tree){
 260
 261 /* WCP Initiate Request/Ack message */
 262
 263         proto_tree_add_uint(tree, hf_wcp_tid, tvb, offset, 2, tvb_get_ntohs(tvb, offset));
 264         proto_tree_add_uint(tree, hf_wcp_rev, tvb, offset + 2, 1, tvb_get_guint8(tvb, offset + 2));
 265         proto_tree_add_uint(tree, hf_wcp_hist_size, tvb, offset + 3, 1, tvb_get_guint8(tvb, offset + 3));
 266         proto_tree_add_uint(tree, hf_wcp_ppc, tvb, offset + 4, 1, tvb_get_guint8(tvb, offset + 4));
 267         proto_tree_add_uint(tree, hf_wcp_pib, tvb, offset + 5, 1, tvb_get_guint8(tvb, offset + 5));
 268 }
 269
 270
 271 static void
 272 dissect_wcp_reset( tvbuff_t *tvb, int offset, proto_tree *tree){
 273
 274 /* Process WCP Reset Request/Ack message */
 275
 276         proto_tree_add_uint(tree, hf_wcp_tid, tvb, offset, 2, tvb_get_ntohs(tvb, offset));
 277 }
 278
 279
 280 static void wcp_save_data( tvbuff_t *tvb, packet_info *pinfo){
 281
 282         wcp_window_t *buf_ptr = 0;
 283         int len;
 284
 285         /* discard first 2 bytes, header and last byte (check byte) */
 286         len = tvb_reported_length( tvb)-3;
 287         buf_ptr = get_wcp_window_ptr( pinfo);
 288
 289         if (( buf_ptr->buf_cur + len) <= (buf_ptr->buffer + MAX_WIN_BUF_LEN)){
 290                 tvb_memcpy( tvb, buf_ptr->buf_cur, 2, len);
 291                 buf_ptr->buf_cur = buf_ptr->buf_cur + len;
 292
 293         } else {
 294                 guint8 *buf_end = buf_ptr->buffer + MAX_WIN_BUF_LEN;
 295                 tvb_memcpy( tvb, buf_ptr->buf_cur, 2, buf_end - buf_ptr->buf_cur);
 296                 tvb_memcpy( tvb, buf_ptr->buffer, buf_end - buf_ptr->buf_cur-2,
 297                         len - (int)(buf_end - buf_ptr->buf_cur));
 298                 buf_ptr->buf_cur = buf_ptr->buf_cur + len - MAX_WIN_BUF_LEN;
 299         }
 300
 301 }
 302
 303
 304 static void dissect_wcp( tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree) {
 305
 306         proto_tree      *wcp_tree;
 307         proto_item      *ti;
 308         int             wcp_header_len;
 309         guint16         temp, cmd, ext_cmd, seq;
 310         tvbuff_t        *next_tvb;
 311
 312         if (check_col(pinfo->cinfo, COL_PROTOCOL))
 313                 col_set_str(pinfo->cinfo, COL_PROTOCOL, "WCP");
 314         if (check_col(pinfo->cinfo, COL_INFO))
 315                 col_clear(pinfo->cinfo, COL_INFO);
 316
 317         temp =tvb_get_ntohs(tvb, 0);
 318
 319         cmd = (temp & 0xf000) >> 12;
 320         ext_cmd = (temp & 0x0f00) >> 8;
 321
 322         if ( cmd == 0xf)
 323                 wcp_header_len= 1;
 324         else
 325                 wcp_header_len= 2;
 326
 327         seq = temp & 0x0fff;
 328
 329 /*XXX should test seq to be sure it the last + 1 !! */
 330
 331         if (check_col(pinfo->cinfo, COL_INFO)){
 332                 col_add_str(pinfo->cinfo, COL_INFO, val_to_str(cmd, cmd_string, "Unknown"));
 333                 if ( cmd == 0xf)
 334                         col_append_fstr(pinfo->cinfo, COL_INFO, ", %s",
 335                                 val_to_str(ext_cmd, ext_cmd_string, "Unknown"));
 336         }
 337
 338         if (tree) {
 339                 ti = proto_tree_add_item(tree, proto_wcp, tvb, 0, wcp_header_len, FALSE);
 340
 341                 wcp_tree = proto_item_add_subtree(ti, ett_wcp);
 342
 343                 proto_tree_add_uint(wcp_tree, hf_wcp_cmd, tvb, 0, 1, tvb_get_guint8( tvb, 0));
 344                 if ( cmd == 0xf){
 345                         proto_tree_add_uint(wcp_tree, hf_wcp_ext_cmd, tvb, 1, 1,
 346                                         tvb_get_guint8( tvb, 0));
 347                         switch (ext_cmd){
 348                         case CONNECT_REQ:
 349                                 dissect_wcp_con_req( tvb, 1, wcp_tree);
 350                                 break;
 351
 352                         case CONNECT_ACK:
 353                                 dissect_wcp_con_ack( tvb, 1, wcp_tree);
 354                                 break;
 355                         case INIT_REQ:
 356                         case INIT_ACK:
 357                                 dissect_wcp_init( tvb, 1, wcp_tree);
 358                                 break;
 359                         case RESET_REQ:
 360                         case RESET_ACK:
 361                                 dissect_wcp_reset( tvb, 1, wcp_tree);
 362                                 break;
 363                         default:
 364                                 break;
 365                         }
 366                 }else {
 367                         proto_tree_add_uint(wcp_tree, hf_wcp_seq,  tvb, 0, 2, seq);
 368                 }
 369         }
 370         else {
 371                 wcp_tree = NULL;
 372         }
 373
 374
 375                                         /* exit if done */
 376         if ( cmd != 1 && cmd != 0 && !(cmd == 0xf && ext_cmd == 0))
 377                 return;
 378
 379         if ( cmd == 1) {                /* uncompressed data */
 380                 if ( !pinfo->fd->flags.visited){        /* if first pass */
 381                         wcp_save_data( tvb, pinfo);
 382                 }
 383                 next_tvb = tvb_new_subset(tvb, wcp_header_len, -1, -1);
 384         }
 385         else {          /* cmd == 0 || (cmd == 0xf && ext_cmd == 0) */
 386
 387                 next_tvb = wcp_uncompress( tvb, wcp_header_len, pinfo, wcp_tree);
 388
 389                 if ( !next_tvb){
 390                         proto_tree_add_protocol_format(tree, proto_malformed, tvb, 0, 0,
 391                                         "[Malformed Frame: Bad WCP compressed data]" );
 392                         return;
 393                 }
 394         }
 395
 396         if ( tree)                      /* add the check byte */
 397                 proto_tree_add_uint(wcp_tree, hf_wcp_chksum, tvb,
 398                         tvb_reported_length( tvb)-1, 1,
 399                         tvb_get_guint8( tvb, tvb_reported_length(tvb)-1));
 400
 401         call_dissector(fr_uncompressed_handle, next_tvb, pinfo, tree);
 402
 403         return;
 404 }
 405
 406
 407 static guint8 *decompressed_entry( guint8 *src, guint8 *dst, int *len, guint8 * buf_start, guint8 *buf_end){
 408
 409 /* do the decompression for one field */
 410
 411         guint16 data_offset, data_cnt;
 412         guint8 tmp = *src;
 413
 414         data_offset = (*(src++) & 0xf) << 8;    /* get high byte */
 415         data_offset += *(src++);                /* add next byte */
 416
 417         if (( tmp & 0xf0) == 0x10){             /* 2 byte count */
 418                 data_cnt = *src;
 419                 data_cnt++;
 420
 421         }else {                                 /* one byte count */
 422                 data_cnt = tmp >> 4;
 423                 data_cnt++;
 424         }
 425
 426
 427         src = (dst - 1 - data_offset);
 428         if ( src < buf_start)
 429                 src += MAX_WIN_BUF_LEN;
 430
 431
 432 /*XXX could do some fancy memory moves, later if speed is problem */
 433
 434         while( data_cnt--){
 435                 *dst = *src;
 436                 if ( ++(*len) >MAX_WCP_BUF_LEN){
 437                         printf("decomp failed, len = %d\n",  *len);
 438
 439                         return NULL;    /* end of buffer error */
 440                 }
 441                 if ( dst++ == buf_end)
 442                         dst = buf_start;
 443                 if ( src++ == buf_end)
 444                         src = buf_start;
 445
 446         }
 447         return dst;
 448 }
 449
 450
 451 static
 452 wcp_window_t *get_wcp_window_ptr( packet_info *pinfo){
 453
 454 /* find the circuit for this DLCI, create one if needed */
 455 /* and return the wcp_window data structure pointer */
 456 /* for the direction of this packet */
 457
 458         circuit_t *circuit;
 459         wcp_circuit_data_t *wcp_circuit_data;
 460
 461         circuit = find_circuit( pinfo->ctype, pinfo->circuit_id,
 462             pinfo->fd->num);
 463         if ( !circuit){
 464                 circuit = circuit_new( pinfo->ctype, pinfo->circuit_id,
 465                     pinfo->fd->num);
 466         }
 467         wcp_circuit_data = circuit_get_proto_data(circuit, proto_wcp);
 468         if ( !wcp_circuit_data){
 469                 wcp_circuit_data = g_mem_chunk_alloc( wcp_circuit);
 470                 wcp_circuit_data->recv.buf_cur = wcp_circuit_data->recv.buffer;
 471                 wcp_circuit_data->send.buf_cur = wcp_circuit_data->send.buffer;
 472                 circuit_add_proto_data(circuit, proto_wcp, wcp_circuit_data);
 473         }
 474         if (pinfo->pseudo_header->x25.flags & FROM_DCE)
 475                 return &wcp_circuit_data->recv;
 476         else
 477                 return &wcp_circuit_data->send;
 478 }
 479
 480
 481 static tvbuff_t *wcp_uncompress( tvbuff_t *src_tvb, int offset, packet_info *pinfo, proto_tree *tree) {
 482
 483 /* do the packet data uncompression and load it into the dst buffer */
 484
 485         proto_tree      *sub_tree;
 486         proto_item      *ti;
 487
 488         int len=0, i = -1;
 489         int cnt = tvb_reported_length( src_tvb)-1;      /* don't include check byte */
 490
 491         guint8 *buf = 0, *dst, *src, *buf_start, *buf_end,  *tmp, comp_flag_bits = 0;
 492         guint8 src_buf[ MAX_WCP_BUF_LEN];
 493         tvbuff_t *volatile tvb = 0;
 494         wcp_window_t *buf_ptr = 0;
 495         wcp_pdata_t *volatile pdata_ptr;
 496
 497         buf_ptr = get_wcp_window_ptr( pinfo);
 498
 499         buf_start = buf_ptr->buffer;
 500         buf_end = buf_start + MAX_WIN_BUF_LEN;
 501         tmp = buf_ptr->buf_cur;
 502
 503         if (cnt - offset > MAX_WCP_BUF_LEN) {
 504                 if (tree)
 505                         proto_tree_add_text( tree, src_tvb, offset, -1,
 506                                 "Compressed data exceeds maximum buffer length (%d > %d)",
 507                                 cnt - offset, MAX_WCP_BUF_LEN);
 508                 return NULL;
 509         }
 510
 511         src = tvb_memcpy(src_tvb, src_buf, offset, cnt - offset);
 512         dst = buf_ptr->buf_cur;
 513
 514         while( offset++ < cnt){
 515
 516                 if ( --i >= 0){
 517                         if ( comp_flag_bits & 0x80){    /* if this is a compressed entry */
 518
 519                                 if ( !pinfo->fd->flags.visited){        /* if first pass */
 520                                         dst = decompressed_entry( src, dst, &len, buf_start, buf_end);
 521                                 }
 522                                 if ((*src & 0xf0) == 0x10){
 523                                         if ( tree) {
 524                                                 ti = proto_tree_add_item( tree, hf_wcp_long_run, src_tvb,
 525                                                          offset-1, 3, 0);
 526                                                 sub_tree = proto_item_add_subtree(ti, ett_wcp_field);
 527                                                 proto_tree_add_uint(sub_tree, hf_wcp_offset, src_tvb,
 528                                                          offset-1, 2, pntohs(src));
 529
 530                                                 proto_tree_add_item( sub_tree, hf_wcp_long_len, src_tvb,
 531                                                          offset+1, 1, pntohs(src));
 532                                         }
 533                                         src += 3;
 534                                         offset += 2;
 535                                 }else{
 536                                         if ( tree) {
 537                                                 ti = proto_tree_add_item( tree, hf_wcp_short_run, src_tvb,
 538                                                          offset - 1, 2, *src);
 539                                                 sub_tree = proto_item_add_subtree(ti, ett_wcp_field);
 540                                                 proto_tree_add_item( sub_tree, hf_wcp_short_len, src_tvb,
 541                                                          offset-1, 1, *src);
 542                                                 proto_tree_add_uint(sub_tree, hf_wcp_offset, src_tvb,
 543                                                          offset-1, 2, pntohs(src));
 544                                         }
 545                                         src += 2;
 546                                         offset += 1;
 547                                 }
 548                         }else {
 549                                 if ( !pinfo->fd->flags.visited){        /* if first pass */
 550                                         *dst = *src;
 551                                         if ( dst++ == buf_end)
 552                                                 dst = buf_start;
 553                                 }
 554                                 ++src;
 555                                 ++len;
 556
 557                         }
 558
 559                         if ( len >MAX_WCP_BUF_LEN){
 560                                 return NULL;
 561                         }
 562
 563                         comp_flag_bits <<= 1;
 564
 565                 }else { /* compressed data flag */
 566
 567                         comp_flag_bits = *src++;
 568                         if (tree)
 569                                 proto_tree_add_uint( tree, hf_wcp_comp_bits,  src_tvb, offset-1, 1,
 570                                         comp_flag_bits);
 571
 572                         i = 8;
 573                 }
 574         }
 575
 576         if ( pinfo->fd->flags.visited){ /* if not first pass */
 577                                         /* get uncompressed data */
 578                 pdata_ptr = p_get_proto_data( pinfo->fd, proto_wcp);
 579
 580                 if ( !pdata_ptr)        /* exit if no data */
 581                         return NULL;
 582                 len = pdata_ptr->len;
 583         } else {
 584
 585         /* save the new data as per packet data */
 586                 pdata_ptr = g_mem_chunk_alloc( wcp_pdata);
 587                 memcpy( &pdata_ptr->buffer, buf_ptr->buf_cur,  len);
 588                 pdata_ptr->len = len;
 589
 590                 p_add_proto_data( pinfo->fd, proto_wcp, (void*)pdata_ptr);
 591
 592                 buf_ptr->buf_cur = dst;
 593         }
 594
 595
 596         TRY {
 597                 tvb = tvb_new_real_data( pdata_ptr->buffer, pdata_ptr->len, pdata_ptr->len);
 598
 599         }
 600         CATCH(BoundsError) {
 601                 g_assert_not_reached();
 602                 g_free(buf);
 603                 return NULL;
 604         }
 605         CATCH(ReportedBoundsError) {
 606                 g_free(buf);
 607                 return NULL;
 608         }
 609         ENDTRY;
 610
 611         /* link new tvbuff into tvbuff chain so cleanup is done later */
 612         tvb_set_child_real_data_tvbuff( src_tvb, tvb);
 613
 614         /* Add new data to the data source list */
 615         add_new_data_source( pinfo, tvb, "Uncompressed WCP");
 616         return tvb;
 617
 618 }
 619
 620
 621 static void wcp_reinit( void){
 622
 623 /* Do the cleanup work when a new pass through the packet list is       */
 624 /* performed. re-initialize the  memory chunks.                         */
 625
 626         if (wcp_circuit)
 627                 g_mem_chunk_destroy(wcp_circuit);
 628
 629         wcp_circuit = g_mem_chunk_new("wcp_circuit", wcp_circuit_length,
 630                 wcp_win_init_count * wcp_circuit_length,
 631                 G_ALLOC_AND_FREE);
 632
 633         if (wcp_pdata)
 634                 g_mem_chunk_destroy(wcp_pdata);
 635
 636         wcp_pdata = g_mem_chunk_new("wcp_pdata", wcp_packet_length,
 637                 wcp_packet_init_count * wcp_packet_length,
 638                 G_ALLOC_AND_FREE);
 639
 640 }
 641
 642
 643 void
 644 proto_register_wcp(void)
 645 {
 646     static hf_register_info hf[] = {
 647         { &hf_wcp_cmd,
 648           { "Command", "wcp.cmd", FT_UINT8, BASE_HEX, VALS(cmd_string), WCP_CMD,
 649                 "Compression Command", HFILL }},
 650         { &hf_wcp_ext_cmd,
 651           { "Extended Command", "wcp.ext_cmd", FT_UINT8, BASE_HEX, VALS(ext_cmd_string), WCP_EXT_CMD,
 652                 "Extended Compression Command", HFILL }},
 653         { &hf_wcp_seq,
 654           { "SEQ", "wcp.seq", FT_UINT16, BASE_HEX, NULL, WCP_SEQ,
 655                 "Sequence Number", HFILL }},
 656         { &hf_wcp_chksum,
 657           { "Checksum", "wcp.checksum", FT_UINT8, BASE_DEC, NULL, 0,
 658                 "Packet Checksum", HFILL }},
 659         { &hf_wcp_tid,
 660           { "TID", "wcp.tid", FT_UINT16, BASE_DEC, NULL, 0,
 661                 "TID", HFILL }},
 662         { &hf_wcp_rev,
 663           { "Revision", "wcp.rev", FT_UINT8, BASE_DEC, NULL, 0,
 664                 "Revision", HFILL }},
 665         { &hf_wcp_init,
 666           { "Initiator", "wcp.init", FT_UINT8, BASE_DEC, NULL, 0,
 667                 "Initiator", HFILL }},
 668         { &hf_wcp_seq_size,
 669           { "Seq Size", "wcp.seq_size", FT_UINT8, BASE_DEC, NULL, 0,
 670                 "Sequence Size", HFILL }},
 671         { &hf_wcp_alg_cnt,
 672           { "Alg Count", "wcp.alg_cnt", FT_UINT8, BASE_DEC, NULL, 0,
 673                 "Algorithm Count", HFILL }},
 674         { &hf_wcp_alg_a,
 675           { "Alg 1", "wcp.alg1", FT_UINT8, BASE_DEC, NULL, 0,
 676                 "Algorithm #1", HFILL }},
 677         { &hf_wcp_alg_b,
 678           { "Alg 2", "wcp.alg2", FT_UINT8, BASE_DEC, NULL, 0,
 679                 "Algorithm #2", HFILL }},
 680         { &hf_wcp_alg_c,
 681           { "Alg 3", "wcp.alg3", FT_UINT8, BASE_DEC, NULL, 0,
 682                 "Algorithm #3", HFILL }},
 683         { &hf_wcp_alg_d,
 684           { "Alg 4", "wcp.alg4", FT_UINT8, BASE_DEC, NULL, 0,
 685                 "Algorithm #4", HFILL }},
 686         { &hf_wcp_alg,
 687           { "Alg", "wcp.alg", FT_UINT8, BASE_DEC, NULL, 0,
 688                 "Algorithm", HFILL }},
 689         { &hf_wcp_rexmit,
 690           { "Rexmit", "wcp.rexmit", FT_UINT8, BASE_DEC, NULL, 0,
 691                 "Retransmit", HFILL }},
 692         { &hf_wcp_hist_size,
 693           { "History", "wcp.hist", FT_UINT8, BASE_DEC, NULL, 0,
 694                 "History Size", HFILL }},
 695         { &hf_wcp_ppc,
 696           { "PerPackComp", "wcp.ppc", FT_UINT8, BASE_DEC, NULL, 0,
 697                 "Per Packet Compression", HFILL }},
 698         { &hf_wcp_pib,
 699           { "PIB", "wcp.pib", FT_UINT8, BASE_DEC, NULL, 0,
 700                 "PIB", HFILL }},
 701         { &hf_wcp_comp_bits,
 702           { "Compress Flag", "wcp.flag", FT_UINT8, BASE_HEX, NULL, 0,
 703                 "Compressed byte flag", HFILL }},
 704         { &hf_wcp_comp_marker,
 705           { "Compress Marker", "wcp.mark", FT_UINT8, BASE_DEC, NULL, 0,
 706                 "Compressed marker", HFILL }},
 707         { &hf_wcp_offset,
 708           { "Source offset", "wcp.off", FT_UINT16, BASE_HEX, NULL, WCP_OFFSET_MASK,
 709                 "Data source offset", HFILL }},
 710         { &hf_wcp_short_len,
 711           { "Compress Length", "wcp.short_len", FT_UINT8, BASE_HEX, NULL, 0xf0,
 712                 "Compressed length", HFILL }},
 713         { &hf_wcp_long_len,
 714           { "Compress Length", "wcp.long_len", FT_UINT8, BASE_HEX, NULL, 0,
 715                 "Compressed length", HFILL }},
 716         { &hf_wcp_long_run,
 717           { "Long Compression", "wcp.long_comp", FT_UINT16, BASE_HEX, NULL, 0,
 718                 "Long Compression type", HFILL }},
 719         { &hf_wcp_short_run,
 720           { "Short Compression", "wcp.short_comp", FT_UINT8, BASE_HEX, NULL, 0,
 721                 "Short Compression type", HFILL }},
 722
 723    };
 724
 725
 726     static gint *ett[] = {
 727         &ett_wcp,
 728         &ett_wcp_field,
 729     };
 730
 731     proto_wcp = proto_register_protocol ("Wellfleet Compression", "WCP", "wcp");
 732     proto_register_field_array (proto_wcp, hf, array_length(hf));
 733     proto_register_subtree_array(ett, array_length(ett));
 734     register_init_routine(&wcp_reinit);
 735 }
 736
 737
 738 void
 739 proto_reg_handoff_wcp(void) {
 740     dissector_handle_t wcp_handle;
 741
 742     /*
 743      * Get handle for the Frame Relay (uncompressed) dissector.
 744      */
 745     fr_uncompressed_handle = find_dissector("fr_uncompressed");
 746
 747     wcp_handle = create_dissector_handle(dissect_wcp, proto_wcp);
 748     dissector_add("fr.ietf", NLPID_COMPRESSED, wcp_handle);
 749     dissector_add("ethertype",  ETHERTYPE_WCP, wcp_handle);
 750 }