forked from osmocom/wireshark
![Peter Wu](/assets/img/avatar_default.png)
This patch moves g_hash_table_destroy calls from the init routine to the cleanup routine. Besides that, the conditional check for the hash table has been removed, assuming that init is always paired with a cleanup call. If reassembly_table_init is found, a reassembly_table_destroy call is prepended to the cleanup function as well. Comments have been removed from the init function as well as these did not seem to have additional value ("destroy hash table" is clear from the context). The changes were automatically generated using https://git.lekensteyn.nl/peter/wireshark-notes/diff/one-off/cleanup-rewrite.py?id=4d11f07180d9c115eb14bd860e9a47d82d3d1dcd Manually edited files (for assignment auditing): dvbci, ositp, sccp, tcp. Other files that needed special attention due to the use of register_postseq_cleanup_routine: - ipx: keep call, do not add another cleanup routine. - ncp: remove empty mncp_postseq_cleanup. mncp_hash_lookup is used even if a frame is visited before (see dissect_ncp_common), hence the hash table cannot be destroyed here. Do it in cleanup instead. - ndps: add cleanup routine to kill reassembly table, but do not destroy the hash table as it is already done in ndps_postseq_cleanup. Change-Id: I95a72b3df2978b2c13fefff6bd6821442193d0ed Reviewed-on: https://code.wireshark.org/review/9223 Reviewed-by: Michael Mann <mmann78@netscape.net>
2349 lines
125 KiB
C
2349 lines
125 KiB
C
/* packet-sbus.c
|
|
* Routines for Ether-S-Bus dissection
|
|
* Copyright 2010, Christian Durrer <christian.durrer@sensemail.ch>
|
|
*
|
|
* Wireshark - Network traffic analyzer
|
|
* By Gerald Combs <gerald@wireshark.org>
|
|
* Copyright 1998 Gerald Combs
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
*/
|
|
|
|
#include "config.h"
|
|
|
|
#include <epan/packet.h>
|
|
#include <epan/conversation.h>
|
|
#include <epan/expert.h>
|
|
|
|
void proto_register_sbus(void);
|
|
void proto_reg_handoff_sbus(void);
|
|
|
|
/* Attribute values*/
|
|
#define SBUS_REQUEST 0x00
|
|
#define SBUS_RESPONSE 0x01
|
|
#define SBUS_ACKNAK 0x02
|
|
|
|
/*SBus command codes*/
|
|
#define SBUS_RD_COUNTER 0x00
|
|
#define SBUS_RD_DISPLAY_REGISTER 0x01
|
|
#define SBUS_RD_FLAG 0x02
|
|
#define SBUS_RD_INPUT 0x03
|
|
#define SBUS_RD_RTC 0x04
|
|
#define SBUS_RD_OUTPUT 0x05
|
|
#define SBUS_RD_REGISTER 0x06
|
|
#define SBUS_RD_TIMER 0x07
|
|
#define SBUS_WR_COUNTER 0x0A
|
|
#define SBUS_WR_FLAG 0x0B
|
|
#define SBUS_WR_RTC 0x0C
|
|
#define SBUS_WR_OUTPUT 0x0D
|
|
#define SBUS_WR_REGISTER 0x0E
|
|
#define SBUS_WR_TIMER 0x0F
|
|
#define SBUS_RDWR_MULTI_MEDIAS 0x13
|
|
#define SBUS_RD_PCD_STATUS_CPU0 0x14
|
|
#define SBUS_RD_PCD_STATUS_CPU1 0x15
|
|
#define SBUS_RD_PCD_STATUS_CPU2 0x16
|
|
#define SBUS_RD_PCD_STATUS_CPU3 0x17
|
|
#define SBUS_RD_PCD_STATUS_CPU4 0x18
|
|
#define SBUS_RD_PCD_STATUS_CPU5 0x19
|
|
#define SBUS_RD_PCD_STATUS_CPU6 0x1A
|
|
#define SBUS_RD_PCD_STATUS_OWN 0x1B
|
|
#define SBUS_RD_SBUS_STN_NBR 0x1D
|
|
#define SBUS_RD_USER_MEMORY 0x1E
|
|
#define SBUS_RD_PROGRAM_LINE 0x1F
|
|
#define SBUS_RD_PROGRAM_VERSION 0x20
|
|
#define SBUS_RD_TEXT 0x21
|
|
#define SBUS_RD_ACTIVE_TRANSITION 0x22
|
|
#define SBUS_WR_USER_MEMORY 0x23
|
|
#define SBUS_WR_PROGRAM_LINE 0x24
|
|
#define SBUS_WR_TEXT 0x25
|
|
#define SBUS_RUN_PROCEDURE_CPU0 0x28
|
|
#define SBUS_RUN_PROCEDURE_CPU1 0x29
|
|
#define SBUS_RUN_PROCEDURE_CPU2 0x2A
|
|
#define SBUS_RUN_PROCEDURE_CPU3 0x2B
|
|
#define SBUS_RUN_PROCEDURE_CPU4 0x2C
|
|
#define SBUS_RUN_PROCEDURE_CPU5 0x2D
|
|
#define SBUS_RUN_PROCEDURE_CPU6 0x2E
|
|
#define SBUS_RUN_PROCEDURE_OWN 0x2F
|
|
#define SBUS_RUN_PROCEDURE_ALL 0x30
|
|
#define SBUS_RESTART_COLD_CPU1 0x32
|
|
#define SBUS_RESTART_COLD_CPU2 0x33
|
|
#define SBUS_RESTART_COLD_CPU3 0x34
|
|
#define SBUS_RESTART_COLD_CPU4 0x35
|
|
#define SBUS_RESTART_COLD_CPU5 0x36
|
|
#define SBUS_RESTART_COLD_CPU6 0x37
|
|
#define SBUS_RESTART_COLD_OWN 0x38
|
|
#define SBUS_RESTART_COLD_ALL 0x39
|
|
#define SBUS_STOP_PROCEDURE_CPU0 0x3C
|
|
#define SBUS_STOP_PROCEDURE_CPU1 0x3D
|
|
#define SBUS_STOP_PROCEDURE_CPU2 0x3E
|
|
#define SBUS_STOP_PROCEDURE_CPU3 0x3F
|
|
#define SBUS_STOP_PROCEDURE_CPU4 0x40
|
|
#define SBUS_STOP_PROCEDURE_CPU5 0x41
|
|
#define SBUS_STOP_PROCEDURE_CPU6 0x42
|
|
#define SBUS_STOP_PROCEDURE_OWN 0x43
|
|
#define SBUS_STOP_PROCEDURE_ALL 0x44
|
|
#define SBUS_RD_STATUSFLAG_ACCU 0x46
|
|
#define SBUS_RD_BYTE 0x47
|
|
#define SBUS_RD_HALT_FAILURE_REG 0x48
|
|
#define SBUS_RD_INDEX_REGISTER 0x49
|
|
#define SBUS_RD_INSTRUCTION_POINTER 0x4A
|
|
#define SBUS_FIND_HISTORY 0x4B
|
|
#define SBUS_WR_STATUSFLAG_ACCU 0x50
|
|
#define SBUS_WR_BYTE 0x51
|
|
#define SBUS_WR_INDEX_REGISTER 0x52
|
|
#define SBUS_WR_INSTRUCTION_POINTER 0x53
|
|
#define SBUS_CLEAR_ALL 0x5A
|
|
#define SBUS_CLEAR_FLAGS 0x5B
|
|
#define SBUS_CLEAR_OUTPUTS 0x5C
|
|
#define SBUS_CLEAR_REGISTERS 0x5D
|
|
#define SBUS_CLEAR_TIMERS 0x5E
|
|
#define SBUS_RESTART_WARM_CPU1 0x64
|
|
#define SBUS_RESTART_WARM_CPU2 0x65
|
|
#define SBUS_RESTART_WARM_CPU3 0x66
|
|
#define SBUS_RESTART_WARM_CPU4 0x67
|
|
#define SBUS_RESTART_WARM_CPU5 0x68
|
|
#define SBUS_RESTART_WARM_CPU6 0x69
|
|
#define SBUS_RESTART_WARM_OWN 0x6A
|
|
#define SBUS_RESTART_WARM_ALL 0x6B
|
|
#define SBUS_CHANGE_BLOCK 0x6E
|
|
#define SBUS_CLEAR_HISTORY_FAILURE 0x6F
|
|
#define SBUS_DELETE_PROGRAM_LINE 0x70
|
|
#define SBUS_GO_CONDITIONAL 0x71
|
|
#define SBUS_INSERT_PROGRAM_LINE 0x72
|
|
#define SBUS_LOCAL_CYCLE 0x73
|
|
#define SBUS_ALL_CYCLES 0x74
|
|
#define SBUS_MAKE_TEXT 0x75
|
|
#define SBUS_EXECUTE_SINGLE_INSTR 0x76
|
|
#define SBUS_SINGLE_STEP 0x77
|
|
#define SBUS_XOB_17_INTERRUPT 0x82
|
|
#define SBUS_XOB_18_INTERRUPT 0x83
|
|
#define SBUS_XOB_19_INTERRUPT 0x84
|
|
#define SBUS_RD_HANGUP_TIMEOUT 0x91
|
|
#define SBUS_RD_DATA_BLOCK 0x96
|
|
#define SBUS_WR_DATA_BLOCK 0x97
|
|
#define SBUS_MAKE_DATA_BLOCK 0x98
|
|
#define SBUS_CLEAR_DATA_BLOCK 0x99
|
|
#define SBUS_CLEAR_TEXT 0x9A
|
|
#define SBUS_RD_BLOCK_ADDRESSES 0x9B
|
|
#define SBUS_RD_BLOCK_SIZES 0x9C
|
|
#define SBUS_RD_CURRENT_BLOCK 0x9D
|
|
#define SBUS_RD_CALL_STACK 0x9E
|
|
#define SBUS_RD_DBX 0x9F
|
|
#define SBUS_RD_USER_EEPROM_REGISTER 0xA1
|
|
#define SBUS_WR_USER_EEPROM_REGISTER 0xA3
|
|
#define SBUS_ERASE_FLASH 0xA5
|
|
#define SBUS_RESTART_COLD_FLAG 0xA6
|
|
#define SBUS_WR_SYSTEM_BUFFER 0xA7
|
|
#define SBUS_RD_SYSTEM_BUFFER 0xA8
|
|
#define SBUS_RD_WR_PCD_BLOCK 0xA9
|
|
#define SBUS_GET_DIAGNOSTIC 0xAA
|
|
#define SBUS_RD_SYSTEM_INFORMATION 0xAB
|
|
#define SBUS_CHANGE_BLOCKS_ON_RUN 0xAC
|
|
#define SBUS_FLASHCARD_TELEGRAM 0xAD
|
|
#define SBUS_DOWNLOAD_FIRMWARE 0xAE
|
|
#define SBUS_WEB_SERVER_SERIAL_COMM 0xAF
|
|
|
|
/* Bitfield in the arithmetic flags and accu*/
|
|
#define F_ACCU (1<<0) /* Accumulator of PCD */
|
|
#define F_ERROR (1<<1) /* Error flag of PCD */
|
|
#define F_NEGATIVE (1<<2) /* Negative arithmetic status flag */
|
|
#define F_ZERO (1<<3) /* Zero arithmetic status flag */
|
|
|
|
/* Bitfield in the system information*/
|
|
/*#define F_EMPTY (1<<0) always 0 */
|
|
#define F_MEMSIZE (1<<1) /* Memory size information */
|
|
#define F_TRACE (1<<2) /* Trace buffer feature */
|
|
#define F_INFO_B1 (1<<3) /* EEPROM information of slot B1 */
|
|
#define F_INFO_B2 (1<<4) /* EEPROM information of slot B2 */
|
|
#define F_PGU_BAUD (1<<5) /* PGU baudrate can be switched */
|
|
|
|
|
|
/* Read/write block command codes*/
|
|
#define SBUS_WR_START_OF_STREAM 0x00
|
|
#define SBUS_WR_BLOCK_DATA_STREAM 0x01
|
|
#define SBUS_WR_BLOCK_END_OF_STREAM 0x02
|
|
#define SBUS_WR_ABORT_BLOCK_STREAM 0x07
|
|
#define SBUS_WR_BLOCK_DATA_BYTES 0x08
|
|
#define SBUS_RD_BLOCK_START_OF_STREAM 0X10
|
|
#define SBUS_RD_BLOCK_DATA_STREAM 0x11
|
|
#define SBUS_RD_ABORT_BLOCK_STREAM 0x17
|
|
#define SBUS_RD_BLOCK_DATA_BYTES 0x18
|
|
#define SBUS_DELETE_BLOCK 0x20
|
|
#define SBUS_GET_BLOCK_SIZE 0x21
|
|
#define SBUS_GET_PROGRAM_BLOCK_LIST 0x22
|
|
|
|
/* Read/write block types*/
|
|
#define SBUS_RD_WR_CONFIGURATION_FILE 0x20
|
|
#define SBUS_RD_WR_PROGRAM_BLOCK_FILE 0x21
|
|
#define SBUS_RD_WR_UNKNOWN_BLOCK_TYPE 0x83
|
|
|
|
/* Read/write block error codes*/
|
|
#define SBUS_RD_WR_NAK 0x80
|
|
#define SBUS_RD_WR_NAK_INVALID_SIZE 0x8A
|
|
|
|
/* Initialize the protocol and registered fields */
|
|
static int proto_sbus = -1;
|
|
static int hf_sbus_length = -1;
|
|
static int hf_sbus_version = -1;
|
|
static int hf_sbus_protocol = -1;
|
|
static int hf_sbus_sequence = -1;
|
|
static int hf_sbus_attribut = -1;
|
|
static int hf_sbus_dest = -1;
|
|
static int hf_sbus_address = -1;
|
|
static int hf_sbus_command = -1;
|
|
static int hf_sbus_command_extension = -1;
|
|
static int hf_sbus_rcount = -1;
|
|
static int hf_sbus_wcount = -1;
|
|
static int hf_sbus_wcount_calculated = -1;
|
|
static int hf_sbus_fio_count = -1;
|
|
static int hf_sbus_addr_rtc = -1;
|
|
static int hf_sbus_addr_iof = -1;
|
|
static int hf_sbus_addr_eeprom = -1;
|
|
static int hf_sbus_addr_prog = -1;
|
|
static int hf_sbus_addr_68k = -1;
|
|
static int hf_sbus_block_type = -1;
|
|
static int hf_sbus_block_nr = -1;
|
|
static int hf_sbus_nbr_elements = -1;
|
|
static int hf_sbus_display_register = -1;
|
|
static int hf_sbus_data_rtc = -1;
|
|
static int hf_sbus_data_byte = -1;
|
|
static int hf_sbus_data_byte_hex = -1;
|
|
static int hf_sbus_data_iof = -1;
|
|
static int hf_sbus_cpu_type = -1;
|
|
static int hf_sbus_fw_version = -1;
|
|
static int hf_sbus_sysinfo_nr = -1;
|
|
static int hf_sbus_sysinfo0_1 = -1;
|
|
static int hf_sbus_sysinfo0_2 = -1;
|
|
static int hf_sbus_sysinfo0_3 = -1;
|
|
static int hf_sbus_sysinfo0_4 = -1;
|
|
static int hf_sbus_sysinfo0_5 = -1;
|
|
/* static int hf_sbus_sysinfo_length = -1; */
|
|
/* static int hf_sbus_f_module_type = -1; */
|
|
/* static int hf_sbus_harware_version = -1; */
|
|
/* static int hf_sbus_hardware_modification = -1; */
|
|
/* static int hf_sbus_various = -1; */
|
|
static int hf_sbus_acknackcode = -1;
|
|
static int hf_sbus_cpu_status = -1;
|
|
static int hf_sbus_week_day = -1;
|
|
static int hf_sbus_date = -1;
|
|
static int hf_sbus_time = -1;
|
|
static int hf_sbus_crc = -1;
|
|
static int hf_sbus_crc_bad = -1;
|
|
static int hf_sbus_flags_accu = -1;
|
|
static int hf_sbus_flags_error = -1;
|
|
static int hf_sbus_flags_negative = -1;
|
|
static int hf_sbus_flags_zero = -1;
|
|
/* Web server telegram */
|
|
static int hf_sbus_web_size = -1;
|
|
static int hf_sbus_web_aid = -1;
|
|
static int hf_sbus_web_seq = -1;
|
|
/* Read/Write block telegram*/
|
|
static int hf_sbus_rdwr_block_length = -1;
|
|
static int hf_sbus_rdwr_block_length_ext = -1;
|
|
static int hf_sbus_rdwr_telegram_type = -1;
|
|
static int hf_sbus_rdwr_telegram_sequence = -1;
|
|
static int hf_sbus_rdwr_block_size = -1;
|
|
static int hf_sbus_rdwr_block_addr = -1;
|
|
static int hf_sbus_rdwr_file_name = -1;
|
|
static int hf_sbus_rdwr_list_type = -1;
|
|
static int hf_sbus_rdwr_acknakcode = -1;
|
|
/* Request-Response tracking */
|
|
static int hf_sbus_response_in = -1;
|
|
static int hf_sbus_response_to = -1;
|
|
static int hf_sbus_response_time = -1;
|
|
static int hf_sbus_timeout = -1;
|
|
static int hf_sbus_request_in = -1;
|
|
|
|
/* Initialize the subtree pointers */
|
|
static gint ett_sbus = -1;
|
|
static gint ett_sbus_ether = -1;
|
|
static gint ett_sbus_data = -1;
|
|
|
|
static expert_field ei_sbus_retry = EI_INIT;
|
|
static expert_field ei_sbus_telegram_not_acked = EI_INIT;
|
|
static expert_field ei_sbus_crc_bad = EI_INIT;
|
|
static expert_field ei_sbus_telegram_not_implemented = EI_INIT;
|
|
static expert_field ei_sbus_no_request_telegram = EI_INIT;
|
|
|
|
/* True/False strings*/
|
|
static const true_false_string tfs_sbus_flags= {
|
|
"Is high",
|
|
"Is low"
|
|
};
|
|
|
|
static const true_false_string tfs_sbus_present= {
|
|
"Is present",
|
|
"Is not present"
|
|
};
|
|
|
|
/* value to string definitions*/
|
|
/* telegram types*/
|
|
static const value_string sbus_att_vals[] = {
|
|
{0, "Request"},
|
|
{1, "Response"},
|
|
{2, "ACK/NAK"},
|
|
{0, NULL}
|
|
};
|
|
/* Block types*/
|
|
static const value_string sbus_block_types[] = {
|
|
{0x00, "COB"}, /* Cyclic organization block */
|
|
{0x01, "XOB"}, /* Exception organization block */
|
|
{0x02, "PB"}, /* Program block */
|
|
{0x03, "FB"}, /* Function block */
|
|
{0x04, "ST"}, /* Step of Graftec structure*/
|
|
{0x05, "TR"}, /* Transition of Graftec structure*/
|
|
#if 0 /* XXX: Dup vals: should be 0x06 & 0x07 ?? */
|
|
{0x04, "TEXT"}, /* Text*/
|
|
{0x05, "DB"}, /* Data Block*/
|
|
#endif
|
|
{0x08, "SB"}, /* Sequential Block (Graftec)*/
|
|
{0x09, "DBX"}, /* Special Data Block*/
|
|
{0x10, "BACnet"}, /* BACnet configuration block */
|
|
{0x11, "CANopen"}, /* CANopen configuration */
|
|
{0x12, "LONIP"}, /* LONIP configuration */
|
|
{0x20, "Configuration file"}, /* LONIP configuration */
|
|
{0x21, "Program block file"}, /* LONIP configuration */
|
|
{0xFE, "All configuration blocks"}, /* all configuration blocks (delete blocks only) */
|
|
{0xFF, "All blocks"}, /* all blocks (incl. program blocks) (delete blocks only) */
|
|
{0, NULL}
|
|
};
|
|
static value_string_ext sbus_block_types_ext = VALUE_STRING_EXT_INIT(sbus_block_types);
|
|
|
|
/* ACK NAK values*/
|
|
static const value_string sbus_CPU_status[] = {
|
|
{0x43, "C"},
|
|
{0x44, "D"},
|
|
{0x48, "Halt"},
|
|
{0x52, "Run"},
|
|
{0x53, "Stop"},
|
|
{0x58, "X, Exceptional Intermediate Status (MODEMS+)"},
|
|
{0, NULL}
|
|
};
|
|
/* CPU status*/
|
|
static const value_string sbus_ack_nak_vals[] = {
|
|
{0, "ACK (Acknowledged)"},
|
|
{1, "NAK, no reason specified"},
|
|
{2, "NAK, because of password"},
|
|
{3, "NAK, PGU port is in reduced protocol"},
|
|
{4, "NAK, PGU port is already used"},
|
|
{0, NULL}
|
|
};
|
|
/* S-Bus commands*/
|
|
static const value_string sbus_command_vals[] = {
|
|
{0x00, "Read counter(s)"},
|
|
{0x01, "Read display register"},
|
|
{0x02, "Read flag(s)"},
|
|
{0x03, "Read input(s)"},
|
|
{0x04, "Read real time clock"},
|
|
{0x05, "Read output(s)"},
|
|
{0x06, "Read register(s)"},
|
|
{0x07, "Read timer(s)"},
|
|
{0x0A, "Write counter(s)"},
|
|
{0x0B, "Write flag(s)"},
|
|
{0x0C, "Write real time clock"},
|
|
{0x0D, "Write output(s)"},
|
|
{0x0E, "Write register(s)"},
|
|
{0x0F, "Write timer(s)"},
|
|
{0x14, "Read PCD status, CPU 0"},
|
|
{0x15, "Read PCD status, CPU 1"},
|
|
{0x16, "Read PCD status, CPU 2"},
|
|
{0x17, "Read PCD status, CPU 3"},
|
|
{0x18, "Read PCD status, CPU 4"},
|
|
{0x19, "Read PCD status, CPU 5"},
|
|
{0x1A, "Read PCD status, CPU 6"},
|
|
{0x1B, "Read PCD status (own)"},
|
|
{0x1D, "Read S-Bus station number"},
|
|
{0x1E, "Read user memory*"},
|
|
{0x1F, "Read program line*"},
|
|
{0x20, "Read firmware version"},
|
|
{0x21, "Read text*"},
|
|
{0x22, "Read active transition*"},
|
|
{0x23, "Write user memory*"},
|
|
{0x24, "Write program line*"},
|
|
{0x25, "Write text*"},
|
|
{0x28, "Run procedure*, CPU 0"},
|
|
{0x29, "Run procedure*, CPU 1"},
|
|
{0x2A, "Run procedure*, CPU 2"},
|
|
{0x2B, "Run procedure*, CPU 3"},
|
|
{0x2C, "Run procedure*, CPU 4"},
|
|
{0x2D, "Run procedure*, CPU 5"},
|
|
{0x2E, "Run procedure*, CPU 6"},
|
|
{0x2F, "Run procedure* (own CPU)"},
|
|
{0x30, "Run procedure* (All CPUs)"},
|
|
{0x32, "Restart cold CPU 1*"},
|
|
{0x33, "Restart cold CPU 2*"},
|
|
{0x34, "Restart cold CPU 3*"},
|
|
{0x35, "Restart cold CPU 4*"},
|
|
{0x36, "Restart cold CPU 5*"},
|
|
{0x37, "Restart cold CPU 6*"},
|
|
{0x38, "Restart cold own CPU*"},
|
|
{0x39, "Restart cold all CPUs*"},
|
|
{0x3C, "Stop procedure*, CPU 0"},
|
|
{0x3D, "Stop procedure*, CPU 1"},
|
|
{0x3E, "Stop procedure*, CPU 2"},
|
|
{0x3F, "Stop procedure*, CPU 3"},
|
|
{0x40, "Stop procedure*, CPU 4"},
|
|
{0x41, "Stop procedure*, CPU 5"},
|
|
{0x42, "Stop procedure*, CPU 6"},
|
|
{0x43, "Stop procedure*, (own CPU)"},
|
|
{0x44, "Stop procedure*, (All CPUs)"},
|
|
{0x46, "Read arithmetic status and ACCU*"},
|
|
{0x47, "Read byte"},
|
|
{0x48, "Read halt failure register*"},
|
|
{0x49, "Read index register*"},
|
|
{0x4A, "Read instruction pointer*"},
|
|
{0x4B, "Find history*"},
|
|
{0x50, "Write arithmetic staus and ACCU*"},
|
|
{0x51, "Write byte*"},
|
|
{0x52, "Write index register"},
|
|
{0x53, "Write instruction pointer*"},
|
|
{0x5A, "Clear all (F, O, R, T)*"},
|
|
{0x5B, "Clear flags*"},
|
|
{0x5C, "Clear outputs*"},
|
|
{0x5D, "Clear registers*"},
|
|
{0x5E, "Clear timers*"},
|
|
{0x64, "Restart warm CPU 1*"},
|
|
{0x65, "Restart warm CPU 2*"},
|
|
{0x66, "Restart warm CPU 3*"},
|
|
{0x67, "Restart warm CPU 4*"},
|
|
{0x68, "Restart warm CPU 5*"},
|
|
{0x69, "Restart warm CPU 6*"},
|
|
{0x6A, "Restart warm (own CPU)*"},
|
|
{0x6B, "Restart warm (All CPUs)*"},
|
|
{0x6E, "Change block*"},
|
|
{0x6F, "Clear history failure*"},
|
|
{0x70, "Delete program line*"},
|
|
{0x71, "Go conditional*"},
|
|
{0x72, "Insert program line*"},
|
|
{0x73, "Local cycles*"},
|
|
{0x74, "All cycles*"},
|
|
{0x75, "Make text*"},
|
|
{0x76, "Execute single instruction*"},
|
|
{0x77, "Single step*"},
|
|
{0x82, "XOB 17 interrupt"},
|
|
{0x83, "XOB 18 interrupt"},
|
|
{0x84, "XOB 19 interrupt"},
|
|
{0x91, "Read hangup timeout"},
|
|
{0x96, "Read data block"},
|
|
{0x97, "Write data block"},
|
|
{0x98, "Make data block*"},
|
|
{0x99, "Clear data block*"},
|
|
{0x9A, "Clear text*"},
|
|
{0x9B, "Read block address"},
|
|
{0x9C, "Read block sizes"},
|
|
{0x9D, "Read current block*"},
|
|
{0x9E, "Read call stack*"},
|
|
{0x9F, "Read DBX"},
|
|
{0xA1, "Read user EEPROM register"},
|
|
{0xA3, "Write user EEPROM register"},
|
|
{0xA5, "Erase flash*"},
|
|
{0xA6, "Restart cold flag*"},
|
|
{0xA7, "Write system buffer"},
|
|
{0xA8, "Read system buffer"},
|
|
{0xA9, "Read/write block data*"},
|
|
{0xAA, "Get diagnostic*"},
|
|
{0xAB, "Read system information*"},
|
|
{0xAC, "Changes blocks on run*"},
|
|
{0xAD, "Flashcard telegram*"},
|
|
{0xAE, "Download FW*"},
|
|
{0xAF, "Web server serial communication*"},
|
|
{0, NULL}
|
|
};
|
|
static value_string_ext sbus_command_vals_ext = VALUE_STRING_EXT_INIT(sbus_command_vals);
|
|
|
|
static const value_string webserver_aid_vals[] = {
|
|
{0x01, "Partial request"},
|
|
{0x02, "Request end"},
|
|
{0x07, "Get Data"},
|
|
{0x10, "Transfer OK"},
|
|
{0x11, "Partial answer"},
|
|
{0x12, "Last part of answer"},
|
|
{0x13, "Server not ready"},
|
|
{0, NULL}
|
|
};
|
|
static const value_string rdwrblock_vals[] = {
|
|
{0x00, "WR block start of stream"},
|
|
{0x01, "WR block data stream"},
|
|
{0x02, "WR block end of stream"},
|
|
{0x07, "Abort block WR stream"},
|
|
{0x08, "WR block data"},
|
|
{0x10, "RD block start of stream"},
|
|
{0x11, "RD block data stream"},
|
|
{0x17, "Abort block RD stream"},
|
|
{0x18, "RD block data"},
|
|
{0x20, "Delete block"},
|
|
{0x21, "Get block size"},
|
|
{0x22, "Get program block list"},
|
|
{0, NULL}
|
|
};
|
|
static value_string_ext rdwrblock_vals_ext = VALUE_STRING_EXT_INIT(rdwrblock_vals);
|
|
|
|
static const value_string rdwrblock_sts[] = {
|
|
{0x00, "ACK (Acknowledged)"},
|
|
{0x01, "Data"},
|
|
{0x02, "Busy"},
|
|
{0x03, "End of stream"},
|
|
{0x04, "Data EOF reached"},
|
|
{0x80, "NAK"},
|
|
{0x81, "NAK, unknown Tlg_Type"},
|
|
{0x82, "NAK, not supported Tlg_Type"},
|
|
{0x83, "NAK, unknown Block Type"},
|
|
{0x84, "NAK, out of sequence"},
|
|
{0x85, "NAK, not supported Block number"},
|
|
{0x86, "NAK, Block Size invalid (to big)"},
|
|
{0x87, "NAK, Block Address invalid"},
|
|
{0x88, "NAK, CRC invalid"},
|
|
{0x89, "NAK, invalid status"},
|
|
{0x8A, "NAK, invalid command size (w-count)"},
|
|
{0xFF, "Abort (stream)"},
|
|
{0, NULL}
|
|
};
|
|
static value_string_ext rdwrblock_sts_ext = VALUE_STRING_EXT_INIT(rdwrblock_sts);
|
|
|
|
static const value_string rdwrblock_list_type_vals[] = {
|
|
{0x40, "Start request of program block"},
|
|
{0x41, "Get next program block"},
|
|
{0xFF, "Abort get list"},
|
|
{0, NULL}
|
|
};
|
|
|
|
static const guint crc_table[] = {
|
|
0x0000,0x1021,0x2042,0x3063,0x4084,0x50a5,0x60c6,0x70e7,0x8108,0x9129,0xa14a,0xb16b,0xc18c,0xd1ad,0xe1ce,0xf1ef,
|
|
0x1231,0x0210,0x3273,0x2252,0x52b5,0x4294,0x72f7,0x62d6,0x9339,0x8318,0xb37b,0xa35a,0xd3bd,0xc39c,0xf3ff,0xe3de,
|
|
0x2462,0x3443,0x0420,0x1401,0x64e6,0x74c7,0x44a4,0x5485,0xa56a,0xb54b,0x8528,0x9509,0xe5ee,0xf5cf,0xc5ac,0xd58d,
|
|
0x3653,0x2672,0x1611,0x0630,0x76d7,0x66f6,0x5695,0x46b4,0xb75b,0xa77a,0x9719,0x8738,0xf7df,0xe7fe,0xd79d,0xc7bc,
|
|
0x48c4,0x58e5,0x6886,0x78a7,0x0840,0x1861,0x2802,0x3823,0xc9cc,0xd9ed,0xe98e,0xf9af,0x8948,0x9969,0xa90a,0xb92b,
|
|
0x5af5,0x4ad4,0x7ab7,0x6a96,0x1a71,0x0a50,0x3a33,0x2a12,0xdbfd,0xcbdc,0xfbbf,0xeb9e,0x9b79,0x8b58,0xbb3b,0xab1a,
|
|
0x6ca6,0x7c87,0x4ce4,0x5cc5,0x2c22,0x3c03,0x0c60,0x1c41,0xedae,0xfd8f,0xcdec,0xddcd,0xad2a,0xbd0b,0x8d68,0x9d49,
|
|
0x7e97,0x6eb6,0x5ed5,0x4ef4,0x3e13,0x2e32,0x1e51,0x0e70,0xff9f,0xefbe,0xdfdd,0xcffc,0xbf1b,0xaf3a,0x9f59,0x8f78,
|
|
0x9188,0x81a9,0xb1ca,0xa1eb,0xd10c,0xc12d,0xf14e,0xe16f,0x1080,0x00a1,0x30c2,0x20e3,0x5004,0x4025,0x7046,0x6067,
|
|
0x83b9,0x9398,0xa3fb,0xb3da,0xc33d,0xd31c,0xe37f,0xf35e,0x02b1,0x1290,0x22f3,0x32d2,0x4235,0x5214,0x6277,0x7256,
|
|
0xb5ea,0xa5cb,0x95a8,0x8589,0xf56e,0xe54f,0xd52c,0xc50d,0x34e2,0x24c3,0x14a0,0x0481,0x7466,0x6447,0x5424,0x4405,
|
|
0xa7db,0xb7fa,0x8799,0x97b8,0xe75f,0xf77e,0xc71d,0xd73c,0x26d3,0x36f2,0x0691,0x16b0,0x6657,0x7676,0x4615,0x5634,
|
|
0xd94c,0xc96d,0xf90e,0xe92f,0x99c8,0x89e9,0xb98a,0xa9ab,0x5844,0x4865,0x7806,0x6827,0x18c0,0x08e1,0x3882,0x28a3,
|
|
0xcb7d,0xdb5c,0xeb3f,0xfb1e,0x8bf9,0x9bd8,0xabbb,0xbb9a,0x4a75,0x5a54,0x6a37,0x7a16,0x0af1,0x1ad0,0x2ab3,0x3a92,
|
|
0xfd2e,0xed0f,0xdd6c,0xcd4d,0xbdaa,0xad8b,0x9de8,0x8dc9,0x7c26,0x6c07,0x5c64,0x4c45,0x3ca2,0x2c83,0x1ce0,0x0cc1,
|
|
0xef1f,0xff3e,0xcf5d,0xdf7c,0xaf9b,0xbfba,0x8fd9,0x9ff8,0x6e17,0x7e36,0x4e55,0x5e74,0x2e93,0x3eb2,0x0ed1,0x1ef0
|
|
};
|
|
|
|
/* Conversion values passing structure*/
|
|
typedef struct {
|
|
guint32 conversation; /*Conversation ID*/
|
|
guint16 sequence; /*Sequence number of request telegram*/
|
|
} sbus_request_key;
|
|
|
|
typedef struct {
|
|
guint8 cmd_code; /*command code from request*/
|
|
guint8 count; /*rcount value*/
|
|
guint8 sysinfo; /*system information number*/
|
|
guint8 block_tlg; /*telegram type of RD/WR block telegrams*/
|
|
guint8 retry_count; /*number of retries*/
|
|
guint32 req_frame; /*frame number of last request*/
|
|
guint32 resp_frame; /*frame number of response*/
|
|
nstime_t req_time; /*time of the last request*/
|
|
} sbus_request_val;
|
|
|
|
/* The hash structure (for conversations)*/
|
|
static GHashTable *sbus_request_hash = NULL;
|
|
|
|
static guint crc_calc (guint crc, guint val)
|
|
{
|
|
int indx;
|
|
guint ncrc;
|
|
|
|
indx = (((crc >> 8) ^ val) & 0xff);
|
|
ncrc = crc_table[indx] ^ ((crc << 8) & 0xffff);
|
|
|
|
return ncrc;
|
|
}
|
|
|
|
/* Hash functions*/
|
|
static gint sbus_equal(gconstpointer v, gconstpointer w)
|
|
{
|
|
const sbus_request_key *v1 = (const sbus_request_key *)v;
|
|
const sbus_request_key *v2 = (const sbus_request_key *)w;
|
|
|
|
if (v1->conversation == v2->conversation &&
|
|
v1->sequence == v2->sequence) {
|
|
return 1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static guint sbus_hash(gconstpointer v)
|
|
{
|
|
const sbus_request_key *key = (const sbus_request_key *)v;
|
|
guint val;
|
|
|
|
val = key->conversation + key->sequence;
|
|
return val;
|
|
}
|
|
|
|
/*Protocol initialisation*/
|
|
static void sbus_init_protocol(void){
|
|
sbus_request_hash = g_hash_table_new(sbus_hash, sbus_equal);
|
|
}
|
|
|
|
static void sbus_cleanup_protocol(void){
|
|
g_hash_table_destroy(sbus_request_hash);
|
|
}
|
|
|
|
/* check whether the packet looks like SBUS or not */
|
|
static gboolean
|
|
is_sbus_pdu(tvbuff_t *tvb)
|
|
{
|
|
guint32 length;
|
|
|
|
/* we need at least 8 bytes to determine whether this is sbus or
|
|
not*/
|
|
if(tvb_captured_length(tvb)<8){
|
|
return FALSE;
|
|
}
|
|
|
|
/* the length must be >= 8 bytes to accommodate the header,
|
|
it also must be <65536 to fit inside a udp packet
|
|
*/
|
|
length=tvb_get_ntohl(tvb, 0);
|
|
if ( (length<8) || (length>65535) ) {
|
|
return FALSE;
|
|
}
|
|
if (tvb_reported_length(tvb) != length) {
|
|
return FALSE;
|
|
}
|
|
/* First four byte indicate the length which must be at least 12 bytes*/
|
|
if (tvb_get_ntohl(tvb, 0) < 12) {
|
|
return (FALSE);
|
|
}
|
|
/* Fifth byte indicates protocol version which can be 0 or 1*/
|
|
if (tvb_get_guint8(tvb, 4) > 0x01) {
|
|
return (FALSE);
|
|
}
|
|
/* Sixth byte indicates protocol type and must be 0*/
|
|
if ( tvb_get_guint8(tvb, 5) > 0x01 ) {
|
|
return (FALSE);
|
|
}
|
|
/* Seventh and eigth byte indicates the packet sequence number and can
|
|
be 0 to 65565 (--> check does not make sense)*/
|
|
/* Ninth byte the "attributes character" and must be either 0, 1 or 2
|
|
(request, response or ACK/NAK)*/
|
|
if (tvb_get_guint8(tvb, 8) > 0x02 ) {
|
|
return (FALSE);
|
|
}
|
|
return TRUE;
|
|
}
|
|
|
|
/*Dissect the telegram*/
|
|
static int
|
|
dissect_sbus(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data _U_)
|
|
{
|
|
|
|
/* Set up structures needed to add the protocol subtree and manage it */
|
|
proto_item *ti, *hi, *cs;
|
|
proto_tree *sbus_tree, *ethsbus_tree, *sbusdata_tree;
|
|
|
|
gint i; /*for CRC calculation*/
|
|
gint j; /*for CRC calculation*/
|
|
gint offset;
|
|
gint sbus_eth_len;
|
|
guint sbus_crc_calc;
|
|
guint8 sbus_attribut;
|
|
guint8 sbus_media_cnt;
|
|
guint8 sbus_fio_cnt;
|
|
guint8 sbus_cmd_code;
|
|
guint8 sbus_web_size;
|
|
guint8 sbus_web_aid;
|
|
guint8 sbus_web_seq;
|
|
guint8 sbus_rdwr_type;
|
|
guint8 sbus_rdwr_sequence;
|
|
guint8 sbus_rdwr_block_tlg;
|
|
guint8 sbus_rdwr_block_type;
|
|
guint8 sbus_rdwr_ack_nak;
|
|
guint8 sbus_quint8_helper0;
|
|
guint32 sbus_binarymasked;
|
|
guint32 sbus_binaries;
|
|
guint16 sbus_ack_code;
|
|
guint32 sbus_show_bin;
|
|
guint32 sbus_rdwr_length;
|
|
guint32 sbus_helper;
|
|
guint32 sbus_helper1;
|
|
guint32 sbus_helper2;
|
|
char *tmp_string;
|
|
nstime_t ns; /*we use this for the response time*/
|
|
|
|
/* Set up conversations*/
|
|
conversation_t *conversation;
|
|
sbus_request_key request_key, *new_request_key;
|
|
sbus_request_val *request_val;
|
|
|
|
/* does this look like an sbus pdu? */
|
|
if(!is_sbus_pdu(tvb)){
|
|
return 0;
|
|
}
|
|
|
|
/* Make entries in Protocol column and Info column on summary display */
|
|
col_set_str(pinfo->cinfo, COL_PROTOCOL, "S-Bus");
|
|
col_clear(pinfo->cinfo, COL_INFO);
|
|
|
|
conversation = find_or_create_conversation(pinfo);
|
|
|
|
request_key.conversation = conversation->index;
|
|
request_key.sequence = tvb_get_ntohs(tvb,6);
|
|
|
|
request_val = (sbus_request_val *) g_hash_table_lookup(sbus_request_hash,
|
|
&request_key);
|
|
/*Get type of telegram for finding retries
|
|
*As we are storing the info in a hash table we need to update the info
|
|
*also in case this is no retry*/
|
|
sbus_attribut = tvb_get_guint8(tvb,8);
|
|
if (request_val && sbus_attribut == SBUS_REQUEST) {
|
|
if (request_val->req_frame < pinfo->fd->num){ /*a retry; req_frame smaller this frame*/
|
|
request_val->retry_count +=1;
|
|
}
|
|
else { /*we have a conversation but this is not a retry so we store the packet info*/
|
|
request_val->retry_count = 0;
|
|
request_val->req_frame = pinfo->fd->num; /*store actual frame nr.*/
|
|
request_val->req_time = pinfo->fd->abs_ts;
|
|
}
|
|
}
|
|
if (request_val && (sbus_attribut == SBUS_RESPONSE ||
|
|
sbus_attribut == SBUS_ACKNAK)) { /*a response*/
|
|
request_val->resp_frame = pinfo->fd->num; /*so store this frame nr.*/
|
|
}
|
|
/* Only allocate a new hash element when it's a request*/
|
|
sbus_attribut = tvb_get_guint8(tvb,8);
|
|
|
|
if ( !request_val && sbus_attribut == 0 ) {/* request telegram */
|
|
new_request_key = wmem_new(wmem_file_scope(), sbus_request_key);
|
|
*new_request_key = request_key;
|
|
|
|
request_val = wmem_new(wmem_file_scope(), sbus_request_val);
|
|
request_val->cmd_code=tvb_get_guint8(tvb,10);
|
|
request_val->retry_count=0;
|
|
request_val->req_frame = pinfo->fd->num; /*store actual frame nr.*/
|
|
request_val->req_time = pinfo->fd->abs_ts;
|
|
request_val->resp_frame = 0; /*response frame is not known yet*/
|
|
|
|
if (((request_val->cmd_code) == SBUS_RD_USER_EEPROM_REGISTER) ||
|
|
((request_val->cmd_code) == SBUS_WR_USER_EEPROM_REGISTER)) {
|
|
request_val->count=((tvb_get_guint8(tvb,12))+1);
|
|
} else {
|
|
request_val->count=((tvb_get_guint8(tvb,11))+1);
|
|
}
|
|
|
|
/*Enter system info or telegram type (for rd/wr block telegrams)*/
|
|
if ((request_val->cmd_code) == SBUS_RD_SYSTEM_INFORMATION) {
|
|
request_val->sysinfo=(tvb_get_guint8(tvb,12));
|
|
request_val->block_tlg=0x0;
|
|
} else if ((request_val->cmd_code) == SBUS_RD_WR_PCD_BLOCK) {
|
|
request_val->sysinfo=0x0;
|
|
request_val->block_tlg=(tvb_get_guint8(tvb,12));
|
|
} else {
|
|
request_val->sysinfo = 0x0;
|
|
request_val->block_tlg = 0x0;
|
|
}
|
|
|
|
g_hash_table_insert(sbus_request_hash, new_request_key, request_val);
|
|
}
|
|
/* End of attaching data to hash table*/
|
|
|
|
offset = 0;
|
|
|
|
switch (sbus_attribut){
|
|
case SBUS_REQUEST:
|
|
sbus_cmd_code = tvb_get_guint8(tvb, 10);
|
|
switch (sbus_cmd_code){
|
|
case SBUS_WEB_SERVER_SERIAL_COMM:
|
|
/* Special treatment of web server request
|
|
* as is is very helpful to see more information in the packetlist */
|
|
sbus_web_aid = tvb_get_guint8(tvb, 12);
|
|
sbus_web_seq = tvb_get_guint8(tvb, 13);
|
|
col_add_fstr(pinfo->cinfo, COL_INFO,
|
|
"Web Server Request: %s (Seq No: %d)",
|
|
val_to_str_const(sbus_web_aid,
|
|
webserver_aid_vals,
|
|
"Unknown Request!"),
|
|
sbus_web_seq);
|
|
break;
|
|
case SBUS_RD_WR_PCD_BLOCK:
|
|
sbus_rdwr_type = tvb_get_guint8(tvb, 12);
|
|
col_add_fstr( pinfo->cinfo, COL_INFO,
|
|
"Request: %s",
|
|
val_to_str_ext_const(sbus_rdwr_type,
|
|
&rdwrblock_vals_ext,
|
|
"This RD/WR block telegram is not implemented"));
|
|
/* Add name of file to be written in case of start of file stream */
|
|
if (sbus_rdwr_type == SBUS_WR_START_OF_STREAM) {
|
|
sbus_rdwr_block_type = tvb_get_guint8(tvb, 14);
|
|
if ((sbus_rdwr_block_type == SBUS_RD_WR_CONFIGURATION_FILE) ||
|
|
(sbus_rdwr_block_type == SBUS_RD_WR_PROGRAM_BLOCK_FILE)) {
|
|
sbus_quint8_helper0=0;
|
|
for (i=19; i<43; i++) { /*max length is 24 chars*/
|
|
/*find zero-termination of string*/
|
|
if ((tvb_get_guint8(tvb, i)) == 0x00) {
|
|
break;
|
|
}
|
|
sbus_quint8_helper0 += 1;
|
|
}
|
|
tmp_string = tvb_get_string_enc(wmem_packet_scope(), tvb , 19,
|
|
sbus_quint8_helper0, ENC_ASCII);
|
|
col_append_fstr(pinfo->cinfo, COL_INFO,
|
|
": (File: %s)", tmp_string);
|
|
}
|
|
} else if (sbus_rdwr_type == SBUS_RD_BLOCK_START_OF_STREAM) {
|
|
sbus_rdwr_block_type = tvb_get_guint8(tvb, 14);
|
|
if ((sbus_rdwr_block_type == SBUS_RD_WR_CONFIGURATION_FILE) ||
|
|
(sbus_rdwr_block_type == SBUS_RD_WR_PROGRAM_BLOCK_FILE)) {
|
|
sbus_quint8_helper0=0;
|
|
for (i=15; i<39; i++) { /*max length is 24 chars*/
|
|
/*find zero-termination of string*/
|
|
if ((tvb_get_guint8(tvb, i)) == 0x00) {
|
|
break;
|
|
}
|
|
sbus_quint8_helper0 += 1;
|
|
}
|
|
tmp_string = tvb_get_string_enc(wmem_packet_scope(), tvb , 15,
|
|
sbus_quint8_helper0, ENC_ASCII);
|
|
col_append_fstr(pinfo->cinfo, COL_INFO,
|
|
": (File: %s)", tmp_string);
|
|
}
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
default:
|
|
/* All other requests */
|
|
col_add_fstr(pinfo->cinfo, COL_INFO,
|
|
"Request: %s",
|
|
val_to_str_ext_const(sbus_cmd_code,
|
|
&sbus_command_vals_ext,
|
|
"Unknown Command!"));
|
|
break;
|
|
}
|
|
/*mark retries*/
|
|
if (request_val->retry_count>0) {
|
|
col_append_str(pinfo->cinfo, COL_INFO,
|
|
" (Retry)");
|
|
} /*no retry number as it is not always correctly calculated*/
|
|
break;
|
|
|
|
case SBUS_RESPONSE:
|
|
/* Special treatment of web server request
|
|
* as is is very helpful to see more information in the packetlist */
|
|
if (request_val && ((request_val->cmd_code) == SBUS_WEB_SERVER_SERIAL_COMM)) {
|
|
sbus_web_size = tvb_get_guint8(tvb,9);
|
|
sbus_web_aid = tvb_get_guint8(tvb,10);
|
|
col_add_fstr(pinfo->cinfo, COL_INFO,
|
|
"Response: %s",
|
|
val_to_str_const(sbus_web_aid,
|
|
webserver_aid_vals, "Unknown Request!"));
|
|
if (sbus_web_size > 1) {
|
|
sbus_web_seq = tvb_get_guint8(tvb,11);
|
|
col_append_fstr(pinfo->cinfo, COL_INFO,
|
|
" (Seq No: %d)",
|
|
sbus_web_seq);
|
|
}
|
|
} else if (request_val && ((request_val->cmd_code) == SBUS_RD_WR_PCD_BLOCK)) {
|
|
/* Treat the ACK/NAK telgrams in a special way*/
|
|
switch (request_val->block_tlg) {
|
|
case SBUS_WR_START_OF_STREAM:
|
|
case SBUS_WR_BLOCK_DATA_STREAM:
|
|
case SBUS_WR_BLOCK_END_OF_STREAM:
|
|
case SBUS_WR_ABORT_BLOCK_STREAM:
|
|
case SBUS_WR_BLOCK_DATA_BYTES:
|
|
case SBUS_DELETE_BLOCK:
|
|
case SBUS_RD_ABORT_BLOCK_STREAM:
|
|
sbus_rdwr_ack_nak = tvb_get_guint8(tvb, 10);
|
|
col_add_fstr( pinfo->cinfo, COL_INFO,
|
|
"Response: %s",
|
|
val_to_str_ext_const(sbus_rdwr_ack_nak,
|
|
&rdwrblock_sts_ext,
|
|
"Unknown response!"));
|
|
break;
|
|
default:
|
|
sbus_rdwr_type = tvb_get_guint8(tvb, 9);
|
|
col_add_fstr( pinfo->cinfo, COL_INFO,
|
|
"Response: (%d byte)", sbus_rdwr_type);
|
|
break;
|
|
}
|
|
|
|
} else {
|
|
col_set_str(pinfo->cinfo, COL_INFO, "Response");
|
|
}
|
|
break;
|
|
|
|
case SBUS_ACKNAK:
|
|
sbus_ack_code = tvb_get_ntohs(tvb,9);
|
|
col_add_fstr(pinfo->cinfo, COL_INFO,
|
|
"%s", val_to_str_const(sbus_ack_code,
|
|
sbus_ack_nak_vals,
|
|
"Unknown NAK response code!"));
|
|
break;
|
|
|
|
default:
|
|
col_set_str(pinfo->cinfo, COL_INFO, "Unknown attribute");
|
|
break;
|
|
}
|
|
|
|
/* create display subtree for the protocol */
|
|
if (tree) {
|
|
|
|
ti = proto_tree_add_item(tree, proto_sbus, tvb, offset, -1, ENC_NA);
|
|
sbus_tree = proto_item_add_subtree(ti, ett_sbus);
|
|
|
|
/*Add subtree for Ether-S-Bus header*/
|
|
ethsbus_tree = proto_tree_add_subtree(sbus_tree, tvb, offset, 8, ett_sbus_ether, NULL, "Ether-S-Bus header");
|
|
|
|
/* add an item to the subtree*/
|
|
sbus_eth_len = tvb_get_ntohl(tvb,offset);
|
|
proto_tree_add_item(ethsbus_tree,
|
|
hf_sbus_length, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
|
|
proto_tree_add_item(ethsbus_tree,
|
|
hf_sbus_version, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
|
|
proto_tree_add_item(ethsbus_tree,
|
|
hf_sbus_protocol, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
|
|
proto_tree_add_item(ethsbus_tree,
|
|
hf_sbus_sequence, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
|
|
/* Continue adding stuff to the main tree*/
|
|
sbus_attribut = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_attribut, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
|
|
if (sbus_attribut == SBUS_REQUEST) {
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_dest, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
sbus_cmd_code = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_command, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
if (request_val && request_val->retry_count > 0) {/*this is a retry telegram*/
|
|
expert_add_info(pinfo, sbus_tree, &ei_sbus_retry);
|
|
nstime_delta(&ns, &pinfo->fd->abs_ts, &request_val->req_time);
|
|
proto_tree_add_time(sbus_tree, hf_sbus_timeout,
|
|
tvb, 0, 0, &ns);
|
|
proto_tree_add_uint(sbus_tree, hf_sbus_request_in, tvb, 0, 0,
|
|
request_val->req_frame);
|
|
}
|
|
if (request_val && request_val->resp_frame > pinfo->fd->num){
|
|
proto_tree_add_uint(sbus_tree, hf_sbus_response_in, tvb, 0, 0,
|
|
request_val->resp_frame);
|
|
}
|
|
switch (sbus_cmd_code) {
|
|
/*Read Counter, Register or Timer*/
|
|
case SBUS_RD_COUNTER:
|
|
case SBUS_RD_REGISTER:
|
|
case SBUS_RD_TIMER:
|
|
sbus_media_cnt = (tvb_get_guint8(tvb,offset))+1;
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_rcount, tvb, offset, 1, sbus_media_cnt);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_addr_rtc, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
break;
|
|
|
|
/*Read Flag, Input or Output*/
|
|
case SBUS_RD_FLAG:
|
|
case SBUS_RD_INPUT:
|
|
case SBUS_RD_OUTPUT:
|
|
sbus_media_cnt = (tvb_get_guint8(tvb,offset))+1;
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_rcount, tvb, offset, 1, sbus_media_cnt);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_addr_iof, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
break;
|
|
|
|
/*Write Register Timer Counter*/
|
|
case SBUS_WR_COUNTER:
|
|
case SBUS_WR_REGISTER:
|
|
case SBUS_WR_TIMER:
|
|
sbus_media_cnt = (tvb_get_guint8(tvb,offset));
|
|
sbus_media_cnt = ((sbus_media_cnt - 1)/4);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_wcount_calculated, tvb, offset,
|
|
1, sbus_media_cnt);
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_wcount, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_addr_rtc, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
((sbus_media_cnt) * 4), ett_sbus_data, NULL, "Data");
|
|
for (i=((sbus_media_cnt)); i>0; i--) {
|
|
proto_tree_add_item(sbusdata_tree,
|
|
hf_sbus_data_rtc, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
}
|
|
break;
|
|
|
|
/* Write flags and outputs*/
|
|
case SBUS_WR_FLAG:
|
|
case SBUS_WR_OUTPUT:
|
|
sbus_media_cnt = (tvb_get_guint8(tvb,offset));
|
|
sbus_media_cnt = (sbus_media_cnt - 2);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_wcount_calculated, tvb, offset,
|
|
1, sbus_media_cnt);
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_wcount, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_addr_iof, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
sbus_fio_cnt = (tvb_get_guint8(tvb,offset));
|
|
sbus_fio_cnt = ((sbus_fio_cnt + 1));
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_fio_count, tvb, offset, 1, sbus_fio_cnt);
|
|
offset += 1;
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
sbus_media_cnt, ett_sbus_data, NULL, "Data");
|
|
|
|
for (i=sbus_media_cnt; i>0; i--) {
|
|
sbus_helper = 1;
|
|
sbus_show_bin = 0;
|
|
sbus_binarymasked = 0x01;
|
|
sbus_binaries = tvb_get_guint8(tvb, offset);
|
|
for (j=0; j<8; j++) {
|
|
if ((sbus_binarymasked & sbus_binaries) != 0) {
|
|
sbus_show_bin = (sbus_show_bin + sbus_helper);
|
|
}
|
|
sbus_binarymasked = sbus_binarymasked<<1;
|
|
sbus_helper = 10 * sbus_helper;
|
|
}
|
|
|
|
proto_tree_add_uint_format(sbusdata_tree,
|
|
hf_sbus_data_iof, tvb, offset, 1, sbus_show_bin,
|
|
"Binary data: %08u", sbus_show_bin);
|
|
offset += 1;
|
|
}
|
|
break;
|
|
|
|
/* Request: Write Real time clock*/
|
|
case SBUS_WR_RTC:
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
8, ett_sbus_data, NULL, "Clock data");
|
|
|
|
sbus_helper = tvb_get_guint8(tvb, (offset)); /*year-week*/
|
|
sbus_helper1 = tvb_get_guint8(tvb, (offset +1)); /*week-day*/
|
|
proto_tree_add_uint_format_value(sbusdata_tree,
|
|
hf_sbus_week_day, tvb, offset, 2, tvb_get_ntohs(tvb, offset),
|
|
"%x, Week day: %x", sbus_helper, sbus_helper1);
|
|
offset += 2;
|
|
sbus_helper = tvb_get_guint8(tvb, (offset)); /*year*/
|
|
sbus_helper1 = tvb_get_guint8(tvb, (offset +1)); /*month*/
|
|
sbus_helper2 = tvb_get_guint8(tvb, (offset +2)); /*day*/
|
|
proto_tree_add_uint_format_value(sbusdata_tree,
|
|
hf_sbus_date, tvb, offset, 3, tvb_get_ntoh24(tvb, offset),
|
|
"%02x/%02x/%02x", sbus_helper, sbus_helper1, sbus_helper2);
|
|
offset += 3;
|
|
sbus_helper = tvb_get_guint8(tvb, (offset)); /*hours*/
|
|
sbus_helper1 = tvb_get_guint8(tvb, (offset +1)); /*minutes*/
|
|
sbus_helper2 = tvb_get_guint8(tvb, (offset +2)); /*seconds*/
|
|
proto_tree_add_uint_format_value(sbusdata_tree,
|
|
hf_sbus_time, tvb, offset, 3, tvb_get_ntoh24(tvb, offset),
|
|
"%02x:%02x:%02x", sbus_helper, sbus_helper1, sbus_helper2);
|
|
offset += 3;
|
|
break;
|
|
|
|
/* Read user memory or program line*/
|
|
case SBUS_RD_USER_MEMORY:
|
|
case SBUS_RD_PROGRAM_LINE:
|
|
sbus_media_cnt = (tvb_get_guint8(tvb,offset))+1;
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_rcount, tvb, offset, 1, sbus_media_cnt);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_addr_prog, tvb, offset, 3, ENC_BIG_ENDIAN);
|
|
offset += 3;
|
|
break;
|
|
|
|
/*Write user memory*/
|
|
case SBUS_WR_USER_MEMORY:
|
|
sbus_media_cnt = (tvb_get_guint8(tvb,offset));
|
|
sbus_media_cnt = ((sbus_media_cnt - 2)/4);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_wcount_calculated, tvb, offset,
|
|
1, sbus_media_cnt);
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_wcount, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_addr_68k, tvb, offset, 3, ENC_BIG_ENDIAN);
|
|
offset += 3;
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
((sbus_media_cnt) * 4), ett_sbus_data, NULL, "Program lines");
|
|
|
|
for (i=((sbus_media_cnt)); i>0; i--) {
|
|
proto_tree_add_item(sbusdata_tree,
|
|
hf_sbus_data_rtc, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
|
|
}
|
|
break;
|
|
|
|
/* Read byte*/
|
|
case SBUS_RD_BYTE:
|
|
sbus_media_cnt = (tvb_get_guint8(tvb,offset))+1;
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_rcount, tvb, offset, 1, sbus_media_cnt);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_addr_68k, tvb, offset, 3, ENC_BIG_ENDIAN);
|
|
offset += 3;
|
|
break;
|
|
|
|
/* Write byte */
|
|
case SBUS_WR_BYTE:
|
|
sbus_media_cnt = (tvb_get_guint8(tvb,offset));
|
|
sbus_media_cnt = (sbus_media_cnt - 2);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_wcount_calculated, tvb, offset,
|
|
1, sbus_media_cnt);
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_wcount, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_addr_68k, tvb, offset, 3, ENC_BIG_ENDIAN);
|
|
offset += 3;
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
((sbus_media_cnt) * 4), ett_sbus_data, NULL, "Data (bytes)");
|
|
|
|
for (i=sbus_media_cnt; i>0; i--) {
|
|
proto_tree_add_item(sbusdata_tree,
|
|
hf_sbus_data_byte, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
}
|
|
break;
|
|
|
|
/*Read EEPROM register*/
|
|
case SBUS_RD_USER_EEPROM_REGISTER:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_command_extension, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
sbus_media_cnt = (tvb_get_guint8(tvb,offset))+1;
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_rcount, tvb, offset, 1, sbus_media_cnt);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_addr_eeprom, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
break;
|
|
|
|
/*Request for reading system info*/
|
|
/*Syinfo 05 is not implemented as no serial baud is possible*/
|
|
case SBUS_RD_SYSTEM_INFORMATION:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_sysinfo_nr, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_sysinfo_nr, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
break;
|
|
|
|
/* WebServer Request */
|
|
case SBUS_WEB_SERVER_SERIAL_COMM:
|
|
sbus_web_size = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_web_size, tvb, offset,
|
|
1, sbus_web_size);
|
|
offset += 1;
|
|
|
|
sbus_web_aid = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_web_aid, tvb, offset,
|
|
1, sbus_web_aid);
|
|
offset += 1;
|
|
|
|
sbus_web_seq = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_web_seq, tvb, offset,
|
|
1, sbus_web_seq);
|
|
offset += 1;
|
|
|
|
if (sbus_web_size > 1) {
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
(sbus_web_size - 1), ett_sbus_data, NULL, "Data (bytes)");
|
|
|
|
for (i=sbus_web_size -1 ; i>0; i--) {
|
|
proto_tree_add_item(sbusdata_tree,
|
|
hf_sbus_data_byte, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
}
|
|
}
|
|
break;
|
|
/* Read/write block request */
|
|
case SBUS_RD_WR_PCD_BLOCK:
|
|
if (tvb_get_guint8(tvb,offset) == 0xff){
|
|
sbus_rdwr_length = ((tvb_get_ntohl(tvb,0))-15);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_rdwr_block_length_ext, tvb, 0, 4, sbus_rdwr_length);
|
|
offset += 1;
|
|
} else {
|
|
sbus_rdwr_length = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_rdwr_block_length, tvb, offset,
|
|
1, sbus_rdwr_length);
|
|
offset += 1;
|
|
}
|
|
sbus_rdwr_type = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_rdwr_telegram_type, tvb, offset,
|
|
1, sbus_rdwr_type);
|
|
offset += 1;
|
|
switch(sbus_rdwr_type) {
|
|
case SBUS_WR_START_OF_STREAM:
|
|
sbus_rdwr_block_type = tvb_get_guint8(tvb, 14);
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_telegram_sequence, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_type, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
|
|
/* Check for file or block download */
|
|
if ((sbus_rdwr_block_type == SBUS_RD_WR_CONFIGURATION_FILE) ||
|
|
(sbus_rdwr_block_type == SBUS_RD_WR_PROGRAM_BLOCK_FILE)) {
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_block_size, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
sbus_quint8_helper0=0;
|
|
/*find zero-termination of string*/
|
|
for (i=19; i<43; i++) { /*max length string is 24 char*/
|
|
if ((tvb_get_guint8(tvb, i)) == 0x00) {
|
|
break;
|
|
}
|
|
sbus_quint8_helper0 += 1;
|
|
}
|
|
tmp_string = tvb_get_string_enc(wmem_packet_scope(), tvb , 19, sbus_quint8_helper0, ENC_ASCII);
|
|
proto_tree_add_string(sbus_tree,
|
|
hf_sbus_rdwr_file_name, tvb, offset,
|
|
sbus_quint8_helper0, tmp_string);
|
|
offset += sbus_quint8_helper0;
|
|
/*do not display a field for block data (skip)*/
|
|
offset += (sbus_rdwr_length-6-sbus_quint8_helper0);
|
|
} else { /* block write telegram, no file write*/
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_nr, tvb, offset,
|
|
2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_block_size, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
/*do not display a field for block data (skip)*/
|
|
offset += (sbus_rdwr_length-8);
|
|
}
|
|
break;
|
|
case SBUS_WR_BLOCK_DATA_STREAM:
|
|
sbus_rdwr_sequence = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_rdwr_telegram_sequence, tvb, offset,
|
|
1, sbus_rdwr_sequence);
|
|
offset += 1;
|
|
/*do not display a field for block data (skip)*/
|
|
offset += (sbus_rdwr_length-1);
|
|
break;
|
|
case SBUS_WR_BLOCK_END_OF_STREAM:
|
|
sbus_rdwr_sequence = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_rdwr_telegram_sequence, tvb, offset,
|
|
1, sbus_rdwr_sequence);
|
|
offset += 1;
|
|
/*do not display a field for block data (skip it)*/
|
|
offset += (sbus_rdwr_length-5);
|
|
/*do not display a field for block CRC (skip it)*/
|
|
offset += 4;
|
|
break;
|
|
case SBUS_WR_ABORT_BLOCK_STREAM:
|
|
case SBUS_RD_ABORT_BLOCK_STREAM:
|
|
break;
|
|
case SBUS_WR_BLOCK_DATA_BYTES:
|
|
sbus_rdwr_block_type = tvb_get_guint8(tvb, 14);
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_type, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
|
|
/* Check for file or block download */
|
|
if ((sbus_rdwr_block_type == SBUS_RD_WR_CONFIGURATION_FILE) ||
|
|
(sbus_rdwr_block_type == SBUS_RD_WR_PROGRAM_BLOCK_FILE)) {
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_block_addr, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
sbus_quint8_helper0=0;
|
|
/*find zero-termination of string*/
|
|
for (i=19; i<43; i++) { /*max length string is 24 char*/
|
|
if ((tvb_get_guint8(tvb, i)) == 0x00) {
|
|
break;
|
|
}
|
|
sbus_quint8_helper0 += 1;
|
|
}
|
|
tmp_string = tvb_get_string_enc(wmem_packet_scope(), tvb, 19, sbus_quint8_helper0, ENC_ASCII);
|
|
proto_tree_add_string(sbus_tree,
|
|
hf_sbus_rdwr_file_name, tvb, offset,
|
|
sbus_quint8_helper0, tmp_string);
|
|
offset += sbus_quint8_helper0;
|
|
/*do not display a field for block data (skip)*/
|
|
offset += (sbus_rdwr_length-6-sbus_quint8_helper0);
|
|
} else { /* block write telegram, no file write*/
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_nr, tvb, offset,
|
|
2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_block_addr, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
/*do not display a field for block data (skip)*/
|
|
offset += (sbus_rdwr_length-8);
|
|
}
|
|
break;
|
|
case SBUS_RD_BLOCK_START_OF_STREAM:
|
|
sbus_rdwr_block_type = tvb_get_guint8(tvb, 14);
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_telegram_sequence, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_type, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
|
|
/* Check for file or block download */
|
|
if ((sbus_rdwr_block_type == SBUS_RD_WR_CONFIGURATION_FILE) ||
|
|
(sbus_rdwr_block_type == SBUS_RD_WR_PROGRAM_BLOCK_FILE)) {
|
|
sbus_quint8_helper0=0;
|
|
/*find zero-termination of string*/
|
|
for (i=14; i<38; i++) { /*max length string is 24 char*/
|
|
if ((tvb_get_guint8(tvb, i)) == 0x00) {
|
|
break;
|
|
}
|
|
sbus_quint8_helper0 += 1;
|
|
}
|
|
tmp_string = tvb_get_string_enc(wmem_packet_scope(), tvb, 14, sbus_quint8_helper0, ENC_ASCII);
|
|
proto_tree_add_string(sbus_tree,
|
|
hf_sbus_rdwr_file_name, tvb, offset,
|
|
sbus_quint8_helper0, tmp_string);
|
|
offset += sbus_quint8_helper0;
|
|
} else { /* block write telegram, no file write*/
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_nr, tvb, offset,
|
|
2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
}
|
|
break;
|
|
case SBUS_RD_BLOCK_DATA_STREAM:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_telegram_sequence, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
break;
|
|
case SBUS_RD_BLOCK_DATA_BYTES:
|
|
sbus_rdwr_block_type = tvb_get_guint8(tvb, 13);
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_type, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
/* Check for file or block read */
|
|
if ((sbus_rdwr_block_type == SBUS_RD_WR_CONFIGURATION_FILE) ||
|
|
(sbus_rdwr_block_type == SBUS_RD_WR_PROGRAM_BLOCK_FILE)) {
|
|
/*reading from a file*/
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_block_addr, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_block_size, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
sbus_quint8_helper0=0;
|
|
/*find zero-termination of string*/
|
|
for (i=22; i<46; i++) { /*max length string is 24 char*/
|
|
if ((tvb_get_guint8(tvb, i)) == 0x00) {
|
|
break;
|
|
}
|
|
sbus_quint8_helper0 += 1;
|
|
}
|
|
tmp_string = tvb_get_string_enc(wmem_packet_scope(), tvb, 22, sbus_quint8_helper0, ENC_ASCII);
|
|
proto_tree_add_string(sbus_tree,
|
|
hf_sbus_rdwr_file_name, tvb, offset,
|
|
sbus_quint8_helper0, tmp_string);
|
|
offset += sbus_quint8_helper0 + 1;
|
|
} else { /* block read telegram, no file read*/
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_nr, tvb, offset,
|
|
2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_block_addr, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_block_size, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
}
|
|
break;
|
|
case SBUS_DELETE_BLOCK:
|
|
case SBUS_GET_BLOCK_SIZE:
|
|
sbus_rdwr_block_type = tvb_get_guint8(tvb, 13);
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_type, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
/* Check for file or block deletion */
|
|
if ((sbus_rdwr_block_type == SBUS_RD_WR_CONFIGURATION_FILE) ||
|
|
(sbus_rdwr_block_type == SBUS_RD_WR_PROGRAM_BLOCK_FILE)) {
|
|
/*delete a file*/
|
|
sbus_quint8_helper0=0;
|
|
/*find zero-termination of string*/
|
|
for (i=14; i<38; i++) { /*max length string is 24 char*/
|
|
if ((tvb_get_guint8(tvb, i)) == 0x00) {
|
|
break;
|
|
}
|
|
sbus_quint8_helper0 += 1;
|
|
}
|
|
tmp_string = tvb_get_string_enc(wmem_packet_scope(), tvb, 14, sbus_quint8_helper0, ENC_ASCII);
|
|
proto_tree_add_string(sbus_tree,
|
|
hf_sbus_rdwr_file_name, tvb, offset,
|
|
sbus_quint8_helper0, tmp_string);
|
|
offset += sbus_quint8_helper0 + 1;
|
|
} else { /* delete a block*/
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_nr, tvb, offset,
|
|
2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
}
|
|
break;
|
|
case SBUS_GET_PROGRAM_BLOCK_LIST:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_list_type, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
break;
|
|
|
|
/*Inform that command was not dissected and add remaining length*/
|
|
default:
|
|
if (sbus_eth_len > 13) { /*13 bytes is the minimal length of a request telegram...*/
|
|
sbus_helper = sbus_eth_len - (offset + 2);
|
|
proto_tree_add_expert(sbus_tree, pinfo, &ei_sbus_telegram_not_implemented, tvb, offset, sbus_helper);
|
|
offset = offset + sbus_helper;
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* Response dissection*/
|
|
if (sbus_attribut == SBUS_RESPONSE && request_val) {
|
|
/*add response time*/
|
|
nstime_delta(&ns, &pinfo->fd->abs_ts, &request_val->req_time);
|
|
proto_tree_add_time(sbus_tree, hf_sbus_response_time,
|
|
tvb, 0, 0, &ns);
|
|
/*add reference to request telegram*/
|
|
proto_tree_add_uint(sbus_tree, hf_sbus_response_to, tvb, 0, 0,
|
|
request_val->req_frame);
|
|
|
|
switch (request_val->cmd_code) {
|
|
/* Response: 32 bit values*/
|
|
case SBUS_RD_COUNTER:
|
|
case SBUS_RD_REGISTER:
|
|
case SBUS_RD_TIMER:
|
|
case SBUS_RD_USER_MEMORY:
|
|
case SBUS_RD_PROGRAM_LINE:
|
|
case SBUS_RD_USER_EEPROM_REGISTER:
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
((request_val->count) * 4), ett_sbus_data, NULL, "Data");
|
|
for (i=(request_val->count); i>0; i--) {
|
|
proto_tree_add_item(sbusdata_tree,
|
|
hf_sbus_data_rtc, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
}
|
|
break;
|
|
|
|
/* Response: PCD Display register*/
|
|
case SBUS_RD_DISPLAY_REGISTER:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_display_register, tvb, offset, 4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
break;
|
|
|
|
/* Add binary data I, O, F*/
|
|
case SBUS_RD_FLAG:
|
|
case SBUS_RD_INPUT:
|
|
case SBUS_RD_OUTPUT:
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
(((request_val->count) + 7) / 8), ett_sbus_data, NULL, "Data");
|
|
|
|
for (i=(((request_val->count) + 7) / 8); i>0; i--) {
|
|
sbus_helper = 1;
|
|
sbus_show_bin = 0;
|
|
sbus_binarymasked = 0x01;
|
|
sbus_binaries = tvb_get_guint8(tvb, offset);
|
|
for (j=0; j<8; j++){
|
|
if ((sbus_binarymasked & sbus_binaries) != 0) {
|
|
sbus_show_bin = (sbus_show_bin + sbus_helper);
|
|
}
|
|
sbus_binarymasked = sbus_binarymasked<<1;
|
|
sbus_helper = 10 * sbus_helper;
|
|
}
|
|
|
|
proto_tree_add_uint_format(sbusdata_tree,
|
|
hf_sbus_data_iof, tvb, offset, 1, sbus_show_bin,
|
|
"Binary data: %08u", sbus_show_bin);
|
|
offset += 1;
|
|
}
|
|
break;
|
|
|
|
/* Response: Real time clock value*/
|
|
case SBUS_RD_RTC:
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
8, ett_sbus_data, NULL, "Clock data");
|
|
|
|
sbus_helper = tvb_get_guint8(tvb, (offset)); /*year-week*/
|
|
sbus_helper1 = tvb_get_guint8(tvb, (offset +1)); /*week-day*/
|
|
proto_tree_add_uint_format_value(sbusdata_tree,
|
|
hf_sbus_week_day, tvb, offset, 2, tvb_get_ntohs(tvb, offset),
|
|
"%x, Week day: %x", sbus_helper, sbus_helper1);
|
|
offset += 2;
|
|
sbus_helper = tvb_get_guint8(tvb, (offset)); /*year*/
|
|
sbus_helper1 = tvb_get_guint8(tvb, (offset +1)); /*month*/
|
|
sbus_helper2 = tvb_get_guint8(tvb, (offset +2)); /*day*/
|
|
proto_tree_add_uint_format_value(sbusdata_tree,
|
|
hf_sbus_date, tvb, offset, 3, tvb_get_ntoh24(tvb, offset),
|
|
"%02x/%02x/%02x", sbus_helper, sbus_helper1, sbus_helper2);
|
|
offset += 3;
|
|
sbus_helper = tvb_get_guint8(tvb, (offset)); /*hours*/
|
|
sbus_helper1 = tvb_get_guint8(tvb, (offset +1)); /*minutes*/
|
|
sbus_helper2 = tvb_get_guint8(tvb, (offset +2)); /*seconds*/
|
|
proto_tree_add_uint_format_value(sbusdata_tree,
|
|
hf_sbus_time, tvb, offset, 3, tvb_get_ntoh24(tvb, offset),
|
|
"%02x:%02x:%02x", sbus_helper, sbus_helper1, sbus_helper2);
|
|
offset += 3;
|
|
break;
|
|
|
|
/* Response: CPU status, the command codes 14..1B are concerned*/
|
|
case SBUS_RD_PCD_STATUS_CPU0:
|
|
case SBUS_RD_PCD_STATUS_CPU1:
|
|
case SBUS_RD_PCD_STATUS_CPU2:
|
|
case SBUS_RD_PCD_STATUS_CPU3:
|
|
case SBUS_RD_PCD_STATUS_CPU4:
|
|
case SBUS_RD_PCD_STATUS_CPU5:
|
|
case SBUS_RD_PCD_STATUS_CPU6:
|
|
case SBUS_RD_PCD_STATUS_OWN:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_cpu_status, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
break;
|
|
|
|
/* Response: Station address*/
|
|
case SBUS_RD_SBUS_STN_NBR:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_address, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
break;
|
|
|
|
/* Response: Firmware version */
|
|
case SBUS_RD_PROGRAM_VERSION:
|
|
/*PCD type*/
|
|
tmp_string = tvb_get_string_enc(wmem_packet_scope(), tvb , offset, 5, ENC_ASCII);
|
|
proto_tree_add_string(sbus_tree,
|
|
hf_sbus_cpu_type, tvb, offset, 5, tmp_string);
|
|
offset += 5;
|
|
/*FW version*/
|
|
tmp_string = tvb_get_string_enc(wmem_packet_scope(), tvb , offset, 3, ENC_ASCII);
|
|
proto_tree_add_string(sbus_tree,
|
|
hf_sbus_fw_version, tvb, offset, 3, tmp_string);
|
|
offset += 4;
|
|
break;
|
|
|
|
/* Response for Status Flags*/
|
|
case SBUS_RD_STATUSFLAG_ACCU:
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
1, ett_sbus_data, NULL, "ACCU and arithmetic status");
|
|
|
|
proto_tree_add_item(sbusdata_tree, hf_sbus_flags_accu,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
proto_tree_add_item(sbusdata_tree, hf_sbus_flags_error,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
proto_tree_add_item(sbusdata_tree, hf_sbus_flags_negative,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
proto_tree_add_item(sbusdata_tree, hf_sbus_flags_zero,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset +=1;
|
|
break;
|
|
|
|
/* Response for Read byte */
|
|
case SBUS_RD_BYTE:
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
(request_val->count), ett_sbus_data, NULL, "Data (bytes)");
|
|
|
|
for (i=(request_val->count); i>0; i--) {
|
|
proto_tree_add_item(sbusdata_tree,
|
|
hf_sbus_data_byte, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
}
|
|
break;
|
|
|
|
/* Response for Read Index register */
|
|
case SBUS_RD_INDEX_REGISTER:
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
2, ett_sbus_data, NULL, "Data (hex bytes)");
|
|
|
|
for (i=0; i<2; i++) { /*2 bytes*/
|
|
proto_tree_add_item(sbusdata_tree,
|
|
hf_sbus_data_byte_hex, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
}
|
|
break;
|
|
|
|
/* Response: Instruction pointer*/
|
|
case SBUS_RD_INSTRUCTION_POINTER:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_addr_prog, tvb, offset, 3, ENC_BIG_ENDIAN);
|
|
offset += 3;
|
|
break;
|
|
|
|
/*Response for Find History*/
|
|
case SBUS_FIND_HISTORY:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_addr_68k, tvb, offset, 3, ENC_BIG_ENDIAN);
|
|
offset += 3;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_nbr_elements, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
break;
|
|
|
|
/* Response: Read current block*/
|
|
case SBUS_RD_CURRENT_BLOCK:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_type, tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_nr, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
break;
|
|
|
|
/* Response: Read system infomation (without interpretation of module info)*/
|
|
case SBUS_RD_SYSTEM_INFORMATION:
|
|
if (request_val->sysinfo == 0x00){ /*sysinfo 0*/
|
|
offset += 1; /* this byte is always 0x01*/
|
|
/*Add subtree for Data*/
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
1, ett_sbus_data, NULL, "System info");
|
|
|
|
proto_tree_add_item(sbusdata_tree, hf_sbus_sysinfo0_1,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
proto_tree_add_item(sbusdata_tree, hf_sbus_sysinfo0_2,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
proto_tree_add_item(sbusdata_tree, hf_sbus_sysinfo0_3,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
proto_tree_add_item(sbusdata_tree, hf_sbus_sysinfo0_4,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
proto_tree_add_item(sbusdata_tree, hf_sbus_sysinfo0_5,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
} else {
|
|
/*do not dissect all system info telegrams as there is no need*/
|
|
offset = (tvb_get_guint8(tvb,9) + 10);
|
|
}
|
|
break;
|
|
|
|
/* Response: Webserver request */
|
|
case SBUS_WEB_SERVER_SERIAL_COMM:
|
|
sbus_web_size = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_web_size, tvb, offset,
|
|
1, sbus_web_size);
|
|
offset += 1;
|
|
|
|
sbus_web_aid = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_web_aid, tvb, offset,
|
|
1, sbus_web_aid);
|
|
offset += 1;
|
|
|
|
if (sbus_web_size > 1) {
|
|
sbus_web_seq = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_web_seq, tvb, offset,
|
|
1, sbus_web_seq);
|
|
offset += 1;
|
|
|
|
sbusdata_tree = proto_tree_add_subtree(sbus_tree, tvb, offset,
|
|
(sbus_web_size - 2), ett_sbus_data, NULL, "Data (bytes)");
|
|
|
|
for (i=sbus_web_size - 2; i>0; i--) {
|
|
proto_tree_add_item(sbusdata_tree,
|
|
hf_sbus_data_byte, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
}
|
|
}
|
|
break;
|
|
/* Response: Read/Write block data */
|
|
case SBUS_RD_WR_PCD_BLOCK:
|
|
sbus_rdwr_block_tlg = request_val->block_tlg;
|
|
sbus_rdwr_length = tvb_get_guint8(tvb,offset);
|
|
proto_tree_add_uint(sbus_tree,
|
|
hf_sbus_rdwr_block_length, tvb, offset,
|
|
1, sbus_rdwr_length);
|
|
offset += 1;
|
|
hi = proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_acknakcode, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
if ((tvb_get_guint8(tvb, offset) >= SBUS_RD_WR_NAK)&&
|
|
(tvb_get_guint8(tvb, offset) <= SBUS_RD_WR_NAK_INVALID_SIZE)) {
|
|
expert_add_info(pinfo, hi, &ei_sbus_telegram_not_acked);
|
|
}
|
|
offset += 1;
|
|
switch(sbus_rdwr_block_tlg) {
|
|
case SBUS_WR_START_OF_STREAM:
|
|
case SBUS_WR_BLOCK_DATA_STREAM:
|
|
case SBUS_WR_BLOCK_END_OF_STREAM:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_telegram_sequence, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
break;
|
|
case SBUS_WR_ABORT_BLOCK_STREAM:
|
|
case SBUS_RD_ABORT_BLOCK_STREAM:
|
|
case SBUS_WR_BLOCK_DATA_BYTES:
|
|
case SBUS_DELETE_BLOCK:
|
|
break;
|
|
case SBUS_RD_BLOCK_START_OF_STREAM:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_telegram_sequence, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_block_size, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
/*do not display a field for block data (skip)*/
|
|
offset += (sbus_rdwr_length-6);
|
|
break;
|
|
case SBUS_RD_BLOCK_DATA_STREAM:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_telegram_sequence, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
/*do not display a field for block data (skip)*/
|
|
offset += (sbus_rdwr_length-2);
|
|
break;
|
|
case SBUS_RD_BLOCK_DATA_BYTES:
|
|
/*do not display a field for block data (skip)*/
|
|
offset += (sbus_rdwr_length-1);
|
|
break;
|
|
case SBUS_GET_BLOCK_SIZE:
|
|
sbus_rdwr_block_type = tvb_get_guint8(tvb, 10);
|
|
/* Check for unknown block type */
|
|
if (sbus_rdwr_block_type == SBUS_RD_WR_UNKNOWN_BLOCK_TYPE) {
|
|
/*unknown block, no more data follows*/
|
|
} else { /* add block size and CRC32 in case of known block*/
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_block_size, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
/*Now the CRC32 follows, but I don't bother calculating it*/
|
|
offset += 4;
|
|
}
|
|
break;
|
|
case SBUS_GET_PROGRAM_BLOCK_LIST:
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_type, tvb, offset,
|
|
1, ENC_BIG_ENDIAN);
|
|
offset += 1;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_block_nr, tvb, offset,
|
|
2, ENC_BIG_ENDIAN);
|
|
offset += 2;
|
|
proto_tree_add_item(sbus_tree,
|
|
hf_sbus_rdwr_block_size, tvb, offset,
|
|
4, ENC_BIG_ENDIAN);
|
|
offset += 4;
|
|
/*do not display block_timestamp as no description is available*/
|
|
offset += (sbus_rdwr_length-8);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
break;
|
|
|
|
/*Inform that response was not dissected and add remaining length*/
|
|
default:
|
|
sbus_helper = sbus_eth_len - (offset + 2);
|
|
proto_tree_add_expert(sbus_tree, pinfo, &ei_sbus_telegram_not_implemented, tvb, offset, sbus_helper);
|
|
offset = offset + sbus_helper;
|
|
break;
|
|
}
|
|
} else if (sbus_attribut == SBUS_RESPONSE && (!request_val)) {
|
|
/*calculate the offset in case the request telegram was not found or was broadcasted*/
|
|
sbus_eth_len = tvb_get_ntohl(tvb,0);
|
|
sbus_helper = sbus_eth_len - 11;
|
|
proto_tree_add_expert(sbus_tree, pinfo, &ei_sbus_no_request_telegram, tvb, offset, sbus_helper);
|
|
offset = sbus_eth_len - 2;
|
|
}
|
|
|
|
if (sbus_attribut == SBUS_ACKNAK) {
|
|
/*Add response time if possible*/
|
|
if (request_val) {
|
|
nstime_delta(&ns, &pinfo->fd->abs_ts, &request_val->req_time);
|
|
proto_tree_add_time(sbus_tree, hf_sbus_response_time,
|
|
tvb, 0, 0, &ns);
|
|
/*add reference to request telegram*/
|
|
proto_tree_add_uint(sbus_tree, hf_sbus_response_to, tvb, 0, 0,
|
|
request_val->req_frame);
|
|
}
|
|
hi = proto_tree_add_item(sbus_tree,
|
|
hf_sbus_acknackcode, tvb, offset, 2, ENC_BIG_ENDIAN);
|
|
if (tvb_get_guint8(tvb, (offset+1)) > 0) {
|
|
expert_add_info(pinfo, hi, &ei_sbus_telegram_not_acked);
|
|
}
|
|
offset += 2;
|
|
}
|
|
|
|
/* Calclulate CRC */
|
|
sbus_crc_calc = 0;
|
|
for (i = 0; i < sbus_eth_len - 2; i++)
|
|
sbus_crc_calc = crc_calc (sbus_crc_calc, tvb_get_guint8(tvb, i));
|
|
/*Show CRC and add hidden item for wrong CRC*/
|
|
sbus_helper = tvb_get_ntohs(tvb, offset);
|
|
if (sbus_helper == sbus_crc_calc) {
|
|
proto_tree_add_uint_format_value(sbus_tree,
|
|
hf_sbus_crc, tvb, offset, 2, sbus_helper,
|
|
"0x%04x (correct)", sbus_helper);
|
|
} else {
|
|
cs = proto_tree_add_uint_format_value(sbus_tree,
|
|
hf_sbus_crc, tvb, offset, 2, sbus_helper,
|
|
"0x%04x (NOT correct)", sbus_helper);
|
|
expert_add_info(pinfo, cs, &ei_sbus_crc_bad);
|
|
hi = proto_tree_add_boolean(sbus_tree,
|
|
hf_sbus_crc_bad, tvb, offset, 2, TRUE);
|
|
PROTO_ITEM_SET_HIDDEN(hi);
|
|
PROTO_ITEM_SET_GENERATED(hi);
|
|
}
|
|
offset += 2; /*now at the end of the telegram*/
|
|
}
|
|
return offset;
|
|
/*End of dissect_sbus*/
|
|
}
|
|
|
|
/* Register the protocol with Wireshark */
|
|
|
|
void
|
|
proto_register_sbus(void)
|
|
{
|
|
|
|
/* Setup list of header fields See Section 1.6.1 for details*/
|
|
static hf_register_info hf[] = {
|
|
{ &hf_sbus_length,
|
|
{ "Length (bytes)", "sbus.len",
|
|
FT_UINT32, BASE_DEC, NULL, 0,
|
|
"SAIA Ether-S-Bus telegram length", HFILL }
|
|
},
|
|
{ &hf_sbus_version,
|
|
{ "Version", "sbus.vers",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
"SAIA Ether-S-Bus version", HFILL }
|
|
},
|
|
{ &hf_sbus_protocol,
|
|
{ "Protocol type", "sbus.proto",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
"SAIA Ether-S-Bus protocol type", HFILL }
|
|
},
|
|
{ &hf_sbus_sequence,
|
|
{ "Sequence", "sbus.seq",
|
|
FT_UINT16, BASE_DEC, NULL, 0,
|
|
"SAIA Ether-S-Bus sequence number", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_attribut,
|
|
{ "Telegram attribute", "sbus.att",
|
|
FT_UINT8, BASE_HEX, VALS(sbus_att_vals), 0,
|
|
"SAIA Ether-S-Bus telegram attribute, indicating type of telegram", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_dest,
|
|
{ "Destination", "sbus.destination",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
"SAIA S-Bus destination address", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_address,
|
|
{ "S-Bus address", "sbus.address",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
"SAIA S-Bus station address", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_command,
|
|
{ "Command", "sbus.cmd",
|
|
FT_UINT8, BASE_HEX | BASE_EXT_STRING, &sbus_command_vals_ext, 0,
|
|
"SAIA S-Bus command", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_command_extension,
|
|
{ "Command extension", "sbus.cmd_extn",
|
|
FT_UINT8, BASE_HEX, NULL, 0,
|
|
"SAIA S-Bus command extension", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_rcount,
|
|
{ "R-count", "sbus.rcount",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
"Number of elements expected in response", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_wcount,
|
|
{ "W-count (raw)", "sbus.wcount",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
"Number of bytes to be written", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_wcount_calculated,
|
|
{ "W-count (32 bit values)", "sbus.wcount_calc",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
"Number of elements to be written", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_fio_count,
|
|
{ "FIO Count (amount of bits)", "sbus.fio_count",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
"Number of binary elements to be written", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_addr_rtc,
|
|
{ "Base address RTC", "sbus.addr_RTC",
|
|
FT_UINT16, BASE_DEC, NULL, 0,
|
|
"Base address of 32 bit elements to read", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_addr_iof,
|
|
{ "Base address IOF", "sbus.addr_IOF",
|
|
FT_UINT16, BASE_DEC, NULL, 0,
|
|
"Base address of binary elements to read", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_addr_eeprom,
|
|
{ "Base address of EEPROM register", "sbus.addr_EEPROM",
|
|
FT_UINT16, BASE_DEC, NULL, 0,
|
|
"Base address of 32 bit EEPROM register to read or write", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_addr_prog,
|
|
{ "Base address of user memory or program lines", "sbus.addr_prog",
|
|
FT_UINT24, BASE_DEC, NULL, 0,
|
|
"Base address of the user memory or program lines (read or write)", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_addr_68k,
|
|
{ "Base address of bytes", "sbus.addr_68k",
|
|
FT_UINT24, BASE_HEX, NULL, 0,
|
|
"Base address of bytes to read or write (68k address)", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_block_type,
|
|
{ "Block type", "sbus.block_type",
|
|
FT_UINT8, BASE_HEX | BASE_EXT_STRING, &sbus_block_types_ext, 0,
|
|
"Program block type", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_block_nr,
|
|
{ "Block/Element nr", "sbus.block_nr",
|
|
FT_UINT16, BASE_DEC, NULL, 0,
|
|
"Program block / DatatBlock number", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_nbr_elements,
|
|
{ "Number of elements", "sbus.nbr_elements",
|
|
FT_UINT16, BASE_DEC, NULL, 0,
|
|
"Number of elements or characters", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_display_register,
|
|
{ "PCD Display register", "sbus.data_display_register",
|
|
FT_UINT32, BASE_DEC, NULL, 0,
|
|
"The PCD display register (32 bit value)", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_data_rtc,
|
|
{ "S-Bus 32-bit data", "sbus.data_rtc",
|
|
FT_UINT32, BASE_DEC, NULL, 0,
|
|
"One regiser/timer of counter (32 bit value)", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_data_byte,
|
|
{ "Data bytes", "sbus.data_byte",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
"One byte from PCD", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_data_byte_hex,
|
|
{ "Data bytes (hex)", "sbus.data_byte_hex",
|
|
FT_UINT8, BASE_HEX, NULL, 0,
|
|
"One byte from PCD (hexadecimal)", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_data_iof,
|
|
{ "S-Bus binary data", "sbus.data_iof",
|
|
FT_UINT32, BASE_DEC, NULL, 0,
|
|
"8 binaries", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_cpu_type,
|
|
{ "PCD type", "sbus.pcd_type",
|
|
FT_STRING, BASE_NONE, NULL, 0,
|
|
"PCD type (short form)", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_fw_version,
|
|
{ "Firmware version", "sbus.fw_version",
|
|
FT_STRING, BASE_NONE, NULL, 0,
|
|
"Firmware version of the PCD or module", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_sysinfo_nr,
|
|
{ "System information number", "sbus.sysinfo",
|
|
FT_UINT8, BASE_HEX, NULL, 0,
|
|
"System information number (extension to command code)", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_sysinfo0_1,
|
|
{ "Mem size info", "sbus.sysinfo0.mem",
|
|
FT_BOOLEAN, 8, TFS(&tfs_sbus_present), F_MEMSIZE,
|
|
"Availability of memory size information", HFILL }
|
|
},
|
|
{ &hf_sbus_sysinfo0_2,
|
|
{ "Trace buffer", "sbus.sysinfo0.trace",
|
|
FT_BOOLEAN, 8, TFS(&tfs_sbus_present), F_TRACE,
|
|
"Availability of trace buffer feature", HFILL }
|
|
},
|
|
{ &hf_sbus_sysinfo0_3,
|
|
{ "Slot B1", "sbus.sysinfo0.b1",
|
|
FT_BOOLEAN, 8, TFS(&tfs_sbus_present), F_INFO_B1,
|
|
"Presence of EEPROM information on slot B1", HFILL }
|
|
},
|
|
{ &hf_sbus_sysinfo0_4,
|
|
{ "Slot B2", "sbus.sysinfo0.b2",
|
|
FT_BOOLEAN, 8, TFS(&tfs_sbus_present), F_INFO_B2,
|
|
"Presence of EEPROM information on slot B2", HFILL }
|
|
},
|
|
{ &hf_sbus_sysinfo0_5,
|
|
{ "PGU baud", "sbus.sysinfo0.pgubaud",
|
|
FT_BOOLEAN, 8, TFS(&tfs_sbus_present), F_PGU_BAUD,
|
|
"Availability of PGU baud switch feature", HFILL }
|
|
},
|
|
|
|
#if 0
|
|
{ &hf_sbus_sysinfo_length,
|
|
{ "System information length", "sbus.sysinfo_length",
|
|
FT_UINT8, BASE_HEX, NULL, 0,
|
|
"System information length in response", HFILL }
|
|
},
|
|
#endif
|
|
|
|
#if 0
|
|
{ &hf_sbus_f_module_type,
|
|
{ "F-module type", "sbus.fmodule_type",
|
|
FT_STRING, BASE_NONE, NULL, 0,
|
|
"Module type mounted on B1/2 slot", HFILL }
|
|
},
|
|
#endif
|
|
|
|
#if 0
|
|
{ &hf_sbus_harware_version,
|
|
{ "Hardware version", "sbus.hw_version",
|
|
FT_STRING, BASE_NONE, NULL, 0,
|
|
"Hardware version of the PCD or the module", HFILL }
|
|
},
|
|
#endif
|
|
|
|
#if 0
|
|
{ &hf_sbus_hardware_modification,
|
|
{ "Hardware modification", "sbus.hw_modification",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
"Hardware modification of the PCD or module", HFILL }
|
|
},
|
|
#endif
|
|
|
|
#if 0
|
|
{ &hf_sbus_various,
|
|
{ "Various data", "sbus.various",
|
|
FT_NONE, BASE_NONE, NULL, 0,
|
|
"Various data contained in telegrams but nobody will search for it", HFILL }
|
|
},
|
|
#endif
|
|
|
|
{ &hf_sbus_acknackcode,
|
|
{ "ACK/NAK code", "sbus.nakcode",
|
|
FT_UINT16, BASE_HEX, VALS(sbus_ack_nak_vals), 0,
|
|
"SAIA S-Bus ACK/NAK response", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_cpu_status,
|
|
{ "CPU status", "sbus.CPU_status",
|
|
FT_UINT8, BASE_HEX, VALS(sbus_CPU_status), 0,
|
|
"SAIA PCD CPU status", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_week_day,
|
|
{ "Calendar week", "sbus.rtc.week_day",
|
|
FT_UINT16, BASE_HEX, NULL, 0,
|
|
"Calendar week and week day number of the real time clock", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_date,
|
|
{ "RTC date (YYMMDD)", "sbus.rtc.date",
|
|
FT_UINT24, BASE_HEX, NULL, 0,
|
|
"Year, month and day of the real time clock", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_time,
|
|
{ "RTC time (HHMMSS)", "sbus.rtc.time",
|
|
FT_UINT24, BASE_HEX, NULL, 0,
|
|
"Time of the real time clock", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_web_size,
|
|
{ "Web server packet size", "sbus.web.size",
|
|
FT_UINT8, BASE_HEX, NULL, 0,
|
|
NULL, HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_web_aid,
|
|
{ "AID", "sbus.web.aid",
|
|
FT_UINT8, BASE_HEX, NULL, 0,
|
|
"Web server command/status code (AID)", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_web_seq,
|
|
{ "Sequence", "sbus.web.seq",
|
|
FT_UINT8, BASE_HEX, NULL, 0,
|
|
"Web server sequence nr (PACK_N)", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_rdwr_block_length,
|
|
{ "Read/write block telegram length", "sbus.block.length",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
NULL, HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_rdwr_block_length_ext,
|
|
{ "Extended length (bytes)", "sbus.len_ext",
|
|
FT_UINT32, BASE_DEC, NULL, 0,
|
|
NULL, HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_rdwr_telegram_type,
|
|
{ "Read/write block telegram type", "sbus.block.tlgtype",
|
|
FT_UINT8, BASE_HEX | BASE_EXT_STRING, &rdwrblock_vals_ext, 0,
|
|
"Type of RD/WR block telegram", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_rdwr_telegram_sequence,
|
|
{ "Sequence", "sbus.block.seq",
|
|
FT_UINT8, BASE_DEC, NULL, 0,
|
|
"Sequence number of block data stream telegram", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_rdwr_block_size,
|
|
{ "Block size in bytes", "sbus.block.size",
|
|
FT_UINT32, BASE_DEC, NULL, 0,
|
|
"The size of the block in bytes", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_rdwr_block_addr,
|
|
{ "Address inside block", "sbus.block.addr",
|
|
FT_UINT32, BASE_DEC, NULL, 0,
|
|
"The address inside a block", HFILL }
|
|
},
|
|
|
|
|
|
{ &hf_sbus_rdwr_file_name,
|
|
{ "File name", "sbus.block.filename",
|
|
FT_STRING, BASE_NONE, NULL, 0,
|
|
"Name of file to in RD/WR block telegram", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_rdwr_list_type,
|
|
{ "Get program block list, command type", "sbus.block.getlisttype",
|
|
FT_UINT8, BASE_HEX, VALS(rdwrblock_list_type_vals), 0,
|
|
"Type of the Get Program Block list request", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_rdwr_acknakcode,
|
|
{ "ACK/NAK code", "sbus.block.nakcode",
|
|
FT_UINT8, BASE_HEX | BASE_EXT_STRING, &rdwrblock_sts_ext, 0,
|
|
"ACK/NAK response for block write requests", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_crc,
|
|
{ "Checksum", "sbus.crc",
|
|
FT_UINT16, BASE_HEX, NULL, 0,
|
|
"CRC 16", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_crc_bad,
|
|
{ "Bad Checksum", "sbus.crc_bad",
|
|
FT_BOOLEAN, BASE_NONE, NULL, 0x0,
|
|
"A bad checksum in the telegram", HFILL }},
|
|
|
|
{ &hf_sbus_flags_accu,
|
|
{ "ACCU", "sbus.flags.accu",
|
|
FT_BOOLEAN, 8, TFS(&tfs_sbus_flags), F_ACCU,
|
|
"PCD Accumulator", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_flags_error,
|
|
{ "Error flag", "sbus.flags.error",
|
|
FT_BOOLEAN, 8, TFS(&tfs_sbus_flags), F_ERROR,
|
|
"PCD error flag", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_flags_negative,
|
|
{ "N-flag", "sbus.flags.nflag",
|
|
FT_BOOLEAN, 8, TFS(&tfs_sbus_flags), F_NEGATIVE,
|
|
"Negative status flag", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_flags_zero,
|
|
{ "Z-flag", "sbus.flags.zflag",
|
|
FT_BOOLEAN, 8, TFS(&tfs_sbus_flags), F_ZERO,
|
|
"Zero status flag", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_response_in,
|
|
{ "Response in frame nr.", "sbus.response_in",
|
|
FT_FRAMENUM, BASE_NONE, NULL, 0x0,
|
|
"The response to this Ether-S-Bus request is in this frame", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_response_to,
|
|
{ "Request in frame nr.", "sbus.response_to",
|
|
FT_FRAMENUM, BASE_NONE, NULL, 0x0,
|
|
"This is a response to the Ether-S-Bus request in this frame", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_response_time,
|
|
{ "Response time", "sbus.response_time",
|
|
FT_RELATIVE_TIME, BASE_NONE, NULL, 0x0,
|
|
"The time between the request and the response", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_timeout,
|
|
{ "Time passed since first request", "sbus.timeout",
|
|
FT_RELATIVE_TIME, BASE_NONE, NULL, 0x0,
|
|
"The time between the first (identical) request and the repetition", HFILL }
|
|
},
|
|
|
|
{ &hf_sbus_request_in,
|
|
{ "First request in frame nr.", "sbus.request_in",
|
|
FT_FRAMENUM, BASE_NONE, NULL, 0x0,
|
|
"The first request of this repeated request is in this frame", HFILL }
|
|
}
|
|
|
|
};
|
|
|
|
/* Setup protocol subtree array */
|
|
static gint *ett[] = {
|
|
&ett_sbus,
|
|
&ett_sbus_ether,
|
|
&ett_sbus_data
|
|
};
|
|
|
|
static ei_register_info ei[] = {
|
|
{ &ei_sbus_retry, { "sbus.retry", PI_SEQUENCE, PI_NOTE, "Repeated telegram (due to timeout?)", EXPFILL }},
|
|
{ &ei_sbus_telegram_not_acked, { "sbus.telegram_not_acked", PI_RESPONSE_CODE, PI_CHAT, "Telegram not acknowledged by PCD", EXPFILL }},
|
|
{ &ei_sbus_crc_bad, { "sbus.crc_bad.expert", PI_CHECKSUM, PI_ERROR, "Bad checksum", EXPFILL }},
|
|
{ &ei_sbus_telegram_not_implemented, { "sbus.telegram_not_implemented", PI_UNDECODED, PI_WARN, "This telegram isn't implemented in the dissector", EXPFILL }},
|
|
{ &ei_sbus_no_request_telegram, { "sbus.no_request_telegram", PI_UNDECODED, PI_WARN, "Not dissected, could not find request telegram", EXPFILL }},
|
|
};
|
|
|
|
expert_module_t* expert_sbus;
|
|
|
|
/* Register the protocol name and description */
|
|
proto_sbus = proto_register_protocol("SAIA S-Bus", "SBUS", "sbus");
|
|
|
|
/* Required function calls to register the header fields and subtrees used */
|
|
proto_register_field_array(proto_sbus, hf, array_length(hf));
|
|
proto_register_subtree_array(ett, array_length(ett));
|
|
expert_sbus = expert_register_protocol(proto_sbus);
|
|
expert_register_field_array(expert_sbus, ei, array_length(ei));
|
|
register_init_routine(&sbus_init_protocol);
|
|
register_cleanup_routine(&sbus_cleanup_protocol);
|
|
}
|
|
|
|
void
|
|
proto_reg_handoff_sbus(void)
|
|
{
|
|
dissector_handle_t sbus_handle;
|
|
|
|
sbus_handle = new_create_dissector_handle(dissect_sbus, proto_sbus);
|
|
dissector_add_uint("udp.port", 5050, sbus_handle);
|
|
}
|
|
|
|
/*
|
|
* Editor modelines
|
|
*
|
|
* Local Variables:
|
|
* c-basic-offset: 7
|
|
* tab-width: 8
|
|
* indent-tabs-mode: nil
|
|
* End:
|
|
*
|
|
* ex: set shiftwidth=7 tabstop=8 expandtab:
|
|
* :indentSize=7:tabSize=8:noTabs=true:
|
|
*/
|