From Benjamin Roch:

This contains the source for dissecting TTEthernet packets (including Protocol Control Frames) conforming to our TTEthernet specification as dissector for Wireshark.

svn path=/trunk/; revision=26955

1 files changed, 216 insertions, 0 deletions

diff --git a/epan/dissectors/packet-tte.c b/epan/dissectors/packet-tte.c
new file mode 100644
index 0000000000..2c29a454a5
--- /dev/null
+++ b/epan/dissectors/packet-tte.c
@@ -0,0 +1,216 @@
+/* packet-tte.c
+ * Routines for Time Triggered Ethernet dissection
+ *
+ * Author: Valentin Ecker, valentin.ecker (AT) tttech.com
+ * TTTech Computertechnik AG, Austria.
+ * http://www.tttech.com/solutions/ttethernet/
+ *
+ * $Id$
+ *
+ * Wireshark - Network traffic analyzer
+ * By Gerald Combs <gerald@wireshark.org>
+ * Copyright 1998 Gerald Combs
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, 
+ * USA.
+ */
+
+#ifdef HAVE_CONFIG_H
+ #include "config.h"
+#endif
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <glib.h>
+
+#include <epan/packet.h>
+#include <epan/prefs.h>
+#include <epan/etypes.h>
+
+#include "packet-tte.h"
+
+
+/* Forward declaration we need below */
+void proto_reg_handoff_tte(void);
+
+/* Initialize the protocol and registered fields */
+static int proto_tte = -1;
+
+static int hf_tte_macdest = -1;
+static int hf_tte_macdest_cf1 = -1;
+static int hf_tte_macdest_ctid = -1;
+static int hf_tte_macsrc = -1;
+static int hf_tte_ethertype = -1;
+
+/* preference value pointers */
+static guint32    tte_pref_ct_marker    = 0xFFFFFFFF;
+static guint32    tte_pref_ct_mask      = 0x0;
+static dissector_table_t ethertype_dissector_table;
+
+/* Initialize the subtree pointers */
+static gint ett_tte = -1;
+static gint ett_tte_macdest = -1;
+static gint ett_tte_macsrc = -1;
+
+
+
+/* Code to actually dissect the packets */
+static int
+dissect_tte(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree)
+{
+    tvbuff_t* tvb_next;
+    int is_frame_pcf;
+
+    /* Set up structures needed to add the protocol subtree and manage it */
+    proto_item *tte_root_item, *tte_macdest_item, *tte_macsrc_item;
+    proto_tree *tte_tree, *tte_macdest_tree/*, *tte_macsrc_tree*/;
+
+    /* Check that there's enough data */
+    if (tvb_length(tvb) < TTE_HEADER_LENGTH)
+        return 0;
+
+    /* check if data of pcf frame */
+    is_frame_pcf = 
+       (tvb_get_ntohs(tvb, TTE_MAC_LENGTH * 2) == ETHERTYPE_TTE_PCF);
+
+    /* return if no valid cosntant field is found */
+    if (!is_frame_pcf)
+    {
+        if ( (tvb_get_ntohl(tvb, 0) & tte_pref_ct_mask) != tte_pref_ct_marker)
+            return 0;
+    }
+
+    /* Make entries in Protocol column and Info column on summary display */
+    if (check_col(pinfo->cinfo, COL_PROTOCOL))
+        col_set_str(pinfo->cinfo, COL_PROTOCOL, "TTE ");
+
+    if (check_col(pinfo->cinfo, COL_INFO))
+        col_set_str(pinfo->cinfo, COL_INFO, "Bogus TTEthernet Frame");
+
+    if (tree) {
+
+        /* create display subtree for the protocol */
+        tte_root_item = proto_tree_add_item(tree, proto_tte, tvb, 0,
+            TTE_HEADER_LENGTH, FALSE);
+
+        tte_tree = proto_item_add_subtree(tte_root_item, ett_tte);
+
+        tte_macdest_item = proto_tree_add_item(tte_tree,
+            hf_tte_macdest, tvb, 0, TTE_MAC_LENGTH, FALSE);
+
+        tte_macsrc_item = proto_tree_add_item(tte_tree,
+            hf_tte_macsrc, tvb, TTE_MAC_LENGTH, TTE_MAC_LENGTH, FALSE);
+
+        proto_tree_add_item(tte_tree,
+            hf_tte_ethertype, tvb, TTE_MAC_LENGTH*2, TTE_ETHERTYPE_LENGTH,
+            FALSE);
+
+        tte_macdest_tree = proto_item_add_subtree(tte_macdest_item,
+            ett_tte_macdest);
+
+        proto_tree_add_item(tte_macdest_tree,
+            hf_tte_macdest_cf1, tvb, 0, TTE_MACDEST_CF_LENGTH, FALSE);
+
+        proto_tree_add_item(tte_macdest_tree,
+            hf_tte_macdest_ctid, tvb, TTE_MACDEST_CF_LENGTH,
+            TTE_MACDEST_CTID_LENGTH, FALSE);
+    }
+
+    tvb_next = tvb_new_subset(tvb, TTE_HEADER_LENGTH, -1, -1);
+
+    /* prevent the Columns to be cleared...appending cannot be prevented */
+    col_set_fence(pinfo->cinfo, COL_PROTOCOL);
+
+    /* call std Ethernet dissector */
+    dissector_try_port(ethertype_dissector_table,
+        tvb_get_ntohs(tvb, TTE_MAC_LENGTH * 2), tvb_next, pinfo, tree);
+
+    return tvb_length(tvb);
+}
+
+
+void
+proto_register_tte(void)
+{
+    module_t *tte_module;
+
+    static hf_register_info hf[] = {
+
+        { &hf_tte_macdest,
+            { "Destination", "tte.macdest",
+            FT_ETHER, BASE_HEX, NULL, 0x0,
+            NULL, HFILL }
+        },
+        { &hf_tte_macdest_cf1,
+            { "Constant Field", "tte.cf1",
+            FT_UINT32, BASE_HEX, NULL, 0x0,
+            NULL, HFILL }
+        },
+        { &hf_tte_macdest_ctid,
+            { "Critical Traffic Identifier", "tte.ctid",
+            FT_UINT16, BASE_HEX, NULL, 0x0,
+            NULL, HFILL }
+        },
+        { &hf_tte_macsrc,
+            { "Source", "tte.macsrc",
+            FT_ETHER, BASE_HEX, NULL, 0x0,
+            NULL, HFILL }
+        },
+        { &hf_tte_ethertype,
+            { "Type", "tte.type",
+            FT_UINT16, BASE_HEX, VALS(etype_vals), 0x0,
+            NULL, HFILL }
+        }
+    };
+
+    /* Setup protocol subtree array */
+    static gint *ett[] = {
+        &ett_tte,
+        &ett_tte_macdest,
+        &ett_tte_macsrc
+    };
+
+    /* Register the protocol name and description */
+    proto_tte = proto_register_protocol("TTEthernet", "TTE", "tte");
+
+    /* Required function calls to register header fields and subtrees used */
+    proto_register_field_array(proto_tte, hf, array_length(hf));
+    proto_register_subtree_array(ett, array_length(ett));
+
+    /* Register preferences module */
+    tte_module = prefs_register_protocol(proto_tte, proto_reg_handoff_tte);
+
+    /* Register preferences */
+    prefs_register_uint_preference(tte_module, "ct_mask_value",
+        "CT Mask",
+        "Critical Traffic Mask (base hex)",
+        16, &tte_pref_ct_mask);
+
+    prefs_register_uint_preference(tte_module, "ct_marker_value",
+        "CT Marker",
+        "Critical Traffic Marker (base hex)",
+        16, &tte_pref_ct_marker);
+}
+
+
+void
+proto_reg_handoff_tte(void)
+{
+    heur_dissector_add("eth", dissect_tte, proto_tte);
+
+    /* find the ethertype dissector table */
+    ethertype_dissector_table = find_dissector_table("ethertype");
+}