/* packet-signal-pdu.c * Signal PDU dissector. * By Dr. Lars Voelker * Copyright 2020-2022 Dr. Lars Voelker * * Wireshark - Network traffic analyzer * By Gerald Combs * 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 #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /* * 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" #define DATAFILE_SPDU_DLT_MAPPING "Signal_PDU_Binding_DLT" #define DATAFILE_SPDU_UDS_MAPPING "Signal_PDU_Binding_UDS" /* 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_pdu_name = -1; static int hf_payload_unparsed = -1; static gint ett_spdu_payload = -1; static gint ett_spdu_signal = -1; static gboolean spdu_deserializer_activated = TRUE; static gboolean spdu_deserializer_show_hidden = FALSE; static gboolean spdu_deserializer_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; static expert_field ef_spdu_unaligned_data = 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 GHashTable *data_spdu_dlt_mappings = NULL; static GHashTable *data_spdu_uds_mappings = NULL; static hf_register_info *dynamic_hf_base_raw = NULL; static hf_register_info *dynamic_hf_agg_sum = NULL; static hf_register_info *dynamic_hf_agg_avg = NULL; static hf_register_info *dynamic_hf_agg_int = NULL; static guint dynamic_hf_number_of_entries = 0; static guint dynamic_hf_base_raw_number = 0; static guint dynamic_hf_agg_sum_number = 0; static guint dynamic_hf_agg_avg_number = 0; static guint dynamic_hf_agg_int_number = 0; #define HF_TYPE_BASE 0 #define HF_TYPE_RAW 1 #define HF_TYPE_AGG_SUM 2 #define HF_TYPE_AGG_AVG 3 #define HF_TYPE_AGG_INT 4 #define HF_TYPE_NONE 0xffff #define HF_TYPE_COUNT_BASE_RAW_TABLE 2 /*********************************************** ********* 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_DATA_TYPE_FLOAT, SPDU_DATA_TYPE_STRING, SPDU_DATA_TYPE_STRINGZ, SPDU_DATA_TYPE_UINT_STRING, } 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; guint encoding; gboolean aggregate_sum; gboolean aggregate_avg; gboolean aggregate_int; gint *hf_id_effective; gint *hf_id_raw; gint *hf_id_agg_sum; gint *hf_id_agg_avg; gint *hf_id_agg_int; } spdu_signal_item_t; typedef struct _spdu_signal_list { guint32 id; guint32 num_of_items; gboolean aggregation; 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; gboolean aggregate_sum; gboolean aggregate_avg; gboolean aggregate_int; } 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; typedef struct _spdu_dlt_mapping { gchar *ecu_id; guint32 dlt_message_id; guint32 message_id; } spdu_dlt_mapping_t; typedef spdu_dlt_mapping_t spdu_dlt_mapping_uat_t; typedef struct _spdu_uds_mapping { guint32 uds_address; guint32 service; gboolean reply; guint32 id; guint32 message_id; } spdu_uds_mapping_t; typedef spdu_uds_mapping_t spdu_uds_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; static spdu_dlt_mapping_t *spdu_dlt_mapping = NULL; static guint spdu_dlt_mapping_num = 0; static spdu_uds_mapping_t *spdu_uds_mapping = NULL; static guint spdu_uds_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); if ((id & CAN_EFF_FLAG) == CAN_EFF_FLAG) { dissector_add_uint("can.extended_id", id & CAN_EFF_MASK, signal_pdu_handle_can); } else { dissector_add_uint("can.id", id & CAN_SFF_MASK, 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) UAT_BOOL_CB_DEF(spdu_signal_list, aggregate_sum, spdu_signal_list_uat_t) UAT_BOOL_CB_DEF(spdu_signal_list, aggregate_avg, spdu_signal_list_uat_t) UAT_BOOL_CB_DEF(spdu_signal_list, aggregate_int, 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; new_rec->aggregate_sum = old_rec->aggregate_sum; new_rec->aggregate_avg = old_rec->aggregate_avg; new_rec->aggregate_int = old_rec->aggregate_int; return new_rec; } static gboolean update_spdu_signal_list(void *r, char **err) { gchar *tmp; guchar c; gdouble scaler; gdouble offset; spdu_signal_list_uat_t *rec = (spdu_signal_list_uat_t *)r; offset = g_ascii_strtod(rec->offset, &tmp); if (!(offset == offset)) { *err = ws_strdup_printf("Offset not a double!"); return FALSE; } scaler = g_ascii_strtod(rec->scaler, &tmp); if (!(scaler == scaler)) { *err = ws_strdup_printf("Scaler not a double!"); return FALSE; } 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 && g_strcmp0(rec->data_type, "float") != 0 && g_strcmp0(rec->data_type, "string") != 0 && g_strcmp0(rec->data_type, "stringz") != 0 && g_strcmp0(rec->data_type, "uint_string") != 0 && g_strcmp0(rec->data_type, "utf_string") != 0 && g_strcmp0(rec->data_type, "utf_stringz") != 0 && g_strcmp0(rec->data_type, "utf_uint_string") != 0) { *err = ws_strdup_printf("Currently the only supported data types are uint, int, float, string, stringz, uint_string, utf_string, utf_stringz, and utf_uint_string (ID: 0x%08x)", rec->id); return FALSE; } /* uint */ if (g_strcmp0(rec->data_type, "uint") == 0) { if ((rec->bitlength_base_type != 8) && (rec->bitlength_base_type != 16) && (rec->bitlength_base_type != 32) && (rec->bitlength_base_type != 64)) { *err = ws_strdup_printf("Data type uint is only supported as 8, 16, 32, or 64 bit base type (ID: 0x%08x)", rec->id); return FALSE; } } /* int */ if (g_strcmp0(rec->data_type, "int") == 0) { if (rec->bitlength_base_type != rec->bitlength_encoded_type) { *err = ws_strdup_printf("Data type int is only supported in non-shortened length (ID: 0x%08x)", rec->id); return FALSE; } if ((rec->bitlength_encoded_type != 8) && (rec->bitlength_encoded_type != 16) && (rec->bitlength_encoded_type != 32) && (rec->bitlength_encoded_type != 64)) { *err = ws_strdup_printf("Data type int is only supported in 8, 16, 32, or 64 bit (ID: 0x%08x)", rec->id); return FALSE; } } /* float */ if (g_strcmp0(rec->data_type, "float") == 0) { if (rec->bitlength_base_type != rec->bitlength_encoded_type) { *err = ws_strdup_printf("Data type float is only supported in non-shortened length (ID: 0x%08x)", rec->id); return FALSE; } if ((rec->bitlength_encoded_type != 32) && (rec->bitlength_encoded_type != 64)) { *err = ws_strdup_printf("Data type float is only supported in 32 or 64 bit (ID: 0x%08x)", rec->id); return FALSE; } if ((scaler != 1.0) || (offset != 0.0)) { *err = ws_strdup_printf("Data type float currently does not support scaling and offset (ID: 0x%08x)", rec->id); return FALSE; } if (rec->multiplexer == TRUE) { *err = ws_strdup_printf("Data type float currently cannot be used as multiplexer (ID: 0x%08x)", rec->id); return FALSE; } } /* string, stringz, uint_string, utf_string, utf_stringz, utf_uint_string */ if (g_strcmp0(rec->data_type, "string") == 0 || g_strcmp0(rec->data_type, "stringz") == 0 || g_strcmp0(rec->data_type, "uint_string") == 0 || g_strcmp0(rec->data_type, "utf_string") == 0 || g_strcmp0(rec->data_type, "utf_stringz") == 0 || g_strcmp0(rec->data_type, "utf_uint_string") == 0) { if ((scaler != 1.0) || (offset != 0.0)) { *err = ws_strdup_printf("Data types string, stringz, uint_string, utf_string, utf_stringz, and utf_uint_string currently do not support scaling and offset (ID: 0x%08x)", rec->id); return FALSE; } if (rec->multiplexer == TRUE) { *err = ws_strdup_printf("Data types string, stringz, uint_string, utf_string, utf_stringz, and utf_uint_string currently cannot be used as multiplexer (ID: 0x%08x)", rec->id);; return FALSE; } if ((g_strcmp0(rec->data_type, "string") == 0 || g_strcmp0(rec->data_type, "stringz") == 0 || g_strcmp0(rec->data_type, "uint_string") == 0) && rec->bitlength_base_type != 8) { *err = ws_strdup_printf("Data types string, stringz, and uint_string only support 8 bit Bitlength base type since they are ASCII-based (ID: 0x%08x)", rec->id); return FALSE; } if ((g_strcmp0(rec->data_type, "utf_string") == 0 || g_strcmp0(rec->data_type, "utf_stringz") == 0 || g_strcmp0(rec->data_type, "utf_uint_string") == 0) && rec->bitlength_base_type != 8 && rec->bitlength_base_type != 16) { *err = ws_strdup_printf("Data types utf_string, utf_stringz, and utf_uint_string only support Bitlength base type with 8 bit (UTF-8) or 16 bit (UTF-16) (ID: 0x%08x)", rec->id); return FALSE; } if ((g_strcmp0(rec->data_type, "stringz") == 0 || g_strcmp0(rec->data_type, "utf_stringz") == 0 ) && (rec->bitlength_encoded_type != 0)) { *err = ws_strdup_printf("Data types stringz and utf_stringz only support Bitlength encoded with 0 bit since the length is determined by zero-termination (ID: 0x%08x)", rec->id); return FALSE; } if ((g_strcmp0(rec->data_type, "uint_string") == 0 || g_strcmp0(rec->data_type, "utf_uint_string") == 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("Data types uint_string and utf_uint_string only support Bitlength encoded with 8, 16, 32, or 64 bit since that defines the length of the length field (ID: 0x%08x)", rec->id); return FALSE; } } if (g_strcmp0(rec->data_type, "uint") != 0 && g_strcmp0(rec->data_type, "int") != 0 && g_strcmp0(rec->data_type, "float") != 0 && (rec->aggregate_sum || rec->aggregate_avg || rec->aggregate_int)) { *err = ws_strdup_printf("Aggregation is only allowed for uint, int, and float (ID: 0x%08x)", rec->id); 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; } if (rec->data_type) { g_free(rec->data_type); rec->data_type = NULL; } if (rec->scaler) { g_free(rec->scaler); rec->scaler = NULL; } if (rec->offset) { g_free(rec->offset); rec->offset = NULL; } } static void deregister_user_data_hfarray(hf_register_info **hf_array, guint *number_of_entries) { if (hf_array == NULL || number_of_entries == NULL) { return; } guint dynamic_hf_size = *number_of_entries; hf_register_info *dynamic_hf = *hf_array; if (dynamic_hf != NULL) { /* Unregister all fields */ for (guint i = 0; i < dynamic_hf_size; i++) { if (dynamic_hf[i].p_id != NULL) { if (*(dynamic_hf[i].p_id) != -1) { 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 would double free this... */ dynamic_hf[i].hfinfo.strings = NULL; } } proto_add_deregistered_data(dynamic_hf); *hf_array = NULL; *number_of_entries = 0; } } static void deregister_user_data(void) { deregister_user_data_hfarray(&dynamic_hf_base_raw, &dynamic_hf_base_raw_number); deregister_user_data_hfarray(&dynamic_hf_agg_sum, &dynamic_hf_agg_sum_number); deregister_user_data_hfarray(&dynamic_hf_agg_avg, &dynamic_hf_agg_avg_number); deregister_user_data_hfarray(&dynamic_hf_agg_int, &dynamic_hf_agg_int_number); dynamic_hf_number_of_entries = 0; } static spdu_signal_value_name_t *get_signal_value_name_config(guint32 id, guint16 pos); static gint* create_hf_entry(hf_register_info *dynamic_hf, guint i, guint32 id, guint32 pos, gchar *name, gchar *filter_string, spdu_dt_t data_type, gboolean scale_or_offset, guint32 hf_type) { val64_string *vs = NULL; gint *hf_id = g_new(gint, 1); *hf_id = -1; 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; switch (hf_type) { case HF_TYPE_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); break; case HF_TYPE_AGG_SUM: dynamic_hf[i].hfinfo.name = ws_strdup_printf("%s_sum", name); dynamic_hf[i].hfinfo.abbrev = ws_strdup_printf("%s.%s_sum", SPDU_NAME_FILTER, filter_string); break; case HF_TYPE_AGG_AVG: dynamic_hf[i].hfinfo.name = ws_strdup_printf("%s_avg", name); dynamic_hf[i].hfinfo.abbrev = ws_strdup_printf("%s.%s_avg", SPDU_NAME_FILTER, filter_string); break; case HF_TYPE_AGG_INT: dynamic_hf[i].hfinfo.name = ws_strdup_printf("%s_int", name); dynamic_hf[i].hfinfo.abbrev = ws_strdup_printf("%s.%s_int", SPDU_NAME_FILTER, filter_string); break; case HF_TYPE_BASE: dynamic_hf[i].hfinfo.name = ws_strdup(name); dynamic_hf[i].hfinfo.abbrev = ws_strdup_printf("%s.%s", SPDU_NAME_FILTER, filter_string); break; case HF_TYPE_NONE: default: /* we bail out but have set hf_id to -1 before */ dynamic_hf[i].hfinfo.name = ws_strdup_printf("%s_none", name);; dynamic_hf[i].hfinfo.abbrev = ws_strdup_printf("%s.%s_none", SPDU_NAME_FILTER, filter_string); return hf_id; } dynamic_hf[i].hfinfo.bitmask = 0; dynamic_hf[i].hfinfo.blurb = NULL; if ((scale_or_offset && hf_type == HF_TYPE_BASE) || hf_type == HF_TYPE_AGG_SUM || hf_type == HF_TYPE_AGG_AVG || hf_type == HF_TYPE_AGG_INT) { 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_FLOAT: dynamic_hf[i].hfinfo.display = BASE_NONE; dynamic_hf[i].hfinfo.type = FT_DOUBLE; break; case SPDU_DATA_TYPE_STRING: dynamic_hf[i].hfinfo.display = BASE_NONE; dynamic_hf[i].hfinfo.type = FT_STRING; break; case SPDU_DATA_TYPE_STRINGZ: dynamic_hf[i].hfinfo.display = BASE_NONE; dynamic_hf[i].hfinfo.type = FT_STRINGZ; break; case SPDU_DATA_TYPE_UINT_STRING: dynamic_hf[i].hfinfo.display = BASE_NONE; dynamic_hf[i].hfinfo.type = FT_UINT_STRING; break; case SPDU_DATA_TYPE_NONE: /* do nothing */ break; } } if (hf_type == HF_TYPE_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) { dynamic_hf_number_of_entries = data_num; /* lets create the dynamic_hf array (base + raw) */ dynamic_hf_base_raw = g_new0(hf_register_info, 2 * dynamic_hf_number_of_entries); dynamic_hf_base_raw_number = 2 * dynamic_hf_number_of_entries; /* lets create the other dynamic_hf arrays */ dynamic_hf_agg_sum = g_new0(hf_register_info, dynamic_hf_number_of_entries); dynamic_hf_agg_sum_number = 0; dynamic_hf_agg_avg = g_new0(hf_register_info, dynamic_hf_number_of_entries); dynamic_hf_agg_avg_number = 0; dynamic_hf_agg_int = g_new0(hf_register_info, dynamic_hf_number_of_entries); dynamic_hf_agg_int_number = 0; 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; item->encoding = ENC_ASCII; if (g_strcmp0("utf_string", data[i].data_type) == 0 || g_strcmp0("utf_stringz", data[i].data_type) == 0 || g_strcmp0("utf_uint_string", data[i].data_type) == 0) { switch (data[i].bitlength_base_type) { case 8: item->encoding = ENC_UTF_8; break; case 16: item->encoding = ENC_UTF_16; break; default: /* this should never happen, since it is validated in the update callback */ item->encoding = ENC_ASCII; break; } } 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 if (g_strcmp0("float", data[i].data_type) == 0) { item->data_type = SPDU_DATA_TYPE_FLOAT; } else if (g_strcmp0("string", data[i].data_type) == 0 || g_strcmp0("utf_string", data[i].data_type) == 0) { item->data_type = SPDU_DATA_TYPE_STRING; } else if (g_strcmp0("stringz", data[i].data_type) == 0 || g_strcmp0("utf_stringz", data[i].data_type) == 0) { item->data_type = SPDU_DATA_TYPE_STRINGZ; } else if (g_strcmp0("uint_string", data[i].data_type) == 0 || g_strcmp0("utf_uint_string", data[i].data_type) == 0) { item->data_type = SPDU_DATA_TYPE_UINT_STRING; } 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->aggregate_sum = data[i].aggregate_sum; item->aggregate_avg = data[i].aggregate_avg; item->aggregate_int = data[i].aggregate_int; /* if one signal needs aggregation, the messages needs to know */ list->aggregation |= item->aggregate_sum | item->aggregate_avg | item->aggregate_int; item->hf_id_effective = create_hf_entry(dynamic_hf_base_raw, HF_TYPE_COUNT_BASE_RAW_TABLE * i + HF_TYPE_BASE, data[i].id, data[i].pos, data[i].name, data[i].filter_string, item->data_type, item->scale_or_offset, HF_TYPE_BASE); item->hf_id_raw = create_hf_entry(dynamic_hf_base_raw, HF_TYPE_COUNT_BASE_RAW_TABLE * i + HF_TYPE_RAW, data[i].id, data[i].pos, data[i].name, data[i].filter_string, item->data_type, item->scale_or_offset, HF_TYPE_RAW); if (data[i].aggregate_sum) { item->hf_id_agg_sum = create_hf_entry(dynamic_hf_agg_sum, dynamic_hf_agg_sum_number++, data[i].id, data[i].pos, data[i].name, data[i].filter_string, item->data_type, item->scale_or_offset, HF_TYPE_AGG_SUM); } if (data[i].aggregate_avg) { item->hf_id_agg_avg = create_hf_entry(dynamic_hf_agg_avg, dynamic_hf_agg_avg_number++, data[i].id, data[i].pos, data[i].name, data[i].filter_string, item->data_type, item->scale_or_offset, HF_TYPE_AGG_AVG); } if (data[i].aggregate_int) { item->hf_id_agg_int = create_hf_entry(dynamic_hf_agg_int, dynamic_hf_agg_int_number++, data[i].id, data[i].pos, data[i].name, data[i].filter_string, item->data_type, item->scale_or_offset, HF_TYPE_AGG_INT); } } } if (dynamic_hf_base_raw_number) { proto_register_field_array(proto_signal_pdu, dynamic_hf_base_raw, dynamic_hf_base_raw_number); } if (dynamic_hf_agg_sum_number) { proto_register_field_array(proto_signal_pdu, dynamic_hf_agg_sum, dynamic_hf_agg_sum_number); } if (dynamic_hf_agg_avg_number) { proto_register_field_array(proto_signal_pdu, dynamic_hf_agg_avg, dynamic_hf_agg_avg_number); } if (dynamic_hf_agg_int_number) { proto_register_field_array(proto_signal_pdu, dynamic_hf_agg_int, dynamic_hf_agg_int_number); } } } 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 gboolean update_spdu_can_mapping(void *r, char **err) { spdu_can_mapping_uat_t *rec = (spdu_can_mapping_uat_t *)r; if ((rec->can_id & (CAN_RTR_FLAG | CAN_ERR_FLAG)) != 0) { *err = g_strdup_printf("We currently do not support CAN IDs with RTR or Error Flag set (CAN_ID: 0x%x)", rec->can_id); return FALSE; } if ((rec->can_id & CAN_EFF_FLAG) == 0 && rec->can_id > CAN_SFF_MASK) { *err = g_strdup_printf("Standard CAN ID (EFF flag not set) cannot be bigger than 0x7ff (CAN_ID: 0x%x)", rec->can_id); return FALSE; } return TRUE; } 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; } /* key is Bus ID, EFF Flag, CAN-ID*/ gint64 key = ((gint64)id & (CAN_EFF_MASK | CAN_EFF_FLAG)) | ((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 = id & (CAN_EFF_MASK | CAN_EFF_FLAG); 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 |= (gint64)(spdu_flexray_mapping[i].cycle & 0xff) << 16; *key |= (gint64)(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); } /* UAT: DLT Mapping */ UAT_CSTRING_CB_DEF(spdu_dlt_mapping, ecu_id, spdu_dlt_mapping_uat_t) UAT_HEX_CB_DEF(spdu_dlt_mapping, dlt_message_id, spdu_dlt_mapping_uat_t) UAT_HEX_CB_DEF(spdu_dlt_mapping, message_id, spdu_dlt_mapping_uat_t) static void * copy_spdu_dlt_mapping_cb(void *n, const void *o, size_t size _U_) { spdu_dlt_mapping_uat_t *new_rec = (spdu_dlt_mapping_uat_t *)n; const spdu_dlt_mapping_uat_t *old_rec = (const spdu_dlt_mapping_uat_t *)o; if (old_rec->ecu_id) { new_rec->ecu_id = g_strdup(old_rec->ecu_id); } else { new_rec->ecu_id = NULL; } new_rec->dlt_message_id = old_rec->dlt_message_id; new_rec->message_id = old_rec->message_id; return new_rec; } static gboolean update_spdu_dlt_mapping(void *r, char **err) { spdu_dlt_mapping_uat_t *rec = (spdu_dlt_mapping_uat_t *)r; if (rec->ecu_id != NULL && strlen(rec->ecu_id) > 4) { *err = ws_strdup_printf("ECU ID can only be up to 4 characters long!"); return FALSE; } return TRUE; } static void post_update_spdu_dlt_mapping_cb(void) { /* destroy old hash table, if it exists */ if (data_spdu_dlt_mappings) { g_hash_table_destroy(data_spdu_dlt_mappings); data_spdu_dlt_mappings = NULL; } /* we don't need to free the data as long as we don't alloc it first */ data_spdu_dlt_mappings = g_hash_table_new_full(g_int64_hash, g_int64_equal, &spdu_payload_free_key, NULL); if (data_spdu_dlt_mappings == NULL || spdu_dlt_mapping == NULL) { return; } if (spdu_dlt_mapping_num > 0) { guint i; for (i = 0; i < spdu_dlt_mapping_num; i++) { gint64 *key = wmem_new(wmem_epan_scope(), gint64); *key = spdu_dlt_mapping[i].dlt_message_id; *key |= (gint64)(dlt_ecu_id_to_gint32(spdu_dlt_mapping[i].ecu_id)) << 32; g_hash_table_insert(data_spdu_dlt_mappings, key, &spdu_dlt_mapping[i]); } } } static spdu_dlt_mapping_uat_t * get_dlt_mapping(guint32 pdu_id, const gchar *ecu_id) { if (data_spdu_dlt_mappings == NULL) { return NULL; } gint64 key = pdu_id; key |= (gint64)dlt_ecu_id_to_gint32(ecu_id) << 32; return (spdu_dlt_mapping_uat_t *)g_hash_table_lookup(data_spdu_dlt_mappings, &key); } /* UAT: UDS Mapping */ UAT_HEX_CB_DEF(spdu_uds_mapping, uds_address, spdu_uds_mapping_uat_t) UAT_HEX_CB_DEF(spdu_uds_mapping, service, spdu_uds_mapping_uat_t) UAT_BOOL_CB_DEF(spdu_uds_mapping, reply, spdu_uds_mapping_uat_t) UAT_HEX_CB_DEF(spdu_uds_mapping, id, spdu_uds_mapping_uat_t) UAT_HEX_CB_DEF(spdu_uds_mapping, message_id, spdu_uds_mapping_uat_t) static void * copy_spdu_uds_mapping_cb(void *n, const void *o, size_t size _U_) { spdu_uds_mapping_uat_t *new_rec = (spdu_uds_mapping_uat_t *)n; const spdu_uds_mapping_uat_t *old_rec = (const spdu_uds_mapping_uat_t *)o; new_rec->uds_address = old_rec->uds_address; new_rec->service = old_rec->service; new_rec->reply = old_rec->reply; new_rec->id = old_rec->id; new_rec->message_id = old_rec->message_id; return new_rec; } static gboolean update_spdu_uds_mapping(void *r, char **err) { spdu_uds_mapping_uat_t *rec = (spdu_uds_mapping_uat_t *)r; if (rec->id > 0xffff) { *err = g_strdup_printf("UDS IDs are only uint16!"); return FALSE; } if (rec->service > 0xff) { *err = g_strdup_printf("UDS Services are only uint8!"); return FALSE; } return TRUE; } static void post_update_spdu_uds_mapping_cb(void) { /* destroy old hash table, if it exists */ if (data_spdu_uds_mappings) { g_hash_table_destroy(data_spdu_uds_mappings); data_spdu_uds_mappings = NULL; } /* we don't need to free the data as long as we don't alloc it first */ data_spdu_uds_mappings = g_hash_table_new_full(g_int64_hash, g_int64_equal, &spdu_payload_free_key, NULL); if (data_spdu_uds_mappings == NULL || spdu_uds_mapping == NULL) { return; } if (spdu_uds_mapping_num > 0) { guint i; guint32 sid; for (i = 0; i < spdu_uds_mapping_num; i++) { gint64 *key = wmem_new(wmem_epan_scope(), gint64); if (spdu_uds_mapping[i].reply) { sid = (0xff & spdu_uds_mapping[i].service) | UDS_REPLY_MASK; } else { sid = (0xff & spdu_uds_mapping[i].service); } *key = (guint64)(spdu_uds_mapping[i].uds_address) | ((guint64)(0xffff & spdu_uds_mapping[i].id) << 32) | ((guint64)sid << 48); g_hash_table_insert(data_spdu_uds_mappings, key, &spdu_uds_mapping[i]); /* Adding with 0xffffffff (ANY) as address too */ key = wmem_new(wmem_epan_scope(), gint64); *key = (guint64)(0xffffffff) | ((guint64)(0xffff & spdu_uds_mapping[i].id) << 32) | ((guint64)sid << 48); g_hash_table_insert(data_spdu_uds_mappings, key, &spdu_uds_mapping[i]); } } } static spdu_uds_mapping_uat_t * get_uds_mapping(uds_info_t *uds_info) { guint32 sid; DISSECTOR_ASSERT(uds_info); if (data_spdu_uds_mappings == NULL) { return NULL; } gint64 *key = wmem_new(wmem_epan_scope(), gint64); if (uds_info->reply) { sid = (0xff & uds_info->service) | UDS_REPLY_MASK; } else { sid = (0xff & uds_info->service); } *key = (guint64)(uds_info->uds_address) | ((guint64)(0xffff & uds_info->id) << 32) | ((guint64)sid << 48); spdu_uds_mapping_uat_t *tmp = (spdu_uds_mapping_uat_t *)g_hash_table_lookup(data_spdu_uds_mappings, key); /* if we cannot find it for the Address, lets look at MAXUINT32 */ if (tmp == NULL) { *key = (guint64)(G_MAXUINT32) | ((guint64)(0xffff & uds_info->id) << 32) | ((guint64)sid << 48); tmp = (spdu_uds_mapping_uat_t *)g_hash_table_lookup(data_spdu_uds_mappings, key); } wmem_free(wmem_epan_scope(), key); return tmp; } /************************************** ******** 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!]"); } static void expert_spdu_unaligned_data(proto_tree *tree, packet_info *pinfo, tvbuff_t *tvb, gint offset, gint length) { proto_tree_add_expert(tree, pinfo, &ef_spdu_unaligned_data, tvb, offset, length); col_append_str(pinfo->cinfo, COL_INFO, " [Signal PDU: Unaligned Data!]"); } /************************************** ******** Aggregation Feature ******** **************************************/ typedef struct _spdu_frame_data { gdouble sum; guint32 count; gdouble avg; gdouble sum_time_value_products; } spdu_frame_data_t; typedef struct _spdu_aggregation { gdouble sum; guint32 count; nstime_t start_time; nstime_t last_time; gdouble last_value; gdouble sum_time_value_products; } spdu_aggregation_t; static wmem_map_t *spdu_aggregation_data = NULL; static spdu_aggregation_t * get_or_create_aggregation_data(packet_info *pinfo, gint hf_id_effective) { DISSECTOR_ASSERT(spdu_aggregation_data != NULL); DISSECTOR_ASSERT(hf_id_effective != -1); spdu_aggregation_t *data = (spdu_aggregation_t *)wmem_map_lookup(spdu_aggregation_data, GINT_TO_POINTER(hf_id_effective)); if (data == NULL) { data = wmem_new0(wmem_file_scope(), spdu_aggregation_t); data->sum = 0; data->count = 0; data->start_time = pinfo->abs_ts; data->last_time = pinfo->abs_ts; data->sum_time_value_products = 0.0; wmem_map_insert(spdu_aggregation_data, GINT_TO_POINTER(hf_id_effective), data); } return data; } /************************************** ******** Dissector Helpers ******** **************************************/ /* There is similar code in tvbuff.c ... */ static gdouble spdu_ieee_double_from_64bits(guint64 value) { union { gdouble d; guint64 w; } ieee_fp_union; ieee_fp_union.w = value; return ieee_fp_union.d; } static gfloat spdu_ieee_float_from_32bits(guint32 value) { union { gfloat d; guint32 w; } ieee_fp_union; ieee_fp_union.w = value; return ieee_fp_union.d; } /************************************** ******** 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) { DISSECTOR_ASSERT(item != NULL); DISSECTOR_ASSERT(item->hf_id_effective != NULL); 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 string_length = 0; 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_deserializer_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); /* we need to reset this because it is reused */ ti = NULL; gdouble value_gdouble = 0.0; switch (item->data_type) { case SPDU_DATA_TYPE_UINT: { 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); 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_FLOAT: { value_gdouble = 0.0; switch (item->bitlength_base_type) { case 64: value_gdouble = spdu_ieee_double_from_64bits(value_guint64); break; case 32: value_gdouble = (gdouble)spdu_ieee_float_from_32bits((guint32)value_guint64); break; default: /* not supported and cannot occur since the config is checked! */ break; } /* scaler, offset, multiplexer not allowed by config checks */ ti = proto_tree_add_double(tree, hf_id_effective, tvb, offset, signal_length, value_gdouble); 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_double(subtree, hf_id_raw, tvb, offset, signal_length, value_gdouble); proto_item_append_text(ti, " [raw: 0x%" PRIx64 "]", value_guint64); } break; case SPDU_DATA_TYPE_STRING: if (offset_bits != 0) { expert_spdu_unaligned_data(tree, pinfo, tvb, offset, 0); } proto_tree_add_item(tree, hf_id_effective, tvb, offset, signal_length, item->encoding); break; case SPDU_DATA_TYPE_STRINGZ: if (offset_bits != 0) { expert_spdu_unaligned_data(tree, pinfo, tvb, offset, 0); } proto_tree_add_item_ret_length(tree, hf_id_effective, tvb, offset, -1, item->encoding, &string_length); string_length *= 8; break; case SPDU_DATA_TYPE_UINT_STRING: if (offset_bits != 0) { expert_spdu_unaligned_data(tree, pinfo, tvb, offset, 0); } if (item->big_endian) { proto_tree_add_item_ret_length(tree, hf_id_effective, tvb, offset, signal_length, item->encoding | ENC_BIG_ENDIAN, &string_length); } else { proto_tree_add_item_ret_length(tree, hf_id_effective, tvb, offset, signal_length, item->encoding | ENC_LITTLE_ENDIAN, &string_length); } string_length = string_length * 8 - (gint)item->bitlength_encoded_type; break; case SPDU_DATA_TYPE_NONE: /* do nothing */ break; } /* hide raw value per default, if effective value is present */ if (spdu_deserializer_hide_raw_values) { proto_item_set_hidden(ti); } /* Value passed in with value_gdouble, tree via subtree. */ if (item->aggregate_sum || item->aggregate_avg || item->aggregate_int) { gint hf_id_eff = *(item->hf_id_effective); spdu_aggregation_t *agg_data = get_or_create_aggregation_data(pinfo, hf_id_eff); spdu_frame_data_t *spdu_frame_data = (spdu_frame_data_t *)p_get_proto_data(wmem_file_scope(), pinfo, proto_signal_pdu, (guint32)hf_id_eff); if (!PINFO_FD_VISITED(pinfo)) { nstime_t delta; agg_data->sum += value_gdouble; agg_data->count++; nstime_delta(&delta, &(pinfo->abs_ts), &(agg_data->last_time)); gdouble delta_s = nstime_to_sec(&delta); if (delta_s > 0.0) { agg_data->sum_time_value_products += delta_s * agg_data->last_value; agg_data->last_time = pinfo->abs_ts; } agg_data->last_value = value_gdouble; if (!spdu_frame_data) { spdu_frame_data = wmem_new0(wmem_file_scope(), spdu_frame_data_t); p_add_proto_data(wmem_file_scope(), pinfo, proto_signal_pdu, (guint32)hf_id_eff, spdu_frame_data); } spdu_frame_data->sum = agg_data->sum; spdu_frame_data->count = agg_data->count; spdu_frame_data->avg = agg_data->sum / agg_data->count; spdu_frame_data->sum_time_value_products = agg_data->sum_time_value_products; } /* if frame data was not created on first pass, we cannot calculate it now */ if (spdu_frame_data != NULL) { if (item->aggregate_sum) { proto_tree_add_double(subtree, *(item->hf_id_agg_sum), tvb, offset, signal_length, spdu_frame_data->sum); } if (item->aggregate_avg) { proto_tree_add_double(subtree, *(item->hf_id_agg_avg), tvb, offset, signal_length, spdu_frame_data->avg); } if (item->aggregate_int && (spdu_frame_data->sum_time_value_products == spdu_frame_data->sum_time_value_products)) { proto_tree_add_double(subtree, *(item->hf_id_agg_int), tvb, offset, signal_length, spdu_frame_data->sum_time_value_products); } } } return (gint)item->bitlength_encoded_type + string_length; } 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); } ti = proto_tree_add_string(tree, hf_pdu_name, tvb, offset, -1, name); proto_item_set_generated(ti); proto_item_set_hidden(ti); } spdu_signal_list_t *paramlist = get_parameter_config(id); if (name == NULL && paramlist == NULL) { /* unknown message, lets skip */ return 0; } if (paramlist == NULL || !spdu_deserializer_activated) { /* we only receive subtvbs with nothing behind us */ proto_tree_add_text_internal(tree, tvb, 0, tvb_captured_length(tvb), "Dissection of payload is disabled. It can be enabled via protocol preferences."); return tvb_captured_length(tvb); } if (root_tree == NULL && !proto_field_is_referenced(root_tree, proto_signal_pdu) && !paramlist->aggregation) { /* 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) { if (offset_bits == 0) { proto_tree_add_item(tree, hf_payload_unparsed, tvb, offset, length - offset, ENC_NA); } else { 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); } static int dissect_spdu_message_dlt_heur(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data) { dlt_info_t *pdu_info = (dlt_info_t *)data; DISSECTOR_ASSERT(pdu_info); spdu_dlt_mapping_uat_t *dlt_mapping = get_dlt_mapping(pdu_info->message_id, pdu_info->ecu_id); if (dlt_mapping == NULL) { return 0; } return dissect_spdu_payload(tvb, pinfo, tree, dlt_mapping->message_id, TRUE); } static gboolean dissect_spdu_message_uds_heur(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data) { uds_info_t *uds_info = (uds_info_t *)data; DISSECTOR_ASSERT(uds_info); spdu_uds_mapping_t *uds_mapping = get_uds_mapping(uds_info); if (uds_mapping == NULL) { return FALSE; } return dissect_spdu_payload(tvb, pinfo, tree, uds_mapping->message_id, FALSE) != 0; } /************************************** ******** 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; uat_t *spdu_dlt_mapping_uat; uat_t *spdu_uds_mapping_uat; /* data fields */ static hf_register_info hf[] = { { &hf_pdu_name, { "Signal PDU Name", "signal_pdu.name", FT_STRING, BASE_NONE, NULL, 0x0, NULL, HFILL }}, { &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|float|string|stringz|uint_string|utf8_string|utf8_stringz|utf8_uint_string]"), 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). The length of the original type or the length of a single character."), UAT_FLD_DEC(spdu_signal_list, bitlength_encoded_type, "Bitlength enc. type", "Bitlength encoded type (uint32 dec). The shortened length of uints or the total length of string/utf8_string or the length of the uint_string/utf8_uint_string length field."), 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_FLD_BOOL(spdu_signal_list, aggregate_sum, "Calc Sum?", "Should this field be aggregated using sum function? [FALSE|TRUE]"), UAT_FLD_BOOL(spdu_signal_list, aggregate_avg, "Calc Avg?", "Should this field be aggregated using average function? [FALSE|TRUE]"), UAT_FLD_BOOL(spdu_signal_list, aggregate_int, "Calc Int?", "Should this field be aggregated using integrate function (sum of time value product)? [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, highest bit 1 for extended, 0 for standard ID)"), 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 uat_field_t spdu_dlt_mapping_uat_fields[] = { UAT_FLD_CSTRING(spdu_dlt_mapping, ecu_id, "ECU ID", "ECU ID (4 ASCII chars only!)"), UAT_FLD_HEX(spdu_dlt_mapping, dlt_message_id, "DLT Message ID", "Message ID (32bit hex without leading 0x)"), UAT_FLD_HEX(spdu_dlt_mapping, message_id, "Signal PDU ID", "ID of the Signal PDU (32bit hex without leading 0x)"), UAT_END_FIELDS }; static uat_field_t spdu_uds_mapping_uat_fields[] = { UAT_FLD_HEX(spdu_uds_mapping, uds_address, "ECU Address", "ECU Address (32bit hex without leading 0x, 0xffffffff means any)"), UAT_FLD_HEX(spdu_uds_mapping, service, "UDS Service", "UDS Service (8bit hex without leading 0x)"), UAT_FLD_BOOL(spdu_uds_mapping, reply, "Reply", "Reply [FALSE|TRUE]"), UAT_FLD_HEX(spdu_uds_mapping, id, "ID", "ID (16bit hex without leading 0x)"), UAT_FLD_HEX(spdu_uds_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} }, { &ef_spdu_unaligned_data, {"signal_pdu.payload.unaligned_data", PI_MALFORMED, PI_ERROR, "Signal PDU: Unaligned data! Strings etc. need to be aligned to bytes!", 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_deserializer_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_deserializer_show_hidden); prefs_register_bool_preference(spdu_module, "payload_dissector_hide_raw_values", "Hide raw values", "Should the payload dissector hide raw values?", &spdu_deserializer_hide_raw_values); spdu_parameter_value_names_uat = uat_new("Signal Value Names", sizeof(spdu_signal_value_name_uat_t), /* record size */ DATAFILE_SPDU_VALUE_NAMES, /* filename */ TRUE, /* from profile */ (void **)&spdu_signal_value_names, /* data_ptr */ &spdu_parameter_value_names_num, /* numitems_ptr */ UAT_AFFECTS_DISSECTION, /* but not fields */ NULL, /* help */ copy_spdu_signal_value_name_cb, /* copy callback */ update_spdu_signal_value_name, /* update callback */ free_spdu_signal_value_name_cb, /* free callback */ post_update_spdu_signal_value_names_cb, /* post update callback */ NULL, /* reset callback */ spdu_parameter_value_name_uat_fields /* UAT field definitions */ ); /* 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), /* record size */ DATAFILE_SPDU_SIGNALS, /* filename */ TRUE, /* from profile */ (void **)&spdu_signal_list, /* data_ptr */ &spdu_signal_list_num, /* numitems_ptr */ UAT_AFFECTS_DISSECTION | UAT_AFFECTS_FIELDS, NULL, /* help */ copy_spdu_signal_list_cb, /* copy callback */ update_spdu_signal_list, /* update callback */ free_spdu_signal_list_cb, /* free callback */ post_update_spdu_signal_list_cb, /* post update callback */ reset_spdu_signal_list, /* reset callback */ spdu_signal_list_uat_fields /* UAT field definitions */ ); static const char *spdu_signal_list_uat_defaults_[] = { NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, "FALSE", "FALSE", "FALSE" }; uat_set_default_values(spdu_signal_list_uat, spdu_signal_list_uat_defaults_); 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), /* record size */ DATAFILE_SPDU_SOMEIP_MAPPING, /* filename */ TRUE, /* from profile */ (void **)&spdu_someip_mapping, /* data_ptr */ &spdu_someip_mapping_num, /* numitems_ptr */ UAT_AFFECTS_DISSECTION, /* but not fields */ NULL, /* help */ copy_spdu_someip_mapping_cb, /* copy callback */ update_spdu_someip_mapping, /* update callback */ NULL, /* free callback */ post_update_spdu_someip_mapping_cb, /* post update callback */ NULL, /* reset callback */ spdu_someip_mapping_uat_fields /* UAT field definitions */ ); 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), /* record size */ DATAFILE_SPDU_CAN_MAPPING, /* filename */ TRUE, /* from profile */ (void **)&spdu_can_mapping, /* data_ptr */ &spdu_can_mapping_num, /* numitems_ptr */ UAT_AFFECTS_DISSECTION, /* but not fields */ NULL, /* help */ copy_spdu_can_mapping_cb, /* copy callback */ update_spdu_can_mapping, /* update callback */ NULL, /* free callback */ post_update_spdu_can_mapping_cb, /* post update callback */ NULL, /* reset callback */ spdu_can_mapping_uat_fields /* UAT field definitions */ ); 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), /* record size */ DATAFILE_SPDU_FLEXRAY_MAPPING, /* filename */ TRUE, /* from profile */ (void **)&spdu_flexray_mapping, /* data_ptr */ &spdu_flexray_mapping_num, /* numitems_ptr */ UAT_AFFECTS_DISSECTION, /* but not fields */ NULL, /* help */ copy_spdu_flexray_mapping_cb, /* copy callback */ update_spdu_flexray_mapping, /* update callback */ NULL, /* free callback */ post_update_spdu_flexray_mapping_cb, /* post update callback */ NULL, /* reset callback */ spdu_flexray_mapping_uat_fields /* UAT field definitions */ ); 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), /* record size */ DATAFILE_SPDU_LIN_MAPPING, /* filename */ TRUE, /* from profile */ (void **)&spdu_lin_mapping, /* data_ptr */ &spdu_lin_mapping_num, /* numitems_ptr */ UAT_AFFECTS_DISSECTION, /* but not fields */ NULL, /* help */ copy_spdu_lin_mapping_cb, /* copy callback */ update_spdu_lin_mapping, /* update callback */ NULL, /* free callback */ post_update_spdu_lin_mapping_cb, /* post update callback */ NULL, /* reset callback */ spdu_lin_mapping_uat_fields /* UAT field definitions */ ); 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), /* record size */ DATAFILE_SPDU_PDU_TRANSPORT_MAPPING, /* filename */ TRUE, /* from profile */ (void **)&spdu_pdu_transport_mapping, /* data_ptr */ &spdu_pdu_transport_mapping_num, /* numitems_ptr */ UAT_AFFECTS_DISSECTION, /* but not fields */ NULL, /* help */ copy_spdu_pdu_transport_mapping_cb, /* copy callback */ update_spdu_pdu_transport_mapping, /* update callback */ NULL, /* free callback */ post_update_spdu_pdu_transport_mapping_cb, /* post update callback */ NULL, /* reset callback */ spdu_pdu_transport_mapping_uat_fields /* UAT field definitions */ ); 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), /* record size */ DATAFILE_SPDU_IPDUM_MAPPING, /* filename */ TRUE, /* from profile */ (void **)&spdu_ipdum_mapping, /* data_ptr */ &spdu_ipdum_mapping_num, /* numitems_ptr */ UAT_AFFECTS_DISSECTION, /* but not fields */ NULL, /* help */ copy_spdu_ipdum_mapping_cb, /* copy callback */ update_spdu_ipdum_mapping, /* update callback */ NULL, /* free callback */ post_update_spdu_ipdum_mapping_cb, /* post update callback */ NULL, /* reset callback */ spdu_ipdum_mapping_uat_fields /* UAT field definitions */ ); 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); spdu_dlt_mapping_uat = uat_new("DLT", sizeof(spdu_dlt_mapping_uat_t), /* record size */ DATAFILE_SPDU_DLT_MAPPING, /* filename */ TRUE, /* from profile */ (void **)&spdu_dlt_mapping, /* data_ptr */ &spdu_dlt_mapping_num, /* numitems_ptr */ UAT_AFFECTS_DISSECTION, /* but not fields */ NULL, /* help */ copy_spdu_dlt_mapping_cb, /* copy callback */ update_spdu_dlt_mapping, /* update callback */ NULL, /* free callback */ post_update_spdu_dlt_mapping_cb, /* post update callback */ NULL, /* reset callback */ spdu_dlt_mapping_uat_fields /* UAT field definitions */ ); prefs_register_uat_preference(spdu_module, "_spdu_dlt_mapping", "DLT Mappings", "A table to map DLT non-verbose Payloads to Signal PDUs", spdu_dlt_mapping_uat); spdu_uds_mapping_uat = uat_new("UDS", sizeof(spdu_uds_mapping_uat_t), /* record size */ DATAFILE_SPDU_UDS_MAPPING, /* filename */ TRUE, /* from profile */ (void **)&spdu_uds_mapping, /* data_ptr */ &spdu_uds_mapping_num, /* numitems_ptr */ UAT_AFFECTS_DISSECTION, /* but not fields */ NULL, /* help */ copy_spdu_uds_mapping_cb, /* copy callback */ update_spdu_uds_mapping, /* update callback */ NULL, /* free callback */ post_update_spdu_uds_mapping_cb, /* post update callback */ NULL, /* reset callback */ spdu_uds_mapping_uat_fields /* UAT field definitions */ ); prefs_register_uat_preference(spdu_module, "_spdu_uds_mapping", "UDS Mappings", "A table to map UDS payloads to Signal PDUs", spdu_uds_mapping_uat); /* Aggregation Feature */ spdu_aggregation_data = wmem_map_new_autoreset(wmem_epan_scope(), wmem_file_scope(), g_direct_hash, g_direct_equal); } 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 over CAN", "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 over FlexRay", "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); heur_dissector_add("dlt", dissect_spdu_message_dlt_heur, "Signal PDU over DLT", "signal_pdu_dlt_heur", proto_signal_pdu, HEURISTIC_ENABLE); heur_dissector_add("uds", dissect_spdu_message_uds_heur, "Signal PDU over UDS", "signal_pdu_uds_heur", proto_signal_pdu, HEURISTIC_ENABLE); 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: */