osmith
/
wireshark
forked from osmocom/wireshark
1
0
Fork 0
Code Pull Requests Releases Wiki Activity
wireshark/epan/dissectors/packet-signal-pdu.c

2157 lines
77 KiB
C
Raw Blame History

/* packet-signal-pdu.c
* Signal PDU dissector.
* By Dr. Lars Voelker <lars.voelker@technica-engineering.de>
* Copyright 2020-2021 Dr. Lars Voelker
*
* Wireshark - Network traffic analyzer
* By Gerald Combs <gerald@wireshark.org>
* Copyright 1998 Gerald Combs
*
* SPDX-License-Identifier: GPL-2.0-or-later
*
* This dissector allows Signal PDUs (e.g. CAN or FlexRay) to be dissected into signals (automotive use case).
*
* This feature is based on typical operations of signal messages:
* - Scaling/Offset: Move the value by multiplying with scaler and moving by adding offset. (compu methods).
* - Multiplexer: A signal in the PDU determines, what signals follow.
* - Value names: Giving raw values names.
*/
#include <config.h>
#include <epan/packet.h>
#include <epan/prefs.h>
#include <epan/expert.h>
#include <epan/to_str.h>
#include <epan/uat.h>
#include "wsutil/sign_ext.h"
#include <packet-someip.h>
#include <packet-socketcan.h>
#include <packet-flexray.h>
#include <packet-pdu-transport.h>
#include <packet-lin.h>
#include <packet-autosar-ipdu-multiplexer.h>
/*
* Dissector for CAN, FlexRay, and other message payloads.
* This includes such PDUs being transported on top of TECMP,
* SOME/IP, and others.
*/
#define SPDU_NAME "Signal PDU"
#define SPDU_NAME_LONG "Signal PDU"
#define SPDU_NAME_FILTER "signal_pdu"
/*** Configuration ***/
/* Define the Signal PDUs and their IDs and Names. */
#define DATAFILE_SPDU_MESSAGES "Signal_PDU_identifiers"
/* Define how to parse Signal PDUs into Signals. */
#define DATAFILE_SPDU_SIGNALS "Signal_PDU_signal_list"
/* Define enumeration for signal values. */
#define DATAFILE_SPDU_VALUE_NAMES "Signal_PDU_signal_values"
/* Using the following config files the payloads of different protocols are mapped to Signal PDU IDs: */
#define DATAFILE_SPDU_SOMEIP_MAPPING "Signal_PDU_Binding_SOMEIP"
#define DATAFILE_SPDU_CAN_MAPPING "Signal_PDU_Binding_CAN"
#define DATAFILE_SPDU_FLEXRAY_MAPPING "Signal_PDU_Binding_FlexRay"
#define DATAFILE_SPDU_LIN_MAPPING "Signal_PDU_Binding_LIN"
#define DATAFILE_SPDU_PDU_TRANSPORT_MAPPING "Signal_PDU_Binding_PDU_Transport"
#define DATAFILE_SPDU_IPDUM_MAPPING "Signal_PDU_Binding_AUTOSAR_IPduM"
/* ID wireshark identifies the dissector by */
static int proto_signal_pdu = -1;
static dissector_handle_t signal_pdu_handle_someip = NULL;
static dissector_handle_t signal_pdu_handle_can = NULL;
static dissector_handle_t signal_pdu_handle_flexray = NULL;
static dissector_handle_t signal_pdu_handle_lin = NULL;
static dissector_handle_t signal_pdu_handle_pdu_transport = NULL;
static dissector_handle_t signal_pdu_handle_ipdum = NULL;
static int hf_payload_unparsed = -1;
static gint ett_spdu_payload = -1;
static gint ett_spdu_signal = -1;
static gboolean spdu_derserializer_activated = FALSE;
static gboolean spdu_derserializer_show_hidden = FALSE;
static gboolean spdu_derserializer_hide_raw_values = TRUE;
/*** expert info items ***/
static expert_field ef_spdu_payload_truncated = EI_INIT;
static expert_field ef_spdu_config_error = EI_INIT;
/*** Data Structure for UAT based config ***/
static GHashTable *data_spdu_messages = NULL;
static GHashTable *data_spdu_signal_list = NULL;
static GHashTable *data_spdu_signal_value_names = NULL;
static GHashTable *data_spdu_someip_mappings = NULL;
static GHashTable *data_spdu_can_mappings = NULL;
static GHashTable *data_spdu_flexray_mappings = NULL;
static GHashTable *data_spdu_lin_mappings = NULL;
static GHashTable *data_spdu_pdu_transport_mappings = NULL;
static GHashTable *data_spdu_ipdum_mappings = NULL;
static hf_register_info *dynamic_hf = NULL;
static guint dynamic_hf_size = 0;
/***********************************************
********* Preferences / Configuration *********
***********************************************/
typedef struct _generic_one_id_string {
guint id;
gchar *name;
} generic_one_id_string_t;
typedef enum _spdu_data_type {
SPDU_DATA_TYPE_NONE,
SPDU_DATA_TYPE_UINT,
SPDU_DATA_TYPE_INT,
} spdu_dt_t;
typedef struct _spdu_signal_item {
guint32 pos;
gchar *name;
spdu_dt_t data_type;
gboolean big_endian;
guint32 bitlength_base_type;
guint32 bitlength_encoded_type;
gboolean scale_or_offset;
double scaler;
double offset;
gboolean multiplexer;
gint multiplex_value_only;
gboolean hidden;
gint *hf_id_effective;
gint *hf_id_raw;
} spdu_signal_item_t;
typedef struct _spdu_signal_list {
guint32 id;
guint32 num_of_items;
spdu_signal_item_t *items;
} spdu_signal_list_t;
typedef struct _spdu_signal_list_uat {
guint32 id;
guint32 num_of_params;
guint32 pos;
gchar *name;
gchar *filter_string;
gchar *data_type;
gboolean big_endian;
guint32 bitlength_base_type;
guint32 bitlength_encoded_type;
gchar *scaler;
gchar *offset;
gboolean multiplexer;
gint multiplex_value_only;
gboolean hidden;
} spdu_signal_list_uat_t;
typedef struct _spdu_signal_value_name_item {
guint64 value_start;
guint64 value_end;
gchar *name;
} spdu_signal_value_name_item_t;
#define INIT_SIGNAL_VALUE_NAME_ITEM(NAME) \
(NAME)->value_start = 0; \
(NAME)->value_end = 0; \
(NAME)->name = NULL;
typedef struct _spdu_signal_value_name {
guint32 id;
guint32 num_of_items;
guint32 pos;
val64_string *vs;
spdu_signal_value_name_item_t *items;
} spdu_signal_value_name_t;
#define INIT_SIGNAL_VALUE_NAME(NAME) \
(NAME)->id = 0; \
(NAME)->pos = 0; \
(NAME)->num_of_items = 0; \
(NAME)->vs = NULL; \
(NAME)->items = NULL;
typedef struct _spdu_signal_value_name_uat {
guint32 id;
guint32 pos;
guint32 num_of_items;
guint64 value_start;
guint64 value_end;
gchar *value_name;
} spdu_signal_value_name_uat_t;
typedef struct _spdu_someip_mapping {
guint32 service_id;
guint32 method_id;
guint32 major_version;
guint32 message_type;
guint32 spdu_message_id;
} spdu_someip_mapping_t;
#define INIT_SOMEIP_MAPPING(NAME) \
(NAME)->service_id = 0; \
(NAME)->method_id = 0; \
(NAME)->major_version = 0; \
(NAME)->message_type = 0; \
(NAME)->message_id = 0;
typedef spdu_someip_mapping_t spdu_someip_mapping_uat_t;
typedef struct _spdu_can_mapping {
guint32 can_id;
guint32 bus_id;
guint32 message_id;
} spdu_can_mapping_t;
typedef spdu_can_mapping_t spdu_can_mapping_uat_t;
typedef struct _spdu_flexray_mapping {
guint32 channel;
guint32 cycle;
guint32 flexray_id;
guint32 message_id;
} spdu_flexray_mapping_t;
typedef spdu_flexray_mapping_t spdu_flexray_mapping_uat_t;
typedef struct _spdu_lin_mapping {
guint32 frame_id;
guint32 bus_id;
guint32 message_id;
} spdu_lin_mapping_t;
typedef spdu_lin_mapping_t spdu_lin_mapping_uat_t;
typedef struct _spdu_pdu_transport_mapping {
guint32 pdu_id;
guint32 message_id;
} spdu_pdu_transport_mapping_t;
typedef spdu_pdu_transport_mapping_t spdu_pdu_transport_mapping_uat_t;
typedef struct _spdu_ipdum_mapping {
guint32 pdu_id;
guint32 message_id;
} spdu_ipdum_mapping_t;
typedef spdu_ipdum_mapping_t spdu_ipdum_mapping_uat_t;
static generic_one_id_string_t *spdu_message_ident = NULL;
static guint spdu_message_ident_num = 0;
static spdu_signal_list_uat_t *spdu_signal_list = NULL;
static guint spdu_signal_list_num = 0;
static spdu_signal_value_name_uat_t *spdu_signal_value_names = NULL;
static guint spdu_parameter_value_names_num = 0;
static spdu_someip_mapping_t *spdu_someip_mapping = NULL;
static guint spdu_someip_mapping_num = 0;
static spdu_can_mapping_t *spdu_can_mapping = NULL;
static guint spdu_can_mapping_num = 0;
static spdu_flexray_mapping_t *spdu_flexray_mapping = NULL;
static guint spdu_flexray_mapping_num = 0;
static spdu_lin_mapping_t *spdu_lin_mapping = NULL;
static guint spdu_lin_mapping_num = 0;
static spdu_pdu_transport_mapping_t *spdu_pdu_transport_mapping = NULL;
static guint spdu_pdu_transport_mapping_num = 0;
static spdu_ipdum_mapping_t *spdu_ipdum_mapping = NULL;
static guint spdu_ipdum_mapping_num = 0;
void proto_register_signal_pdu(void);
void proto_reg_handoff_signal_pdu(void);
static void
register_signal_pdu_can(void) {
if (signal_pdu_handle_can == NULL) {
return;
}
dissector_delete_all("can.id", signal_pdu_handle_can);
dissector_delete_all("can.extended_id", signal_pdu_handle_can);
/* CAN: loop over all frame IDs in HT */
if (data_spdu_can_mappings != NULL) {
GList *keys = g_hash_table_get_keys(data_spdu_can_mappings);
GList *tmp;
for (tmp = keys; tmp != NULL; tmp = tmp->next) {
gint32 *id = ((gint32*)tmp->data);
*id &= CAN_EFF_MASK;
dissector_add_uint("can.extended_id", *id, signal_pdu_handle_can);
if (*id <= CAN_SFF_MASK) {
dissector_add_uint("can.id", *id, signal_pdu_handle_can);
}
}
g_list_free(keys);
}
}
static void
register_signal_pdu_lin(void) {
if (signal_pdu_handle_lin == NULL) {
return;
}
dissector_delete_all("lin.frame_id", signal_pdu_handle_lin);
/* LIN: loop over all frame IDs in HT */
if (data_spdu_lin_mappings != NULL) {
GList *keys = g_hash_table_get_keys(data_spdu_lin_mappings);
GList *tmp;
for (tmp = keys; tmp != NULL; tmp = tmp->next) {
gint32 *id = (gint32*)tmp->data;
/* we register the combination of bus and frame id */
dissector_add_uint("lin.frame_id", *id, signal_pdu_handle_lin);
}
g_list_free(keys);
}
}
static void
register_signal_pdu_someip(void) {
if (signal_pdu_handle_someip == NULL) {
return;
}
dissector_delete_all("someip.messageid", signal_pdu_handle_someip);
/* SOME/IP: loop over all messages IDs in HT */
if (data_spdu_someip_mappings != NULL) {
GList *keys = g_hash_table_get_keys(data_spdu_someip_mappings);
GList *tmp;
for (tmp = keys; tmp != NULL; tmp = tmp->next) {
gint64 *id = (gint64*)tmp->data;
guint32 message_id = (guint32)((guint64)(*id)) & 0xffffffff;
dissector_add_uint("someip.messageid", message_id, signal_pdu_handle_someip);
}
g_list_free(keys);
}
}
static void
register_signal_pdu_pdu_transport(void) {
if (signal_pdu_handle_pdu_transport == NULL) {
return;
}
dissector_delete_all("pdu_transport.id", signal_pdu_handle_pdu_transport);
/* PDU Transport: loop over all messages IDs in HT */
if (data_spdu_pdu_transport_mappings != NULL) {
GList *keys = g_hash_table_get_keys(data_spdu_pdu_transport_mappings);
GList *tmp;
for (tmp = keys; tmp != NULL; tmp = tmp->next) {
gint64 *id = (gint64*)tmp->data;
dissector_add_uint("pdu_transport.id", ((guint32)((guint64)(*id)) & 0xffffffff), signal_pdu_handle_pdu_transport);
}
g_list_free(keys);
}
}
static void
register_signal_pdu_ipdum_ids(void) {
if (signal_pdu_handle_ipdum == NULL) {
return;
}
dissector_delete_all("ipdum.pdu.id", signal_pdu_handle_ipdum);
/* IPduM: loop over all messages IDs in HT */
if (data_spdu_ipdum_mappings != NULL) {
GList *keys = g_hash_table_get_keys(data_spdu_ipdum_mappings);
GList *tmp;
for (tmp = keys; tmp != NULL; tmp = tmp->next) {
gint64 *id = (gint64*)tmp->data;
dissector_add_uint("ipdum.pdu.id", ((guint32)((guint64)(*id)) & 0xffffffff), signal_pdu_handle_ipdum);
}
g_list_free(keys);
}
}
/*** UAT Callbacks and Helpers ***/
static void
spdu_payload_free_key(gpointer key) {
wmem_free(wmem_epan_scope(), key);
}
static void
spdu_payload_free_generic_data(gpointer data _U_) {
/* currently nothing to be free */
}
/* ID -> Name */
static void *
copy_generic_one_id_string_cb(void *n, const void *o, size_t size _U_) {
generic_one_id_string_t *new_rec = (generic_one_id_string_t *)n;
const generic_one_id_string_t *old_rec = (const generic_one_id_string_t *)o;
if (old_rec->name == NULL) {
new_rec->name = NULL;
} else {
new_rec->name = g_strdup(old_rec->name);
}
new_rec->id = old_rec->id;
return new_rec;
}
static gboolean
update_generic_one_identifier_32bit(void *r, char **err) {
generic_one_id_string_t *rec = (generic_one_id_string_t *)r;
if (rec->id > 0xffffffff) {
*err = ws_strdup_printf("We currently only support 32 bit identifiers (ID: %i Name: %s)", rec->id, rec->name);
return FALSE;
}
if (rec->name == NULL || rec->name[0] == 0) {
*err = g_strdup("Name cannot be empty");
return FALSE;
}
guchar c = proto_check_field_name(rec->name);
if (c) {
if (c == '.') {
*err = ws_strdup_printf("Name contains illegal chars '.' (ID: 0x%08x)", rec->id);
} else if (g_ascii_isprint(c)) {
*err = ws_strdup_printf("Name contains illegal chars '%c' (ID: 0x%08x)", c, rec->id);
} else {
*err = ws_strdup_printf("Name contains invalid byte \\%03o (ID: 0x%08x)", c, rec->id);
}
return FALSE;
}
return TRUE;
}
static void
free_generic_one_id_string_cb(void *r) {
generic_one_id_string_t *rec = (generic_one_id_string_t *)r;
/* freeing result of g_strdup */
g_free(rec->name);
rec->name = NULL;
}
static void
post_update_one_id_string_template_cb(generic_one_id_string_t *data, guint data_num, GHashTable *ht) {
guint i;
for (i = 0; i < data_num; i++) {
int *key = wmem_new(wmem_epan_scope(), int);
*key = data[i].id;
g_hash_table_insert(ht, key, g_strdup(data[i].name));
}
}
/*** Signal PDU Messages ***/
UAT_HEX_CB_DEF (spdu_message_ident, id, generic_one_id_string_t)
UAT_CSTRING_CB_DEF (spdu_message_ident, name, generic_one_id_string_t)
static void
post_update_spdu_message_cb(void) {
/* destroy old hash table, if it exists */
if (data_spdu_messages) {
g_hash_table_destroy (data_spdu_messages);
data_spdu_messages = NULL;
}
/* create new hash table */
data_spdu_messages = g_hash_table_new_full(g_int_hash, g_int_equal, &spdu_payload_free_key, &spdu_payload_free_generic_data);
post_update_one_id_string_template_cb(spdu_message_ident, spdu_message_ident_num, data_spdu_messages);
}
static char*
get_message_name(guint32 id) {
guint32 tmp = id;
if (data_spdu_messages == NULL) {
return NULL;
}
return (char *)g_hash_table_lookup(data_spdu_messages, &tmp);
}
/* UAT: Signals */
UAT_HEX_CB_DEF(spdu_signal_list, id, spdu_signal_list_uat_t)
UAT_DEC_CB_DEF(spdu_signal_list, num_of_params, spdu_signal_list_uat_t)
UAT_DEC_CB_DEF(spdu_signal_list, pos, spdu_signal_list_uat_t)
UAT_CSTRING_CB_DEF(spdu_signal_list, name, spdu_signal_list_uat_t)
UAT_CSTRING_CB_DEF(spdu_signal_list, filter_string, spdu_signal_list_uat_t)
UAT_CSTRING_CB_DEF(spdu_signal_list, data_type, spdu_signal_list_uat_t)
UAT_BOOL_CB_DEF(spdu_signal_list, big_endian, spdu_signal_list_uat_t)
UAT_DEC_CB_DEF(spdu_signal_list, bitlength_base_type, spdu_signal_list_uat_t)
UAT_DEC_CB_DEF(spdu_signal_list, bitlength_encoded_type, spdu_signal_list_uat_t)
UAT_CSTRING_CB_DEF(spdu_signal_list, scaler, spdu_signal_list_uat_t)
UAT_CSTRING_CB_DEF(spdu_signal_list, offset, spdu_signal_list_uat_t)
UAT_BOOL_CB_DEF(spdu_signal_list, multiplexer, spdu_signal_list_uat_t)
UAT_SIGNED_DEC_CB_DEF(spdu_signal_list, multiplex_value_only, spdu_signal_list_uat_t)
UAT_BOOL_CB_DEF(spdu_signal_list, hidden, spdu_signal_list_uat_t)
static void *
copy_spdu_signal_list_cb(void *n, const void *o, size_t size _U_) {
spdu_signal_list_uat_t *new_rec = (spdu_signal_list_uat_t *)n;
const spdu_signal_list_uat_t *old_rec = (const spdu_signal_list_uat_t *)o;
new_rec->id = old_rec->id;
new_rec->num_of_params = old_rec->num_of_params;
new_rec->pos = old_rec->pos;
if (old_rec->name) {
new_rec->name = g_strdup(old_rec->name);
} else {
new_rec->name = NULL;
}
if (old_rec->filter_string) {
new_rec->filter_string = g_strdup(old_rec->filter_string);
} else {
new_rec->filter_string = NULL;
}
if (old_rec->data_type) {
new_rec->data_type = g_strdup(old_rec->data_type);
} else {
new_rec->data_type = NULL;
}
new_rec->big_endian = old_rec->big_endian;
new_rec->bitlength_base_type = old_rec->bitlength_base_type;
new_rec->bitlength_encoded_type = old_rec->bitlength_encoded_type;
if (old_rec->scaler) {
new_rec->scaler = g_strdup(old_rec->scaler);
} else {
new_rec->scaler = NULL;
}
if (old_rec->offset) {
new_rec->offset = g_strdup(old_rec->offset);
} else {
new_rec->offset = NULL;
}
new_rec->multiplexer = old_rec->multiplexer;
new_rec->multiplex_value_only = old_rec->multiplex_value_only;
new_rec->hidden = old_rec->hidden;
return new_rec;
}
static gboolean
update_spdu_signal_list(void *r, char **err) {
gchar *tmp;
guchar c;
gdouble d;
spdu_signal_list_uat_t *rec = (spdu_signal_list_uat_t *)r;
if (rec->pos >= 0xffff) {
*err = ws_strdup_printf("Position too big");
return FALSE;
}
if (rec->num_of_params >= 0xffff) {
*err = ws_strdup_printf("Number of Parameters too big");
return FALSE;
}
if (rec->pos >= rec->num_of_params) {
*err = ws_strdup_printf("Position >= Number of Parameters");
return FALSE;
}
if (rec->name == NULL || rec->name[0] == 0) {
*err = ws_strdup_printf("Name cannot be empty");
return FALSE;
}
if (rec->filter_string == NULL || rec->filter_string[0] == 0) {
*err = ws_strdup_printf("Filter String cannot be empty");
return FALSE;
}
c = proto_check_field_name(rec->filter_string);
if (c) {
if (c == '.') {
*err = ws_strdup_printf("Filter String contains illegal chars '.' (ID: 0x%08x)", rec->id);
} else if (g_ascii_isprint(c)) {
*err = ws_strdup_printf("Filter String contains illegal chars '%c' (ID: 0x%08x)", c, rec->id);
} else {
*err = ws_strdup_printf("Filter String contains invalid byte \\%03o (ID: 0x%08x)", c, rec->id);
}
return FALSE;
}
if (g_strcmp0(rec->data_type, "uint") != 0 && g_strcmp0(rec->data_type, "int") != 0) {
*err = ws_strdup_printf("Currently only uint and int supported!");
return FALSE;
}
if (g_strcmp0(rec->data_type, "int") == 0 && (rec->bitlength_base_type != rec->bitlength_encoded_type)) {
*err = ws_strdup_printf("signed ints (int) only support in non-shortened length");
return FALSE;
}
if (g_strcmp0(rec->data_type, "int") == 0 && (rec->bitlength_encoded_type != 8) && (rec->bitlength_encoded_type != 16) && (rec->bitlength_encoded_type != 32) && (rec->bitlength_encoded_type != 64)) {
*err = ws_strdup_printf("signed ints (int) are only supported in 8, 16, 32, or 64 bit.");
return FALSE;
}
d = g_ascii_strtod(rec->offset, &tmp);
if (!(d == d)) {
*err = ws_strdup_printf("Offset not a double!");
return FALSE;
}
d = g_ascii_strtod(rec->scaler, &tmp);
if (!(d == d)) {
*err = ws_strdup_printf("Scaler not a double!");
return FALSE;
}
return TRUE;
}
static void
free_spdu_signal_list_cb(void*r) {
spdu_signal_list_uat_t *rec = (spdu_signal_list_uat_t *)r;
if (rec->name) {
g_free(rec->name);
rec->name = NULL;
}
if (rec->filter_string) {
g_free(rec->filter_string);
rec->filter_string = NULL;
}
}
static void
deregister_user_data(void)
{
if (dynamic_hf) {
/* Unregister all fields */
for (guint i = 0; i < dynamic_hf_size; i++) {
proto_deregister_field(proto_signal_pdu, *(dynamic_hf[i].p_id));
g_free(dynamic_hf[i].p_id);
dynamic_hf[i].p_id = NULL;
/* workaround since the proto.c proto_free_field_strings seems to crash us... */
dynamic_hf[i].hfinfo.strings = NULL;
}
proto_add_deregistered_data(dynamic_hf);
dynamic_hf = NULL;
dynamic_hf_size = 0;
}
}
static spdu_signal_value_name_t* get_signal_value_name_config(guint32 id, guint16 pos);
static gint*
create_hf_entry(guint i, guint32 id, guint32 pos, gchar *name, gchar *filter_string, spdu_dt_t data_type, gboolean scale_or_offset, gboolean raw) {
val64_string *vs = NULL;
gint *hf_id = g_new(gint, 1);
*hf_id = -1;
if (i >= dynamic_hf_size) {
return NULL;
}
spdu_signal_value_name_t *sig_val = get_signal_value_name_config(id, pos);
if (sig_val != NULL) {
vs = sig_val->vs;
}
dynamic_hf[i].p_id = hf_id;
dynamic_hf[i].hfinfo.bitmask = 0x0;
if (raw) {
dynamic_hf[i].hfinfo.name = ws_strdup_printf("%s_raw", name);
dynamic_hf[i].hfinfo.abbrev = ws_strdup_printf("%s.%s_raw", SPDU_NAME_FILTER, filter_string);
} else {
dynamic_hf[i].hfinfo.name = g_strdup(name);
dynamic_hf[i].hfinfo.abbrev = ws_strdup_printf("%s.%s", SPDU_NAME_FILTER, filter_string);
}
dynamic_hf[i].hfinfo.bitmask = 0;
dynamic_hf[i].hfinfo.blurb = NULL;
if (scale_or_offset && !raw) {
dynamic_hf[i].hfinfo.display = BASE_NONE;
dynamic_hf[i].hfinfo.type = FT_DOUBLE;
} else {
switch (data_type) {
case SPDU_DATA_TYPE_UINT:
dynamic_hf[i].hfinfo.display = BASE_DEC;
dynamic_hf[i].hfinfo.type = FT_UINT64;
break;
case SPDU_DATA_TYPE_INT:
dynamic_hf[i].hfinfo.display = BASE_DEC;
dynamic_hf[i].hfinfo.type = FT_INT64;
break;
case SPDU_DATA_TYPE_NONE:
/* do nothing */
break;
}
}
if (raw && vs != NULL) {
dynamic_hf[i].hfinfo.strings = VALS64(vs);
dynamic_hf[i].hfinfo.display |= BASE_VAL64_STRING | BASE_SPECIAL_VALS;
} else {
dynamic_hf[i].hfinfo.strings = NULL;
}
HFILL_INIT(dynamic_hf[i]);
return hf_id;
}
static void
post_update_spdu_signal_list_read_in_data(spdu_signal_list_uat_t *data, guint data_num, GHashTable *ht) {
if (ht == NULL || data == NULL || data_num == 0) {
return;
}
if (data_num) {
/* lets create 2 hf_ids per entry (1x effective, 1x raw) */
dynamic_hf = g_new0(hf_register_info, 2 * data_num);
dynamic_hf_size = 2 * data_num;
guint i = 0;
for (i = 0; i < data_num; i++) {
/* the hash table does not know about uint64, so we use int64*/
gint64 *key = wmem_new(wmem_epan_scope(), gint64);
*key = (guint32)data[i].id;
spdu_signal_list_t *list = (spdu_signal_list_t *)g_hash_table_lookup(ht, key);
if (list == NULL) {
list = wmem_new(wmem_epan_scope(), spdu_signal_list_t);
list->id = data[i].id;
list->num_of_items = data[i].num_of_params;
spdu_signal_item_t *items = (spdu_signal_item_t *)wmem_alloc0_array(wmem_epan_scope(), spdu_signal_item_t, data[i].num_of_params);
list->items = items;
/* create new entry ... */
g_hash_table_insert(ht, key, list);
} else {
/* already present, deleting key */
wmem_free(wmem_epan_scope(), key);
}
/* and now we add to item array */
if (data[i].num_of_params == list->num_of_items && data[i].pos < list->num_of_items) {
spdu_signal_item_t *item = &(list->items[data[i].pos]);
/* we do not care if we overwrite param */
item->name = g_strdup(data[i].name);
item->pos = data[i].pos;
if (g_strcmp0("uint", data[i].data_type) == 0) {
item->data_type = SPDU_DATA_TYPE_UINT;
} else if (g_strcmp0("int", data[i].data_type) == 0) {
item->data_type = SPDU_DATA_TYPE_INT;
} else {
item->data_type = SPDU_DATA_TYPE_NONE;
}
item->big_endian = data[i].big_endian;
item->bitlength_base_type = data[i].bitlength_base_type;
item->bitlength_encoded_type = data[i].bitlength_encoded_type;
item->scaler = g_ascii_strtod(data[i].scaler, NULL);
item->offset = g_ascii_strtod(data[i].offset, NULL);
item->scale_or_offset = (item->scaler != 1.0 || item->offset != 0.0);
item->multiplexer = data[i].multiplexer;
item->multiplex_value_only = data[i].multiplex_value_only;
item->hidden = data[i].hidden;
item->hf_id_effective = create_hf_entry(2 * i, data[i].id, data[i].pos, data[i].name, data[i].filter_string, item->data_type, item->scale_or_offset, FALSE);
item->hf_id_raw = create_hf_entry(2 * i + 1, data[i].id, data[i].pos, data[i].name, data[i].filter_string, item->data_type, item->scale_or_offset, TRUE);
}
}
proto_register_field_array(proto_signal_pdu, dynamic_hf, dynamic_hf_size);
}
}
static void
post_update_spdu_signal_list_cb(void) {
/* destroy old hash table, if it exists */
if (data_spdu_signal_list) {
g_hash_table_destroy(data_spdu_signal_list);
data_spdu_signal_list = NULL;
}
deregister_user_data();
data_spdu_signal_list = g_hash_table_new_full(g_int64_hash, g_int64_equal, &spdu_payload_free_key, &spdu_payload_free_generic_data);
post_update_spdu_signal_list_read_in_data(spdu_signal_list, spdu_signal_list_num, data_spdu_signal_list);
}
static void
reset_spdu_signal_list(void)
{
deregister_user_data();
}
static spdu_signal_list_t*
get_parameter_config(guint64 id) {
if (data_spdu_signal_list == NULL) {
return NULL;
}
gint64 key = (gint64)id;
return (spdu_signal_list_t*)g_hash_table_lookup(data_spdu_signal_list, &key);
}
/* UAT: Value Names */
UAT_HEX_CB_DEF(spdu_signal_value_names, id, spdu_signal_value_name_uat_t)
UAT_DEC_CB_DEF(spdu_signal_value_names, pos, spdu_signal_value_name_uat_t)
UAT_DEC_CB_DEF(spdu_signal_value_names, num_of_items, spdu_signal_value_name_uat_t)
UAT_HEX64_CB_DEF(spdu_signal_value_names, value_start, spdu_signal_value_name_uat_t)
UAT_HEX64_CB_DEF(spdu_signal_value_names, value_end, spdu_signal_value_name_uat_t)
UAT_CSTRING_CB_DEF(spdu_signal_value_names, value_name, spdu_signal_value_name_uat_t)
static void *
copy_spdu_signal_value_name_cb(void *n, const void *o, size_t size _U_) {
spdu_signal_value_name_uat_t *new_rec = (spdu_signal_value_name_uat_t *)n;
const spdu_signal_value_name_uat_t *old_rec = (const spdu_signal_value_name_uat_t *)o;
new_rec->id = old_rec->id;
new_rec->num_of_items = old_rec->num_of_items;
new_rec->pos = old_rec->pos;
new_rec->value_start = old_rec->value_start;
new_rec->value_end = old_rec->value_end;
if (old_rec->value_name) {
new_rec->value_name = g_strdup(old_rec->value_name);
} else {
new_rec->value_name = NULL;
}
return new_rec;
}
static gboolean
update_spdu_signal_value_name(void *r, char **err) {
spdu_signal_value_name_uat_t *rec = (spdu_signal_value_name_uat_t *)r;
if (rec->value_name == NULL || rec->value_name[0] == 0) {
*err = ws_strdup_printf("Value Name cannot be empty");
return FALSE;
}
if (rec->value_end < rec->value_start) {
*err = ws_strdup_printf("Value Range is defined backwards (end < start)!");
return FALSE;
}
if (rec->pos >= 0xffff) {
*err = ws_strdup_printf("Position too big");
return FALSE;
}
return TRUE;
}
static void
free_spdu_signal_value_name_cb(void*r) {
spdu_signal_value_name_uat_t *rec = (spdu_signal_value_name_uat_t *)r;
if (rec->value_name) {
g_free(rec->value_name);
rec->value_name = NULL;
}
}
static void
post_update_spdu_signal_value_names_read_in_data(spdu_signal_value_name_uat_t *data, guint data_num, GHashTable *ht) {
if (ht == NULL || data == NULL || data_num == 0) {
return;
}
guint i;
for (i = 0; i < data_num; i++) {
gint64 *key = wmem_new(wmem_epan_scope(), gint64);
*key = (guint64)data[i].id | ((guint64)data[i].pos << 32);
spdu_signal_value_name_t *list = (spdu_signal_value_name_t *)g_hash_table_lookup(ht, key);
if (list == NULL) {
list = wmem_new(wmem_epan_scope(), spdu_signal_value_name_t);
INIT_SIGNAL_VALUE_NAME(list)
list->id = data[i].id;
list->pos = data[i].pos;
list->num_of_items = data[i].num_of_items;
list->items = (spdu_signal_value_name_item_t *)wmem_alloc0_array(wmem_epan_scope(), spdu_signal_value_name_item_t, list->num_of_items);
list->vs = (val64_string *)wmem_alloc0_array(wmem_epan_scope(), val64_string, list->num_of_items + 1);
/* create new entry ... */
g_hash_table_insert(ht, key, list);
} else {
/* do not need it anymore */
wmem_free(wmem_epan_scope(), key);
}
/* and now we add to item array */
if (list->num_of_items > 0 && data[i].num_of_items == list->num_of_items) {
/* find first empty slot for value */
guint j;
for (j = 0; j < list->num_of_items && list->items[j].name != NULL; j++);
if (j < list->num_of_items) {
spdu_signal_value_name_item_t *item = &(list->items[j]);
INIT_SIGNAL_VALUE_NAME_ITEM(item)
item->value_start = data[i].value_start;
item->value_end = data[i].value_end;
item->name = g_strdup(data[i].value_name);
}
/* find first empty slot for range_value array */
guint g;
for (g = 0; g < list->num_of_items && list->vs[g].strptr != NULL; g++);
if (g < list->num_of_items) {
/* Limitation: range strings currently do not support guint64 min/max and do not support filtering using value names. */
/* Therefore, we currently use only val64_string. :-( */
list->vs[g].value = (guint32)data[i].value_start;
list->vs[g].strptr = g_strdup(data[i].value_name);
}
}
}
}
static void
post_update_spdu_signal_value_names_cb(void) {
/* destroy old hash table, if it exists */
if (data_spdu_signal_value_names) {
g_hash_table_destroy(data_spdu_signal_value_names);
data_spdu_signal_value_names = NULL;
}
data_spdu_signal_value_names = g_hash_table_new_full(g_int64_hash, g_int64_equal, &spdu_payload_free_key, &spdu_payload_free_generic_data);
post_update_spdu_signal_value_names_read_in_data(spdu_signal_value_names, spdu_parameter_value_names_num, data_spdu_signal_value_names);
}
static spdu_signal_value_name_t*
get_signal_value_name_config(guint32 id, guint16 pos) {
if (data_spdu_signal_list == NULL) {
return NULL;
}
gint64 key = (guint64)id | (guint64)pos << 32;
return (spdu_signal_value_name_t*)g_hash_table_lookup(data_spdu_signal_value_names, &key);
}
/* UAT: SOME/IP Mapping */
UAT_HEX_CB_DEF(spdu_someip_mapping, service_id, spdu_someip_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_someip_mapping, method_id, spdu_someip_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_someip_mapping, major_version, spdu_someip_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_someip_mapping, message_type, spdu_someip_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_someip_mapping, spdu_message_id, spdu_someip_mapping_uat_t)
static gint64
spdu_someip_key(guint16 service_id, guint16 method_id, guint8 major_version, guint8 message_type) {
return (gint64)method_id | ((gint64)service_id << 16) | ((gint64)major_version << 32) | ((gint64)message_type << 40);
}
static void *
copy_spdu_someip_mapping_cb(void *n, const void *o, size_t size _U_) {
spdu_someip_mapping_uat_t *new_rec = (spdu_someip_mapping_uat_t *)n;
const spdu_someip_mapping_uat_t *old_rec = (const spdu_someip_mapping_uat_t *)o;
new_rec->service_id = old_rec->service_id;
new_rec->method_id = old_rec->method_id;
new_rec->major_version = old_rec->major_version;
new_rec->message_type = old_rec->message_type;
new_rec->spdu_message_id = old_rec->spdu_message_id;
return new_rec;
}
static gboolean
update_spdu_someip_mapping(void *r, char **err) {
spdu_someip_mapping_uat_t *rec = (spdu_someip_mapping_uat_t *)r;
if (rec->service_id > 0xffff) {
*err = ws_strdup_printf("We currently only support 16 bit SOME/IP Service IDs (Service-ID: %x Method-ID: %x MsgType: %x Version: %i)",
rec->service_id, rec->method_id, rec->message_type, rec->major_version);
return FALSE;
}
if (rec->method_id > 0xffff) {
*err = ws_strdup_printf("We currently only support 16 bit SOME/IP Method IDs (Service-ID: %x Method-ID: %x MsgType: %x Version: %i)",
rec->service_id, rec->method_id, rec->message_type, rec->major_version);
return FALSE;
}
if (rec->major_version > 0xff) {
*err = ws_strdup_printf("We currently only support 8 bit SOME/IP major versions (Service-ID: %x Method-ID: %x MsgType: %x Version: %i)",
rec->service_id, rec->method_id, rec->message_type, rec->major_version);
}
if (rec->message_type > 0xff) {
*err = ws_strdup_printf("We currently only support 8 bit SOME/IP message types (Service-ID: %x Method-ID: %x MsgType: %x Version: %i)",
rec->service_id, rec->method_id, rec->message_type, rec->major_version);
}
return TRUE;
}
static void
post_update_spdu_someip_mapping_cb(void) {
/* destroy old hash table, if it exists */
if (data_spdu_someip_mappings) {
g_hash_table_destroy(data_spdu_someip_mappings);
data_spdu_someip_mappings = NULL;
}
/* we don't need to free the data as long as we don't alloc it first */
data_spdu_someip_mappings = g_hash_table_new_full(g_int64_hash, g_int64_equal, &spdu_payload_free_key, NULL);
if (data_spdu_someip_mappings == NULL || spdu_someip_mapping == NULL) {
return;
}
guint i;
if (spdu_someip_mapping_num > 0) {
for (i = 0; i < spdu_someip_mapping_num; i++) {
gint64 *key = wmem_new(wmem_epan_scope(), gint64);
*key = spdu_someip_key((guint16)spdu_someip_mapping[i].service_id,
(guint16)spdu_someip_mapping[i].method_id,
(guint8)spdu_someip_mapping[i].major_version,
(guint8)spdu_someip_mapping[i].message_type);
g_hash_table_insert(data_spdu_someip_mappings, key, &spdu_someip_mapping[i]);
}
}
/* we need to make sure we register again */
register_signal_pdu_someip();
}
static spdu_someip_mapping_t*
get_someip_mapping(guint16 service_id, guint16 method_id, guint8 major_version, guint8 message_type) {
if (data_spdu_someip_mappings == NULL) {
return NULL;
}
gint64 key = spdu_someip_key(service_id, method_id, major_version, message_type);
return (spdu_someip_mapping_t*)g_hash_table_lookup(data_spdu_someip_mappings, &key);
}
/* UAT: CAN Mapping */
UAT_HEX_CB_DEF(spdu_can_mapping, can_id, spdu_can_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_can_mapping, bus_id, spdu_can_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_can_mapping, message_id, spdu_can_mapping_uat_t)
static void *
copy_spdu_can_mapping_cb(void *n, const void *o, size_t size _U_) {
spdu_can_mapping_uat_t *new_rec = (spdu_can_mapping_uat_t *)n;
const spdu_can_mapping_uat_t *old_rec = (const spdu_can_mapping_uat_t *)o;
new_rec->can_id = old_rec->can_id;
new_rec->bus_id = old_rec->bus_id;
new_rec->message_id = old_rec->message_id;
return new_rec;
}
static void
post_update_spdu_can_mapping_cb(void) {
/* destroy old hash table, if it exists */
if (data_spdu_can_mappings) {
g_hash_table_destroy(data_spdu_can_mappings);
data_spdu_can_mappings = NULL;
}
/* we don't need to free the data as long as we don't alloc it first */
data_spdu_can_mappings = g_hash_table_new_full(g_int64_hash, g_int64_equal, &spdu_payload_free_key, NULL);
if (data_spdu_can_mappings == NULL || spdu_can_mapping == NULL) {
return;
}
if (spdu_can_mapping_num > 0) {
guint i;
for (i = 0; i < spdu_can_mapping_num; i++) {
gint64 *key = wmem_new(wmem_epan_scope(), gint64);
*key = spdu_can_mapping[i].can_id;
*key |= ((gint64)(spdu_can_mapping[i].bus_id & 0xffff)) << 32;
g_hash_table_insert(data_spdu_can_mappings, key, &spdu_can_mapping[i]);
}
}
/* we need to make sure we register again */
register_signal_pdu_can();
}
static spdu_can_mapping_t*
get_can_mapping(guint32 id, guint16 bus_id) {
if (data_spdu_can_mappings == NULL) {
return NULL;
}
gint64 key = ((gint64)id & CAN_EFF_MASK) | ((gint64)bus_id << 32);
spdu_can_mapping_t *tmp = (spdu_can_mapping_t*)g_hash_table_lookup(data_spdu_can_mappings, &key);
if (tmp == NULL) {
/* try again without Bus ID set */
key = (gint64)id & CAN_EFF_MASK;
tmp = (spdu_can_mapping_t*)g_hash_table_lookup(data_spdu_can_mappings, &key);
}
return tmp;
}
/* UAT: FlexRay Mapping */
UAT_HEX_CB_DEF(spdu_flexray_mapping, channel, spdu_flexray_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_flexray_mapping, cycle, spdu_flexray_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_flexray_mapping, flexray_id, spdu_flexray_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_flexray_mapping, message_id, spdu_flexray_mapping_uat_t)
static void *
copy_spdu_flexray_mapping_cb(void *n, const void *o, size_t size _U_) {
spdu_flexray_mapping_uat_t *new_rec = (spdu_flexray_mapping_uat_t *)n;
const spdu_flexray_mapping_uat_t *old_rec = (const spdu_flexray_mapping_uat_t *)o;
new_rec->channel = old_rec->channel;
new_rec->cycle = old_rec->cycle;
new_rec->flexray_id = old_rec->flexray_id;
new_rec->message_id = old_rec->message_id;
return new_rec;
}
static gboolean
update_spdu_flexray_mapping(void *r, char **err) {
spdu_flexray_mapping_uat_t *rec = (spdu_flexray_mapping_uat_t *)r;
if (rec->cycle > 0xff) {
*err = ws_strdup_printf("We currently only support 8 bit Cycles (Cycle: %i Frame ID: %i)", rec->cycle, rec->flexray_id);
return FALSE;
}
if (rec->flexray_id > 0xffff) {
*err = ws_strdup_printf("We currently only support 16 bit Frame IDs (Cycle: %i Frame ID: %i)", rec->cycle, rec->flexray_id);
return FALSE;
}
return TRUE;
}
static void
post_update_spdu_flexray_mapping_cb(void) {
/* destroy old hash table, if it exists */
if (data_spdu_flexray_mappings) {
g_hash_table_destroy(data_spdu_flexray_mappings);
data_spdu_flexray_mappings = NULL;
}
/* we don't need to free the data as long as we don't alloc it first */
data_spdu_flexray_mappings = g_hash_table_new_full(g_int64_hash, g_int64_equal, &spdu_payload_free_key, NULL);
if (data_spdu_flexray_mappings == NULL || spdu_flexray_mapping == NULL) {
return;
}
if (spdu_flexray_mapping_num > 0) {
guint i;
for (i = 0; i < spdu_flexray_mapping_num; i++) {
gint64 *key = wmem_new(wmem_epan_scope(), gint64);
*key = spdu_flexray_mapping[i].flexray_id & 0xffff;
*key |= (spdu_flexray_mapping[i].cycle & 0xff) << 16;
*key |= (spdu_flexray_mapping[i].channel & 0xff) << 24;
g_hash_table_insert(data_spdu_flexray_mappings, key, &spdu_flexray_mapping[i]);
}
}
}
static spdu_flexray_mapping_t*
get_flexray_mapping(guint8 channel, guint8 cycle, guint16 flexray_id) {
if (data_spdu_flexray_mappings == NULL) {
return NULL;
}
gint64 key = (channel << 24) | (cycle << 16) | flexray_id;
return (spdu_flexray_mapping_t*)g_hash_table_lookup(data_spdu_flexray_mappings, &key);
}
/* UAT: LIN Mapping */
UAT_HEX_CB_DEF(spdu_lin_mapping, frame_id, spdu_lin_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_lin_mapping, bus_id, spdu_lin_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_lin_mapping, message_id, spdu_lin_mapping_uat_t)
static void *
copy_spdu_lin_mapping_cb(void *n, const void *o, size_t size _U_) {
spdu_lin_mapping_uat_t *new_rec = (spdu_lin_mapping_uat_t*)n;
const spdu_lin_mapping_uat_t *old_rec = (const spdu_lin_mapping_uat_t*)o;
new_rec->frame_id = old_rec->frame_id;
new_rec->bus_id = old_rec->bus_id;
new_rec->message_id = old_rec->message_id;
return new_rec;
}
static gboolean
update_spdu_lin_mapping(void *r, char **err) {
spdu_lin_mapping_uat_t *rec = (spdu_lin_mapping_uat_t *)r;
if (rec->frame_id > LIN_ID_MASK) {
*err = ws_strdup_printf("LIN Frame IDs are only uint with 6 bits (ID: %i)", rec->frame_id);
return FALSE;
}
if (rec->bus_id > 0xffff) {
*err = ws_strdup_printf("LIN Bus IDs are only uint with 16 bits (ID: 0x%x, Bus ID: 0x%x)", rec->frame_id, rec->bus_id);
return FALSE;
}
return TRUE;
}
static void
post_update_spdu_lin_mapping_cb(void) {
/* destroy old hash table, if it exists */
if (data_spdu_lin_mappings) {
g_hash_table_destroy(data_spdu_lin_mappings);
data_spdu_lin_mappings = NULL;
}
/* we don't need to free the data as long as we don't alloc it first */
data_spdu_lin_mappings = g_hash_table_new_full(g_int_hash, g_int_equal, &spdu_payload_free_key, NULL);
if (data_spdu_lin_mappings == NULL || spdu_lin_mapping == NULL) {
return;
}
if (spdu_lin_mapping_num > 0) {
guint i;
for (i = 0; i < spdu_lin_mapping_num; i++) {
gint *key = wmem_new(wmem_epan_scope(), gint);
*key = (spdu_lin_mapping[i].frame_id)&LIN_ID_MASK;
*key |= ((spdu_lin_mapping[i].bus_id) & 0xffff) << 16;
g_hash_table_insert(data_spdu_lin_mappings, key, &spdu_lin_mapping[i]);
}
}
/* we need to make sure we register again */
register_signal_pdu_lin();
}
static spdu_lin_mapping_t*
get_lin_mapping(lin_info_t *lininfo) {
if (data_spdu_lin_mappings == NULL) {
return NULL;
}
gint32 key = ((lininfo->id)&LIN_ID_MASK) | (((lininfo->bus_id) & 0xffff) << 16);
spdu_lin_mapping_uat_t *tmp = (spdu_lin_mapping_uat_t*)g_hash_table_lookup(data_spdu_lin_mappings, &key);
if (tmp == NULL) {
/* try again without Bus ID set */
key = (lininfo->id) & LIN_ID_MASK;
tmp = (spdu_lin_mapping_uat_t*)g_hash_table_lookup(data_spdu_lin_mappings, &key);
}
return tmp;
}
/* UAT: PDU Transport Mapping */
UAT_HEX_CB_DEF(spdu_pdu_transport_mapping, pdu_id, spdu_pdu_transport_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_pdu_transport_mapping, message_id, spdu_pdu_transport_mapping_uat_t)
static void *
copy_spdu_pdu_transport_mapping_cb(void *n, const void *o, size_t size _U_) {
spdu_pdu_transport_mapping_uat_t *new_rec = (spdu_pdu_transport_mapping_uat_t*)n;
const spdu_pdu_transport_mapping_uat_t *old_rec = (const spdu_pdu_transport_mapping_uat_t*)o;
new_rec->pdu_id = old_rec->pdu_id;
new_rec->message_id = old_rec->message_id;
return new_rec;
}
static gboolean
update_spdu_pdu_transport_mapping(void *r, char **err) {
spdu_pdu_transport_mapping_uat_t *rec = (spdu_pdu_transport_mapping_uat_t *)r;
if (rec->pdu_id > 0xffffffff) {
*err = ws_strdup_printf("PDU-Transport IDs are only uint32 (ID: %i)", rec->pdu_id);
return FALSE;
}
return TRUE;
}
static void
post_update_spdu_pdu_transport_mapping_cb(void) {
/* destroy old hash table, if it exists */
if (data_spdu_pdu_transport_mappings) {
g_hash_table_destroy(data_spdu_pdu_transport_mappings);
data_spdu_pdu_transport_mappings = NULL;
}
/* we don't need to free the data as long as we don't alloc it first */
data_spdu_pdu_transport_mappings = g_hash_table_new_full(g_int64_hash, g_int64_equal, &spdu_payload_free_key, NULL);
if (data_spdu_pdu_transport_mappings == NULL || spdu_pdu_transport_mapping == NULL) {
return;
}
if (spdu_pdu_transport_mapping_num > 0) {
guint i;
for (i = 0; i < spdu_pdu_transport_mapping_num; i++) {
gint64 *key = wmem_new(wmem_epan_scope(), gint64);
*key = spdu_pdu_transport_mapping[i].pdu_id;
g_hash_table_insert(data_spdu_pdu_transport_mappings, key, &spdu_pdu_transport_mapping[i]);
}
}
/* we need to make sure we register again */
register_signal_pdu_pdu_transport();
}
static spdu_pdu_transport_mapping_t*
get_pdu_transport_mapping(guint32 pdu_transport_id) {
if (data_spdu_pdu_transport_mappings == NULL) {
return NULL;
}
gint64 key = pdu_transport_id;
return (spdu_pdu_transport_mapping_uat_t*)g_hash_table_lookup(data_spdu_pdu_transport_mappings, &key);
}
/* UAT: IPduM Mapping */
UAT_HEX_CB_DEF(spdu_ipdum_mapping, pdu_id, spdu_ipdum_mapping_uat_t)
UAT_HEX_CB_DEF(spdu_ipdum_mapping, message_id, spdu_ipdum_mapping_uat_t)
static void *
copy_spdu_ipdum_mapping_cb(void *n, const void *o, size_t size _U_) {
spdu_ipdum_mapping_uat_t *new_rec = (spdu_ipdum_mapping_uat_t*)n;
const spdu_ipdum_mapping_uat_t *old_rec = (const spdu_ipdum_mapping_uat_t*)o;
new_rec->pdu_id = old_rec->pdu_id;
new_rec->message_id = old_rec->message_id;
return new_rec;
}
static gboolean
update_spdu_ipdum_mapping(void *r, char **err) {
spdu_ipdum_mapping_uat_t *rec = (spdu_ipdum_mapping_uat_t *)r;
if (rec->pdu_id > 0xffffffff) {
*err = ws_strdup_printf("IPduM IDs are only uint32 (ID: %i)", rec->pdu_id);
return FALSE;
}
return TRUE;
}
static void
post_update_spdu_ipdum_mapping_cb(void) {
/* destroy old hash table, if it exists */
if (data_spdu_ipdum_mappings) {
g_hash_table_destroy(data_spdu_ipdum_mappings);
data_spdu_ipdum_mappings = NULL;
}
/* we don't need to free the data as long as we don't alloc it first */
data_spdu_ipdum_mappings = g_hash_table_new_full(g_int64_hash, g_int64_equal, &spdu_payload_free_key, NULL);
if (data_spdu_ipdum_mappings == NULL || spdu_ipdum_mapping == NULL) {
return;
}
if (spdu_ipdum_mapping_num > 0) {
guint i;
for (i = 0; i < spdu_ipdum_mapping_num; i++) {
gint64 *key = wmem_new(wmem_epan_scope(), gint64);
*key = spdu_ipdum_mapping[i].pdu_id;
g_hash_table_insert(data_spdu_ipdum_mappings, key, &spdu_ipdum_mapping[i]);
}
}
/* we need to make sure we register again */
register_signal_pdu_ipdum_ids();
}
static spdu_ipdum_mapping_uat_t*
get_ipdum_mapping(guint32 pdu_id) {
if (data_spdu_ipdum_mappings == NULL) {
return NULL;
}
gint64 key = pdu_id;
return (spdu_ipdum_mapping_uat_t*)g_hash_table_lookup(data_spdu_ipdum_mappings, &key);
}
/**************************************
******** Expert Infos ********
**************************************/
static void
expert_spdu_payload_truncated(proto_tree *tree, packet_info *pinfo, tvbuff_t *tvb, gint offset, gint length) {
proto_tree_add_expert(tree, pinfo, &ef_spdu_payload_truncated, tvb, offset, length);
col_append_str(pinfo->cinfo, COL_INFO, " [Signal PDU: Truncated payload!]");
}
static void
expert_spdu_config_error(proto_tree *tree, packet_info *pinfo, tvbuff_t *tvb, gint offset, gint length) {
proto_tree_add_expert(tree, pinfo, &ef_spdu_config_error, tvb, offset, length);
col_append_str(pinfo->cinfo, COL_INFO, " [Signal PDU: Config Error!]");
}
/**************************************
******** Signal PDU Dissector ********
**************************************/
static guint64
dissect_shifted_and_shortened_uint(tvbuff_t *tvb, gint offset, gint offset_bits, gint offset_end, gint offset_end_bits, gboolean big_endian) {
gint32 i;
guint64 value_guint64 = 0;
if (!big_endian) {
/* offset and offset_end need to be included */
for (i = offset_end; i >= offset; i--) {
if (i != offset_end || offset_end_bits != 0) {
guint8 tmp = tvb_get_guint8(tvb, i);
gint tmp_bit_count = 8;
if (i == offset_end) {
tmp = tmp & (0xff >> (8 - offset_end_bits));
/* don't need to shift value, in the first round */
tmp_bit_count = 0;
}
if (i == offset) {
tmp >>= offset_bits;
tmp_bit_count = 8 - offset_bits;
}
value_guint64 <<= (guint)tmp_bit_count;
value_guint64 |= tmp;
}
}
} else {
/* offset_end needs to be included. */
for (i = offset; i <= offset_end; i++) {
/* Do not read the last byte, if you do not need any bit of it. Else we read behind buffer! */
if (i != offset_end || offset_end_bits != 0) {
guint8 tmp = tvb_get_guint8(tvb, i);
gint tmp_bit_count = 8;
if (i == offset) {
tmp = tmp & (0xff >> offset_bits);
/* don't need to shift value, in the first round */
tmp_bit_count = 0;
}
if (i == offset_end) {
tmp >>= 8 - offset_end_bits;
tmp_bit_count = offset_end_bits;
}
value_guint64 <<= (guint)tmp_bit_count;
value_guint64 |= tmp;
}
}
}
return value_guint64;
}
static int
dissect_spdu_payload_signal(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, gint offset, gint offset_bits, spdu_signal_item_t *item, spdu_signal_value_name_t *value_name_config, gint *multiplexer) {
proto_item *ti = NULL;
proto_tree *subtree = NULL;
gchar *value_name = NULL;
gint hf_id_effective = -1;
gint hf_id_raw = -1;
gint offset_end = (gint)((8 * offset + offset_bits + item->bitlength_encoded_type) / 8);
gint offset_end_bits = (gint)((8 * offset + offset_bits + item->bitlength_encoded_type) % 8);
gint signal_length = offset_end - offset;
if (offset_end_bits != 0) {
signal_length++;
}
if (item->multiplex_value_only != -1 && item->multiplex_value_only != *multiplexer) {
/* multiplexer set and we are in the wrong multiplex */
return 0;
}
if (tvb_captured_length_remaining(tvb, offset) < signal_length) {
expert_spdu_payload_truncated(tree, pinfo, tvb, offset, tvb_captured_length_remaining(tvb, offset));
return -1;
}
if (!spdu_derserializer_show_hidden && item->hidden) {
return (gint)item->bitlength_encoded_type;
}
if (item != NULL && item->hf_id_effective != NULL) {
hf_id_effective = *item->hf_id_effective;
} else {
expert_spdu_config_error(tree, pinfo, tvb, offset, signal_length);
}
if (item == NULL) {
return tvb_captured_length_remaining(tvb, offset);
}
if (item->hf_id_raw != NULL) {
hf_id_raw = *item->hf_id_raw;
} else {
expert_spdu_config_error(tree, pinfo, tvb, offset, signal_length);
}
guint64 value_guint64 = dissect_shifted_and_shortened_uint(tvb, offset, offset_bits, offset_end, offset_end_bits, item->big_endian);
switch (item->data_type) {
case SPDU_DATA_TYPE_UINT: {
gdouble value_gdouble = (gdouble)value_guint64;
if (item->multiplexer) {
*multiplexer = (gint)value_guint64;
}
/* show names for values */
if (value_name_config != NULL) {
guint32 i;
for (i = 0; i < value_name_config->num_of_items; i++) {
if (value_name_config->items[i].value_start <= value_guint64 && value_guint64 <= value_name_config->items[i].value_end) {
value_name = value_name_config->items[i].name;
}
}
}
/* scale and output */
if (item->scale_or_offset) {
value_gdouble = item->scaler * value_gdouble + item->offset;
ti = proto_tree_add_double(tree, hf_id_effective, tvb, offset, signal_length, value_gdouble);
} else {
ti = proto_tree_add_uint64(tree, hf_id_effective, tvb, offset, signal_length, value_guint64);
}
if (value_name != NULL) {
proto_item_append_text(ti, " [raw: 0x%" PRIx64 ": %s]", value_guint64, value_name);
} else {
proto_item_append_text(ti, " [raw: 0x%" PRIx64 "]", value_guint64);
}
subtree = proto_item_add_subtree(ti, ett_spdu_signal);
ti = proto_tree_add_uint64(subtree, hf_id_raw, tvb, offset, signal_length, value_guint64);
proto_item_append_text(ti, " (0x%" PRIx64 ")", value_guint64);
}
break;
case SPDU_DATA_TYPE_INT: {
gint64 value_gint64 = ws_sign_ext64(value_guint64, (gint)item->bitlength_encoded_type);
gdouble value_gdouble = (gdouble)value_gint64;
if (item->multiplexer) {
*multiplexer = (gint)value_gint64;
}
/* scale and output */
if (item->scale_or_offset) {
value_gdouble = item->scaler * value_gdouble + item->offset;
ti = proto_tree_add_double(tree, hf_id_effective, tvb, offset, signal_length, value_gdouble);
} else {
ti = proto_tree_add_int64(tree, hf_id_effective, tvb, offset, signal_length, value_gint64);
}
if (value_name != NULL) {
proto_item_append_text(ti, " [raw: %" PRIx64 ": %s]", value_gint64, value_name);
} else {
proto_item_append_text(ti, " [raw: %" PRIx64 "]", value_gint64);
}
subtree = proto_item_add_subtree(ti, ett_spdu_signal);
ti = proto_tree_add_int64(subtree, hf_id_raw, tvb, offset, signal_length, value_gint64);
proto_item_append_text(ti, " (0x%" PRIx64 ")", value_gint64);
}
break;
case SPDU_DATA_TYPE_NONE:
/* do nothing */
break;
}
/* hide raw value per default, if effective value is present */
if (spdu_derserializer_hide_raw_values) {
proto_item_set_hidden(ti);
}
return (gint)item->bitlength_encoded_type;
}
static int
dissect_spdu_payload(tvbuff_t *tvb, packet_info *pinfo, proto_tree *root_tree, guint32 id, gboolean update_column) {
gint offset = 0;
gint offset_bits = 0;
gint bits_parsed = 0;
gint multiplexer = -1;
proto_item *ti = proto_tree_add_item(root_tree, proto_signal_pdu, tvb, offset, -1, ENC_NA);
proto_tree *tree = proto_item_add_subtree(ti, ett_spdu_payload);
char *name = get_message_name(id);
if (name != NULL) {
proto_item_append_text(ti, ": %s", name);
if (update_column) {
col_append_fstr(pinfo->cinfo, COL_INFO, " (PDU: %s)", name);
col_set_str(pinfo->cinfo, COL_PROTOCOL, SPDU_NAME);
}
}
spdu_signal_list_t *paramlist = get_parameter_config(id);
if (name == NULL && paramlist == NULL) {
/* unknown message, lets skip */
return 0;
}
if (root_tree == NULL && !proto_field_is_referenced(root_tree, proto_signal_pdu)) {
/* we only receive subtvbs with nothing behind us */
return tvb_captured_length(tvb);
}
if (paramlist == NULL || !spdu_derserializer_activated) {
/* we only receive subtvbs with nothing behind us */
return tvb_captured_length(tvb);
}
gint length = tvb_captured_length_remaining(tvb, 0);
guint i;
for (i = 0; i < paramlist->num_of_items; i++) {
spdu_signal_value_name_t *value_name_config = get_signal_value_name_config(paramlist->id, paramlist->items[i].pos);
bits_parsed = dissect_spdu_payload_signal(tvb, pinfo, tree, offset, offset_bits, &(paramlist->items[i]), value_name_config, &multiplexer);
if (bits_parsed == -1) {
break;
}
offset = (8 * offset + offset_bits + bits_parsed) / 8;
offset_bits = (8 * offset + offset_bits + bits_parsed) % 8;
}
if (bits_parsed != -1 && length > offset + 1) {
proto_tree_add_item(tree, hf_payload_unparsed, tvb, offset + 1, length - (offset + 1), ENC_NA);
}
return offset;
}
static int
dissect_spdu_message_someip(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data) {
someip_info_t *someip_info = (someip_info_t*)data;
DISSECTOR_ASSERT(someip_info);
spdu_someip_mapping_t *someip_mapping = get_someip_mapping(someip_info->service_id, someip_info->method_id, someip_info->major_version, someip_info->message_type);
if (someip_mapping == NULL) {
return 0;
}
return dissect_spdu_payload(tvb, pinfo, tree, someip_mapping->spdu_message_id, FALSE);
}
static int
dissect_spdu_message_can(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data) {
struct can_info *can_info = (struct can_info *)data;
DISSECTOR_ASSERT(can_info);
if (can_info->id & (CAN_ERR_FLAG | CAN_RTR_FLAG)) {
/* Error and RTR frames are not for us. */
return 0;
}
spdu_can_mapping_t *can_mapping = get_can_mapping(can_info->id, can_info->bus_id);
if (can_mapping == NULL) {
return 0;
}
return dissect_spdu_payload(tvb, pinfo, tree, can_mapping->message_id, TRUE);
}
static gboolean
dissect_spdu_message_can_heur(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data) {
return dissect_spdu_message_can(tvb, pinfo, tree, data) != 0;
}
static int
dissect_spdu_message_flexray(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data) {
struct flexray_info *flexray_data = (struct flexray_info*)data;
DISSECTOR_ASSERT(flexray_data);
spdu_flexray_mapping_t *flexray_mapping = get_flexray_mapping(flexray_data->ch, flexray_data->cc, flexray_data->id);
if (flexray_mapping == NULL) {
return 0;
}
return dissect_spdu_payload(tvb, pinfo, tree, flexray_mapping->message_id, TRUE);
}
static gboolean
dissect_spdu_message_flexray_heur(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data) {
return dissect_spdu_message_flexray(tvb, pinfo, tree, data) != 0;
}
static int
dissect_spdu_message_lin(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data) {
lin_info_t *lininfo = (lin_info_t *)data;
DISSECTOR_ASSERT(lininfo);
spdu_lin_mapping_t *lin_mapping = get_lin_mapping(lininfo);
if (lin_mapping == NULL) {
return 0;
}
return dissect_spdu_payload(tvb, pinfo, tree, lin_mapping->message_id, TRUE);
}
static int
dissect_spdu_message_pdu_transport(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data) {
pdu_transport_info_t *pdu_info = (pdu_transport_info_t*)data;
DISSECTOR_ASSERT(pdu_info);
spdu_pdu_transport_mapping_t *pdu_transport_mapping = get_pdu_transport_mapping(pdu_info->id);
if (pdu_transport_mapping == NULL) {
return 0;
}
return dissect_spdu_payload(tvb, pinfo, tree, pdu_transport_mapping->message_id, FALSE);
}
static int
dissect_spdu_message_ipdum(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data) {
autosar_ipdu_multiplexer_info_t *pdu_info = (autosar_ipdu_multiplexer_info_t*)data;
DISSECTOR_ASSERT(pdu_info);
spdu_ipdum_mapping_uat_t *ipdum_mapping = get_ipdum_mapping(pdu_info->pdu_id);
if (ipdum_mapping == NULL) {
return 0;
}
return dissect_spdu_payload(tvb, pinfo, tree, ipdum_mapping->message_id, TRUE);
}
/**************************************
******** Register Dissector ********
**************************************/
void
proto_register_signal_pdu(void) {
module_t *spdu_module;
expert_module_t *expert_module_lpdu;
/* UAT for naming */
uat_t *spdu_messages_uat;
/* the UATs for parsing the message*/
uat_t *spdu_signal_list_uat;
uat_t *spdu_parameter_value_names_uat;
/* UATs for mapping different incoming payloads to messages*/
uat_t *spdu_someip_mapping_uat;
uat_t *spdu_can_mapping_uat;
uat_t *spdu_flexray_mapping_uat;
uat_t *spdu_lin_mapping_uat;
uat_t *spdu_pdu_transport_mapping_uat;
uat_t *spdu_ipdum_mapping_uat;
/* data fields */
static hf_register_info hf[] = {
{ &hf_payload_unparsed,
{ "Unparsed Payload", "signal_pdu.payload.unparsed",
FT_BYTES, BASE_NONE, NULL, 0x0, NULL, HFILL }},
};
static gint *ett[] = {
&ett_spdu_payload,
&ett_spdu_signal,
};
/* UATs for user_data fields */
static uat_field_t spdu_messages_uat_fields[] = {
UAT_FLD_HEX(spdu_message_ident, id, "Signal PDU ID", "ID of the Signal PDU"),
UAT_FLD_CSTRING(spdu_message_ident, name, "Name", "Name of the Signal PDU"),
UAT_END_FIELDS
};
static uat_field_t spdu_signal_list_uat_fields[] = {
UAT_FLD_HEX(spdu_signal_list, id, "Signal PDU ID", "ID of the Signal PDU (32bit hex without leading 0x)"),
UAT_FLD_DEC(spdu_signal_list, num_of_params, "Number of Signals", "Number of signals (16bit dec)"),
UAT_FLD_DEC(spdu_signal_list, pos, "Signal Position", "Position of signal (16bit dec, starting with 0)"),
UAT_FLD_CSTRING(spdu_signal_list, name, "Signal Name", "Name of signal (string)"),
UAT_FLD_CSTRING(spdu_signal_list, filter_string, "Filter String", "Unique filter string that will be prepended with signal_pdu. (string)"),
UAT_FLD_CSTRING(spdu_signal_list, data_type, "Data Type", "Data type (string), [uint|int]"),
UAT_FLD_BOOL(spdu_signal_list, big_endian, "Big Endian?", "Big Endian encoded [FALSE|TRUE]"),
UAT_FLD_DEC(spdu_signal_list, bitlength_base_type, "Bitlength base type", "Bitlength base type (uint32 dec)"),
UAT_FLD_DEC(spdu_signal_list, bitlength_encoded_type, "Bitlength enc. type", "Bitlength encoded type (uint32 dec)"),
UAT_FLD_CSTRING(spdu_signal_list, scaler, "Scaler", "Raw value is multiplied by this Scaler, e.g. 1.0 (double)"),
UAT_FLD_CSTRING(spdu_signal_list, offset, "Offset", "Scaled raw value is shifted by this Offset, e.g. 1.0 (double)"),
UAT_FLD_BOOL(spdu_signal_list, multiplexer, "Multiplexer?", "Is this used as multiplexer? [FALSE|TRUE]"),
UAT_FLD_SIGNED_DEC(spdu_signal_list, multiplex_value_only, "Multiplexer value", "The multiplexer value for which this is relevant (-1 all)"),
UAT_FLD_BOOL(spdu_signal_list, hidden, "Hidden?", "Should this field be hidden in the dissection? [FALSE|TRUE]"),
UAT_END_FIELDS
};
static uat_field_t spdu_parameter_value_name_uat_fields[] = {
UAT_FLD_HEX(spdu_signal_value_names, id, "Signal PDU ID", "ID of the Signal PDU (32bit hex without leading 0x)"),
UAT_FLD_DEC(spdu_signal_value_names, pos, "Signal Position", "Position of signal (16bit dec, starting with 0)"),
UAT_FLD_DEC(spdu_signal_value_names, num_of_items, "Number of Names", "Number of Value Names defined (32bit dec)"),
UAT_FLD_HEX64(spdu_signal_value_names, value_start, "Value Range Start", "Value Range Start (64bit uint hex)"),
UAT_FLD_HEX64(spdu_signal_value_names, value_end, "Value Range End", "Value Range End (64bit uint hex)"),
UAT_FLD_CSTRING(spdu_signal_value_names, value_name, "Value Name", "Name for the values in this range (string)"),
UAT_END_FIELDS
};
static uat_field_t spdu_someip_mapping_uat_fields[] = {
UAT_FLD_HEX(spdu_someip_mapping, service_id, "SOME/IP Service ID", "SOME/IP Service ID (16bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_someip_mapping, method_id, "SOME/IP Method ID", "SOME/IP Method ID (16bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_someip_mapping, major_version, "SOME/IP Major Version", "SOME/IP Major Version (8bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_someip_mapping, message_type, "SOME/IP Message Type", "SOME/IP Message Type (8bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_someip_mapping, spdu_message_id, "Signal PDU ID", "ID of the Signal PDU (32bit hex without leading 0x)"),
UAT_END_FIELDS
};
static uat_field_t spdu_can_mapping_uat_fields[] = {
UAT_FLD_HEX(spdu_can_mapping, can_id, "CAN ID", "CAN ID (32bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_can_mapping, bus_id, "Bus ID", "Bus ID on which frame was recorded with 0=any (16bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_can_mapping, message_id, "Signal PDU ID", "ID of the Signal PDU (32bit hex without leading 0x)"),
UAT_END_FIELDS
};
static uat_field_t spdu_flexray_mapping_uat_fields[] = {
UAT_FLD_HEX(spdu_flexray_mapping, channel, "Channel", "Channel (8bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_flexray_mapping, cycle, "Cycle", "Cycle (8bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_flexray_mapping, flexray_id, "Frame ID", "Frame ID (16bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_flexray_mapping, message_id, "Signal PDU ID", "ID of the Signal PDU (32bit hex without leading 0x)"),
UAT_END_FIELDS
};
static uat_field_t spdu_lin_mapping_uat_fields[] = {
UAT_FLD_HEX(spdu_lin_mapping, frame_id, "Frame ID", "LIN Frame ID (6bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_lin_mapping, bus_id, "Bus ID", "Bus ID on which frame was recorded with 0=any (16bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_lin_mapping, message_id, "Signal PDU ID", "ID of the Signal PDU (32bit hex without leading 0x)"),
UAT_END_FIELDS
};
static uat_field_t spdu_pdu_transport_mapping_uat_fields[] = {
UAT_FLD_HEX(spdu_pdu_transport_mapping, pdu_id, "PDU ID", "PDU ID (32bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_pdu_transport_mapping, message_id, "Signal PDU ID", "ID of the Signal PDU (32bit hex without leading 0x)"),
UAT_END_FIELDS
};
static uat_field_t spdu_ipdum_mapping_uat_fields[] = {
UAT_FLD_HEX(spdu_ipdum_mapping, pdu_id, "PDU ID", "PDU ID (32bit hex without leading 0x)"),
UAT_FLD_HEX(spdu_ipdum_mapping, message_id, "Signal PDU ID", "ID of the Signal PDU (32bit hex without leading 0x)"),
UAT_END_FIELDS
};
static ei_register_info ei[] = {
{ &ef_spdu_payload_truncated, {"signal_pdu.payload.expert_truncated",
PI_MALFORMED, PI_ERROR, "Signal PDU: Truncated payload!", EXPFILL} },
{ &ef_spdu_config_error, {"signal_pdu.payload.config_error",
PI_MALFORMED, PI_ERROR, "Signal PDU: Config Error (missing filter, filter duplicate, ...)!", EXPFILL} },
};
/* Register ETTs */
proto_signal_pdu = proto_register_protocol(SPDU_NAME_LONG, SPDU_NAME, SPDU_NAME_FILTER);
proto_register_field_array(proto_signal_pdu, hf, array_length(hf));
proto_register_subtree_array(ett, array_length(ett));
expert_module_lpdu = expert_register_protocol(proto_signal_pdu);
expert_register_field_array(expert_module_lpdu, ei, array_length(ei));
/* Register preferences */
spdu_module = prefs_register_protocol(proto_signal_pdu, &proto_reg_handoff_signal_pdu);
/* UATs */
spdu_messages_uat = uat_new("Signal PDU Messages",
sizeof(generic_one_id_string_t), /* record size */
DATAFILE_SPDU_MESSAGES, /* filename */
TRUE, /* from profile */
(void**) &spdu_message_ident, /* data_ptr */
&spdu_message_ident_num, /* numitems_ptr */
UAT_AFFECTS_DISSECTION, /* but not fields */
NULL, /* help */
copy_generic_one_id_string_cb, /* copy callback */
update_generic_one_identifier_32bit, /* update callback */
free_generic_one_id_string_cb, /* free callback */
post_update_spdu_message_cb, /* post update callback */
NULL, /* reset callback */
spdu_messages_uat_fields /* UAT field definitions */
);
prefs_register_uat_preference(spdu_module, "_spdu_signal_pdus", "Signal PDUs",
"A table to define names of signal PDUs", spdu_messages_uat);
prefs_register_static_text_preference(spdu_module, "empty1", "", NULL);
prefs_register_static_text_preference(spdu_module, "dis", "PDU Dissection:", NULL);
prefs_register_bool_preference(spdu_module, "payload_dissector_activated",
"Dissect Payload",
"Should the payload dissector be active?",
&spdu_derserializer_activated);
prefs_register_bool_preference(spdu_module, "payload_dissector_show_hidden",
"Show hidden entries",
"Should the payload dissector show entries marked as hidden in the configuration?",
&spdu_derserializer_show_hidden);
prefs_register_bool_preference(spdu_module, "payload_dissector_hide_raw_values",
"Hide raw values",
"Should the payload dissector hide raw values?",
&spdu_derserializer_hide_raw_values);
spdu_parameter_value_names_uat = uat_new("Signal Value Names",
sizeof(spdu_signal_value_name_uat_t), DATAFILE_SPDU_VALUE_NAMES, TRUE,
(void**)&spdu_signal_value_names,
&spdu_parameter_value_names_num,
UAT_AFFECTS_DISSECTION,
NULL, /* help */
copy_spdu_signal_value_name_cb,
update_spdu_signal_value_name,
free_spdu_signal_value_name_cb,
post_update_spdu_signal_value_names_cb,
NULL, /* reset */
spdu_parameter_value_name_uat_fields
);
/* value names must be for signals since we need this data for the later */
prefs_register_uat_preference(spdu_module, "_spdu_parameter_value_names", "Value Names",
"A table to define names of signal values", spdu_parameter_value_names_uat);
spdu_signal_list_uat = uat_new("Signal PDU Signal List",
sizeof(spdu_signal_list_uat_t), DATAFILE_SPDU_SIGNALS, TRUE,
(void**)&spdu_signal_list,
&spdu_signal_list_num,
UAT_AFFECTS_DISSECTION|UAT_AFFECTS_FIELDS,
NULL, /* help */
copy_spdu_signal_list_cb,
update_spdu_signal_list,
free_spdu_signal_list_cb,
post_update_spdu_signal_list_cb,
reset_spdu_signal_list,
spdu_signal_list_uat_fields
);
prefs_register_uat_preference(spdu_module, "_spdu_signal_list", "Signal List",
"A table to define names of signals", spdu_signal_list_uat);
prefs_register_static_text_preference(spdu_module, "empty2", "", NULL);
prefs_register_static_text_preference(spdu_module, "map", "Protocol Mappings:", NULL);
spdu_someip_mapping_uat = uat_new("SOME/IP",
sizeof(spdu_someip_mapping_uat_t), DATAFILE_SPDU_SOMEIP_MAPPING, TRUE,
(void**)&spdu_someip_mapping,
&spdu_someip_mapping_num,
UAT_AFFECTS_DISSECTION,
NULL, /* help */
copy_spdu_someip_mapping_cb,
update_spdu_someip_mapping,
NULL,
post_update_spdu_someip_mapping_cb,
NULL, /* reset */
spdu_someip_mapping_uat_fields
);
prefs_register_uat_preference(spdu_module, "_spdu_someip_mapping", "SOME/IP Mappings",
"A table to map SOME/IP payloads to Signal PDUs", spdu_someip_mapping_uat);
spdu_can_mapping_uat = uat_new("CAN",
sizeof(spdu_can_mapping_uat_t), DATAFILE_SPDU_CAN_MAPPING, TRUE,
(void**)&spdu_can_mapping,
&spdu_can_mapping_num,
UAT_AFFECTS_DISSECTION,
NULL, /* help */
copy_spdu_can_mapping_cb,
NULL,
NULL,
post_update_spdu_can_mapping_cb,
NULL, /* reset */
spdu_can_mapping_uat_fields
);
prefs_register_uat_preference(spdu_module, "_spdu_can_mapping", "CAN Mappings",
"A table to map CAN payloads to Signal PDUs", spdu_can_mapping_uat);
spdu_flexray_mapping_uat = uat_new("FlexRay",
sizeof(spdu_flexray_mapping_uat_t), DATAFILE_SPDU_FLEXRAY_MAPPING, TRUE,
(void**)&spdu_flexray_mapping,
&spdu_flexray_mapping_num,
UAT_AFFECTS_DISSECTION,
NULL, /* help */
copy_spdu_flexray_mapping_cb,
update_spdu_flexray_mapping,
NULL,
post_update_spdu_flexray_mapping_cb,
NULL, /* reset */
spdu_flexray_mapping_uat_fields
);
prefs_register_uat_preference(spdu_module, "_spdu_flexray_mapping", "FlexRay Mappings",
"A table to map FlexRay payloads to Signal PDUs", spdu_flexray_mapping_uat);
spdu_lin_mapping_uat = uat_new("LIN",
sizeof(spdu_lin_mapping_uat_t), DATAFILE_SPDU_LIN_MAPPING, TRUE,
(void**)&spdu_lin_mapping,
&spdu_lin_mapping_num,
UAT_AFFECTS_DISSECTION,
NULL, /* help */
copy_spdu_lin_mapping_cb,
update_spdu_lin_mapping,
NULL,
post_update_spdu_lin_mapping_cb,
NULL, /* reset */
spdu_lin_mapping_uat_fields
);
prefs_register_uat_preference(spdu_module, "_spdu_lin_mapping", "LIN Mappings",
"A table to map LIN payloads to Signal PDUs", spdu_lin_mapping_uat);
spdu_pdu_transport_mapping_uat = uat_new("PDU Transport",
sizeof(spdu_pdu_transport_mapping_uat_t), DATAFILE_SPDU_PDU_TRANSPORT_MAPPING, TRUE,
(void**)&spdu_pdu_transport_mapping,
&spdu_pdu_transport_mapping_num,
UAT_AFFECTS_DISSECTION,
NULL, /* help */
copy_spdu_pdu_transport_mapping_cb,
update_spdu_pdu_transport_mapping,
NULL,
post_update_spdu_pdu_transport_mapping_cb,
NULL, /* reset */
spdu_pdu_transport_mapping_uat_fields
);
prefs_register_uat_preference(spdu_module, "_spdu_pdu_transport_mapping", "PDU Transport Mappings",
"A table to map PDU Transport payloads to Signal PDUs", spdu_pdu_transport_mapping_uat);
spdu_ipdum_mapping_uat = uat_new("AUTOSAR I-PduM",
sizeof(spdu_ipdum_mapping_uat_t), DATAFILE_SPDU_IPDUM_MAPPING, TRUE,
(void**)&spdu_ipdum_mapping,
&spdu_ipdum_mapping_num,
UAT_AFFECTS_DISSECTION,
NULL, /* help */
copy_spdu_ipdum_mapping_cb,
update_spdu_ipdum_mapping,
NULL,
post_update_spdu_ipdum_mapping_cb,
NULL, /* reset */
spdu_ipdum_mapping_uat_fields
);
prefs_register_uat_preference(spdu_module, "_spdu_ipdum_mapping", "IPduM Mappings",
"A table to map AUTOSAR I-PduM PDUs to Signal PDUs", spdu_ipdum_mapping_uat);
}
void
proto_reg_handoff_signal_pdu(void) {
static gboolean initialized = FALSE;
if (!initialized) {
signal_pdu_handle_someip = register_dissector("signal_pdu_over_someip", dissect_spdu_message_someip, proto_signal_pdu);
signal_pdu_handle_can = register_dissector("signal_pdu_over_can", dissect_spdu_message_can, proto_signal_pdu);
dissector_add_for_decode_as("can.subdissector", signal_pdu_handle_can);
heur_dissector_add("can", dissect_spdu_message_can_heur, "Signal-PDU-Heuristic", "signal_pdu_can_heur", proto_signal_pdu, HEURISTIC_ENABLE);
signal_pdu_handle_flexray = register_dissector("signal_pdu_over_flexray", dissect_spdu_message_flexray, proto_signal_pdu);
dissector_add_for_decode_as("flexray.subdissector", signal_pdu_handle_flexray);
heur_dissector_add("flexray", dissect_spdu_message_flexray_heur, "Signal-PDU-Heuristic", "signal_pdu_flexray_heur", proto_signal_pdu, HEURISTIC_ENABLE);
signal_pdu_handle_lin = register_dissector("signal_pdu_over_lin", dissect_spdu_message_lin, proto_signal_pdu);
signal_pdu_handle_pdu_transport = register_dissector("signal_pdu_over_pdu_transport", dissect_spdu_message_pdu_transport, proto_signal_pdu);
signal_pdu_handle_ipdum = register_dissector("signal_pdu_over_IPduM", dissect_spdu_message_ipdum, proto_signal_pdu);
initialized = TRUE;
}
}
/*
* Editor modelines
*
* Local Variables:
* c-basic-offset: 4
* tab-width: 8
* indent-tabs-mode: nil
* End:
*
* ex: set shiftwidth=4 tabstop=8 expandtab:
* :indentSize=4:tabSize=8:noTabs=true:
*/
View Git Blame Copy Permalink