forked from osmocom/wireshark
![Jeff Morriss](/assets/img/avatar_default.png)
are like the non-TVB versions except that they take a TVB and an offset instead of (frequently) a pointer into the TVB. Calling tvb_get_ptr() before modifying the rest of the fields should help fix https://bugs.wireshark.org/bugzilla/show_bug.cgi?id=7960 (though I can't reproduce that problem). Replace a bunch of calls like: SET_ADDRESS(..., AT_XXX, length, tvb_get_ptr(tvb, offset, length)); with: TVB_SET_ADDRESS(..., AT_XXX, tvb, offset, length); svn path=/trunk/; revision=46324
755 lines
22 KiB
C
755 lines
22 KiB
C
/* packet-slimp3.c
|
|
* Routines for SliMP3 protocol dissection
|
|
*
|
|
* Ashok Narayanan <ashokn@cisco.com>
|
|
*
|
|
* Adds support for the data packet protocol for the SliMP3
|
|
* See www.slimdevices.com for details.
|
|
*
|
|
* $Id$
|
|
*
|
|
* Wireshark - Network traffic analyzer
|
|
* By Gerald Combs <gerald@wireshark.org>
|
|
* Copyright 1998 Gerald Combs
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
*/
|
|
|
|
#include "config.h"
|
|
|
|
#include <glib.h>
|
|
#include <string.h>
|
|
#include <ctype.h>
|
|
#include <epan/packet.h>
|
|
|
|
#include "isprint.h"
|
|
|
|
static int proto_slimp3 = -1;
|
|
static int hf_slimp3_opcode = -1;
|
|
static int hf_slimp3_ir = -1;
|
|
static int hf_slimp3_display = -1;
|
|
static int hf_slimp3_control = -1;
|
|
static int hf_slimp3_hello = -1;
|
|
static int hf_slimp3_i2c = -1;
|
|
static int hf_slimp3_data_request = -1;
|
|
static int hf_slimp3_data = -1;
|
|
static int hf_slimp3_discover_request = -1;
|
|
static int hf_slimp3_discover_response = -1;
|
|
static int hf_slimp3_data_ack = -1;
|
|
|
|
static gint ett_slimp3 = -1;
|
|
|
|
#define UDP_PORT_SLIMP3_V1 1069
|
|
#define UDP_PORT_SLIMP3_V2 3483
|
|
|
|
#define SLIMP3_IR 'i'
|
|
#define SLIMP3_CONTROL 's'
|
|
#define SLIMP3_HELLO 'h'
|
|
#define SLIMP3_DATA 'm'
|
|
#define SLIMP3_DATA_REQ 'r'
|
|
#define SLIMP3_DISPLAY 'l'
|
|
#define SLIMP3_I2C '2'
|
|
#define SLIMP3_DISC_REQ 'd'
|
|
#define SLIMP3_DISC_RSP 'D'
|
|
#define SLIMP3_DATA_ACK 'a'
|
|
|
|
static const value_string slimp3_opcode_vals[] = {
|
|
{ SLIMP3_IR, "Infrared Remote Code" },
|
|
{ SLIMP3_CONTROL, "Stream Control" },
|
|
{ SLIMP3_DATA, "MPEG Data" },
|
|
{ SLIMP3_DATA_REQ, "Data Request" },
|
|
{ SLIMP3_HELLO, "Hello" },
|
|
{ SLIMP3_DISPLAY, "Display" },
|
|
{ SLIMP3_I2C, "I2C" },
|
|
{ SLIMP3_DISC_REQ, "Discovery Request" },
|
|
{ SLIMP3_DISC_RSP, "Discovery Response" },
|
|
{ SLIMP3_DATA_ACK, "Ack" },
|
|
{ 0, NULL }
|
|
};
|
|
|
|
/* IR remote control types */
|
|
static const value_string slimp3_ir_types[] = {
|
|
{ 0x02, "SLIMP3" },
|
|
{ 0xff, "JVC DVD Player" },
|
|
|
|
{ 0, NULL }
|
|
};
|
|
|
|
/* IR codes for the custom SLIMP3 remote control */
|
|
static const value_string slimp3_ir_codes_slimp3[] = {
|
|
{ 0x76899867, "0" },
|
|
{ 0x7689f00f, "1" },
|
|
{ 0x768908f7, "2" },
|
|
{ 0x76898877, "3" },
|
|
{ 0x768948b7, "4" },
|
|
{ 0x7689c837, "5" },
|
|
{ 0x768928d7, "6" },
|
|
{ 0x7689a857, "7" },
|
|
{ 0x76896897, "8" },
|
|
{ 0x7689e817, "9" },
|
|
{ 0x7689b04f, "arrow_down" },
|
|
{ 0x7689906f, "arrow_left" },
|
|
{ 0x7689d02f, "arrow_right" },
|
|
{ 0x7689e01f, "arrow_up" },
|
|
{ 0x768900ff, "voldown" },
|
|
{ 0x7689807f, "volup" },
|
|
{ 0x768940bf, "power" },
|
|
{ 0x7689c03f, "rew" },
|
|
{ 0x768920df, "pause" },
|
|
{ 0x7689a05f, "fwd" },
|
|
{ 0x7689609f, "add" },
|
|
{ 0x768910ef, "play" },
|
|
{ 0x768958a7, "search" },
|
|
{ 0x7689d827, "shuffle" },
|
|
{ 0x768938c7, "repeat" },
|
|
{ 0x7689b847, "sleep" },
|
|
{ 0x76897887, "now_playing" },
|
|
{ 0x7689f807, "size" },
|
|
{ 0x768904fb, "brightness" },
|
|
|
|
{ 0, NULL }
|
|
};
|
|
|
|
/* IR codes for the JVC remote control */
|
|
static const value_string slimp3_ir_codes_jvc[] = {
|
|
{ 0xf786, "One" },
|
|
{ 0xf746, "Two" },
|
|
{ 0xf7c6, "Three" },
|
|
{ 0xf726, "Four" },
|
|
{ 0xf7a6, "Five" },
|
|
{ 0xf766, "Six" },
|
|
{ 0xf7e6, "Seven" },
|
|
{ 0xf716, "Eight" },
|
|
{ 0xf796, "Nine" },
|
|
{ 0xf776, "Ten" },
|
|
|
|
{ 0xf7f6, "Picture-In-Picture" },
|
|
/* { 0xf7XX, "Enter" }, */
|
|
{ 0xf70e, "Back" },
|
|
{ 0xf732, "Play" },
|
|
{ 0xf76e, "Forward" },
|
|
{ 0xf743, "Record" },
|
|
{ 0xf7c2, "Stop" },
|
|
{ 0xf7b2, "Pause" },
|
|
/* { 0xf7XX, "TV/Video" }, */
|
|
{ 0xf703, "Display" },
|
|
{ 0xf7b3, "Sleep" },
|
|
{ 0xf7b6, "Guide" },
|
|
{ 0xf70b, "Up" },
|
|
{ 0xf74b, "Left" },
|
|
{ 0xf7cb, "Right" },
|
|
{ 0xf78b, "Down" },
|
|
{ 0xf783, "Menu" },
|
|
{ 0xf72b, "OK" },
|
|
{ 0xf778, "Volume Up" },
|
|
{ 0xf7f8, "Volume Down" },
|
|
{ 0xf70d, "Channel Up" },
|
|
{ 0xf78d, "Channel Down" },
|
|
/* { 0xf7XX, "Mute" }, */
|
|
{ 0xf7ab, "Recall" },
|
|
{ 0xf702, "Power" },
|
|
|
|
{ 0, NULL }
|
|
};
|
|
|
|
|
|
static const value_string slimp3_display_commands[] = {
|
|
{ 0x1, "Clear Display"},
|
|
{ 0x2, "Cursor to 1st Line Home"},
|
|
|
|
{ 0x4, "Mode: Decrement Address, Shift Cursor"},
|
|
{ 0x5, "Mode: Decrement Address, Shift Display"},
|
|
{ 0x6, "Mode: Increment Address, Shift Cursor"},
|
|
{ 0x7, "Mode: Increment Address, Shift Display"},
|
|
|
|
{ 0x8, "Display Off"},
|
|
{ 0xd, "Display On, With Blinking"},
|
|
{ 0xe, "Display On, With Cursor"},
|
|
{ 0xf, "Display On, With Cursor And Blinking"},
|
|
|
|
{ 0x10, "Move Cursor Left"},
|
|
{ 0x14, "Move Cursor Right"},
|
|
{ 0x18, "Shift Display Left"},
|
|
{ 0x1b, "Shift Display Right"},
|
|
|
|
{ 0x30, "Set (8-bit)"},
|
|
{ 0x20, "Set (4-bit)"},
|
|
|
|
{ 0xa0, "Cursor to Top Right"},
|
|
{ 0xc0, "Cursor to 2nd Line Home"},
|
|
|
|
{ 0, NULL},
|
|
};
|
|
|
|
static const value_string slimp3_display_fset8[] = {
|
|
{ 0x0, "Brightness 100%"},
|
|
{ 0x1, "Brightness 75%"},
|
|
{ 0x2, "Brightness 50%"},
|
|
{ 0x3, "Brightness 25%"},
|
|
|
|
{ 0, NULL },
|
|
};
|
|
|
|
static const value_string slimp3_stream_control[] = {
|
|
{ 1, "Reset buffer, Start New Stream"},
|
|
{ 2, "Pause Playback"},
|
|
{ 4, "Resume Playback"},
|
|
{ 0, NULL },
|
|
};
|
|
|
|
|
|
static const value_string slimp3_mpg_control[] = {
|
|
{ 0, "Go"}, /* Run the decoder */
|
|
{ 1, "Stop"}, /* Halt decoder but don't reset rptr */
|
|
{ 3, "Reset"}, /* Halt decoder and reset rptr */
|
|
|
|
{ 0, NULL }
|
|
};
|
|
|
|
#define MAX_LCD_STR_LEN 128
|
|
static int
|
|
dissect_slimp3(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, void *data _U_)
|
|
{
|
|
const char *opcode_str;
|
|
proto_tree *slimp3_tree = NULL;
|
|
proto_item *ti = NULL, *hidden_item;
|
|
gint i1;
|
|
gint offset = 0;
|
|
guint16 opcode;
|
|
guchar lcd_char;
|
|
char lcd_str[MAX_LCD_STR_LEN + 1];
|
|
int to_server = FALSE;
|
|
int old_protocol = FALSE;
|
|
address tmp_addr;
|
|
gboolean in_str;
|
|
int lcd_strlen;
|
|
|
|
/*
|
|
* If it doesn't begin with a known opcode, reject it, so that
|
|
* traffic that happens to be do or from one of our ports
|
|
* doesn't get misidentified as SliMP3 traffic.
|
|
*/
|
|
if (!tvb_bytes_exist(tvb, offset, 1))
|
|
return 0; /* not even an opcode */
|
|
opcode = tvb_get_guint8(tvb, offset);
|
|
opcode_str = match_strval(opcode, slimp3_opcode_vals);
|
|
if (opcode_str == NULL)
|
|
return 0;
|
|
|
|
col_set_str(pinfo->cinfo, COL_PROTOCOL, "SliMP3");
|
|
|
|
if (check_col(pinfo->cinfo, COL_INFO)) {
|
|
|
|
col_add_str(pinfo->cinfo, COL_INFO, opcode_str);
|
|
|
|
}
|
|
|
|
if (tree) {
|
|
|
|
ti = proto_tree_add_item(tree, proto_slimp3, tvb, offset, -1, ENC_NA);
|
|
slimp3_tree = proto_item_add_subtree(ti, ett_slimp3);
|
|
|
|
proto_tree_add_uint(slimp3_tree, hf_slimp3_opcode, tvb,
|
|
offset, 1, opcode);
|
|
}
|
|
|
|
/* The new protocol (v1.3 and later) uses an IANA-assigned port number.
|
|
* It usually uses the same number for both sizes of the conversation, so
|
|
* the port numbers can't always be used to determine client and server.
|
|
* The new protocol places the clients MAC address in the packet, so that
|
|
* is used to identify packets originating at the client.
|
|
*/
|
|
if ((pinfo->destport == UDP_PORT_SLIMP3_V2) && (pinfo->srcport == UDP_PORT_SLIMP3_V2)) {
|
|
TVB_SET_ADDRESS(&tmp_addr, AT_ETHER, tvb, offset+12, 6);
|
|
to_server = ADDRESSES_EQUAL(&tmp_addr, &pinfo->dl_src);
|
|
}
|
|
else if (pinfo->destport == UDP_PORT_SLIMP3_V2) {
|
|
to_server = TRUE;
|
|
}
|
|
else if (pinfo->srcport == UDP_PORT_SLIMP3_V2) {
|
|
to_server = FALSE;
|
|
}
|
|
if (pinfo->destport == UDP_PORT_SLIMP3_V1) {
|
|
to_server = TRUE;
|
|
old_protocol = TRUE;
|
|
}
|
|
else if (pinfo->srcport == UDP_PORT_SLIMP3_V1) {
|
|
to_server = FALSE;
|
|
old_protocol = TRUE;
|
|
}
|
|
|
|
switch (opcode) {
|
|
|
|
case SLIMP3_IR:
|
|
/* IR code
|
|
*
|
|
* [0] 'i' as in "IR"
|
|
* [1] 0x00
|
|
* [2..5] player's time since startup in ticks @625 KHz
|
|
* [6] IR code id, ff=JVC, 02=SLIMP3
|
|
* [7] number of meaningful bits - 16 for JVC, 32 for SLIMP3
|
|
* [8..11] the 32-bit IR code
|
|
* [12..17] reserved
|
|
*/
|
|
if (tree) {
|
|
hidden_item = proto_tree_add_item(slimp3_tree, hf_slimp3_ir, tvb, offset+8, 4, ENC_BIG_ENDIAN);
|
|
PROTO_ITEM_SET_HIDDEN(hidden_item);
|
|
|
|
i1 = tvb_get_ntohl(tvb, offset+2);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+2, 4, "Uptime: %u sec (%u ticks)",
|
|
i1/625000, i1);
|
|
i1 = tvb_get_guint8(tvb, offset+6);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+6, 1, "Code identifier: 0x%0x: %s",
|
|
i1, val_to_str_const(i1, slimp3_ir_types, "Unknown"));
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+7, 1, "Code bits: %d",
|
|
tvb_get_guint8(tvb, offset+7));
|
|
|
|
i1 = tvb_get_ntohl(tvb, offset+8);
|
|
/* Check the code to figure out which remote is being used. */
|
|
if (tvb_get_guint8(tvb, offset+6) == 0x02 &&
|
|
tvb_get_guint8(tvb, offset+7) == 32) {
|
|
/* This is the custom SLIMP3 remote. */
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+8, 4,
|
|
"Infrared Code: %s: 0x%0x",
|
|
val_to_str_const(i1, slimp3_ir_codes_slimp3, "Unknown"), i1);
|
|
}
|
|
else if (tvb_get_guint8(tvb, offset+6) == 0xff &&
|
|
tvb_get_guint8(tvb, offset+7) == 16) {
|
|
/* This is a JVC DVD player remote */
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+8, 4,
|
|
"Infrared Code: %s: 0x%0x",
|
|
val_to_str_const(i1, slimp3_ir_codes_jvc, "Unknown"), i1);
|
|
} else {
|
|
/* Unknown code; just write it */
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+8, 4, "Infrared Code: 0x%0x", i1);
|
|
}
|
|
}
|
|
if (check_col(pinfo->cinfo, COL_INFO)) {
|
|
i1 = tvb_get_ntohl(tvb, offset+8);
|
|
if (tvb_get_guint8(tvb, offset+6) == 0x02 &&
|
|
tvb_get_guint8(tvb, offset+7) == 32) {
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", SLIMP3: %s",
|
|
val_to_str(i1, slimp3_ir_codes_slimp3, "Unknown (0x%0x)"));
|
|
}
|
|
else if (tvb_get_guint8(tvb, offset+6) == 0xff &&
|
|
tvb_get_guint8(tvb, offset+7) == 16) {
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", JVC: %s",
|
|
val_to_str(i1, slimp3_ir_codes_jvc, "Unknown (0x%0x)"));
|
|
} else {
|
|
/* Unknown code; just write it */
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", 0x%0x", i1);
|
|
}
|
|
}
|
|
break;
|
|
|
|
case SLIMP3_DISPLAY:
|
|
if (tree) {
|
|
|
|
hidden_item = proto_tree_add_item(slimp3_tree, hf_slimp3_display,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
PROTO_ITEM_SET_HIDDEN(hidden_item);
|
|
|
|
/* Loop through the commands */
|
|
i1 = 18;
|
|
in_str = FALSE;
|
|
lcd_strlen = 0;
|
|
while (i1 < tvb_reported_length_remaining(tvb, offset)) {
|
|
switch(tvb_get_guint8(tvb, offset + i1)) {
|
|
case 0:
|
|
in_str = FALSE;
|
|
lcd_strlen = 0;
|
|
proto_tree_add_text(slimp3_tree, tvb, offset + i1, 2,
|
|
"Delay (%d ms)", tvb_get_guint8(tvb, offset + i1 + 1));
|
|
i1 += 2;
|
|
break;
|
|
case 3:
|
|
lcd_char = tvb_get_guint8(tvb, offset + i1 + 1);
|
|
if (!isprint(lcd_char)) lcd_char = '.';
|
|
if (ti && in_str) {
|
|
lcd_strlen += 2;
|
|
proto_item_append_text(ti, "%c", lcd_char);
|
|
proto_item_set_len(ti, lcd_strlen);
|
|
} else {
|
|
ti = proto_tree_add_text(slimp3_tree, tvb, offset + i1, 2,
|
|
"String: %c", lcd_char);
|
|
in_str = TRUE;
|
|
lcd_strlen = 2;
|
|
}
|
|
i1 += 2;
|
|
break;
|
|
|
|
case 2:
|
|
in_str = FALSE;
|
|
lcd_strlen = 0;
|
|
ti = proto_tree_add_text(slimp3_tree, tvb, offset + i1, 2,
|
|
"Command: %s",
|
|
val_to_str(tvb_get_guint8(tvb, offset + i1 + 1),
|
|
slimp3_display_commands,
|
|
"Unknown (0x%0x)"));
|
|
if ((tvb_get_guint8(tvb, offset + i1 + 1) & 0xf0) == 0x30) {
|
|
proto_item_append_text(ti, ": %s",
|
|
val_to_str(tvb_get_guint8(tvb, offset + i1 + 2),
|
|
slimp3_display_fset8,
|
|
"Unknown (0x%0x)"));
|
|
i1 += 2;
|
|
}
|
|
i1 += 2;
|
|
break;
|
|
|
|
default:
|
|
proto_tree_add_text(slimp3_tree, tvb, offset + i1, 2,
|
|
"Unknown 0x%0x, 0x%0x",
|
|
tvb_get_guint8(tvb, offset + i1),
|
|
tvb_get_guint8(tvb, offset + i1 + 1));
|
|
i1 += 2;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (check_col(pinfo->cinfo, COL_INFO)) {
|
|
i1 = 18;
|
|
lcd_strlen = 0;
|
|
while (tvb_offset_exists(tvb, offset + i1) &&
|
|
lcd_strlen < MAX_LCD_STR_LEN) {
|
|
switch (tvb_get_guint8(tvb, offset + i1)) {
|
|
|
|
case 0:
|
|
lcd_str[lcd_strlen++] = '.';
|
|
break;
|
|
|
|
case 2:
|
|
lcd_str[lcd_strlen++] = '|';
|
|
if (tvb_offset_exists(tvb, offset + i1 + 1) &&
|
|
(tvb_get_guint8(tvb, offset + i1 + 1) & 0xf0) == 0x30)
|
|
i1 += 2;
|
|
break;
|
|
|
|
case 3:
|
|
if (tvb_offset_exists(tvb, offset + i1 + 1)) {
|
|
if (lcd_strlen < 1 ||
|
|
lcd_str[lcd_strlen-1] != ' ' ||
|
|
tvb_get_guint8(tvb, offset + i1 + 1) != ' ') {
|
|
lcd_char = tvb_get_guint8(tvb, offset + i1 + 1);
|
|
lcd_str[lcd_strlen++] = isprint(lcd_char) ? lcd_char : '.';
|
|
}
|
|
}
|
|
}
|
|
i1 += 2;
|
|
}
|
|
lcd_str[lcd_strlen] = '\0';
|
|
if (lcd_strlen > 0)
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", %s", lcd_str);
|
|
}
|
|
|
|
break;
|
|
|
|
case SLIMP3_CONTROL:
|
|
if (tree) {
|
|
hidden_item = proto_tree_add_item(slimp3_tree, hf_slimp3_control,
|
|
tvb, offset+1, 1, ENC_BIG_ENDIAN);
|
|
PROTO_ITEM_SET_HIDDEN(hidden_item);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+1, 1, "Command: %s",
|
|
val_to_str(tvb_get_guint8(tvb, offset+1),
|
|
slimp3_stream_control, "Unknown (0x%0x)"));
|
|
}
|
|
|
|
if (check_col(pinfo->cinfo, COL_INFO)) {
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", %s",
|
|
val_to_str(tvb_get_guint8(tvb, offset+1),
|
|
slimp3_stream_control, "Unknown (0x%0x)"));
|
|
}
|
|
break;
|
|
|
|
case SLIMP3_HELLO:
|
|
if (tree) {
|
|
hidden_item = proto_tree_add_item(slimp3_tree, hf_slimp3_hello,
|
|
tvb, offset+1, 1, ENC_BIG_ENDIAN);
|
|
PROTO_ITEM_SET_HIDDEN(hidden_item);
|
|
if (to_server) {
|
|
guint8 fw_ver = 0;
|
|
/* Hello response; client->server */
|
|
proto_tree_add_text(slimp3_tree, tvb, offset, 1, "Hello Response (Client --> Server)");
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+1, 1, "Device ID: %d",
|
|
tvb_get_guint8(tvb, offset+1));
|
|
fw_ver = tvb_get_guint8(tvb, offset+2);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+2, 1, "Firmware Revision: %d.%d (0x%0x)",
|
|
fw_ver>>4, fw_ver & 0xf, fw_ver);
|
|
} else {
|
|
/* Hello request; server->client */
|
|
proto_tree_add_text(slimp3_tree, tvb, offset, 1, "Hello Request (Server --> Client)");
|
|
}
|
|
}
|
|
break;
|
|
|
|
case SLIMP3_I2C:
|
|
if (tree) {
|
|
hidden_item = proto_tree_add_item(slimp3_tree, hf_slimp3_i2c,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
PROTO_ITEM_SET_HIDDEN(hidden_item);
|
|
if (to_server) {
|
|
/* Hello response; client->server */
|
|
proto_tree_add_text(slimp3_tree, tvb, offset, -1,
|
|
"I2C Response (Client --> Server)");
|
|
} else {
|
|
/* Hello request; server->client */
|
|
proto_tree_add_text(slimp3_tree, tvb, offset, -1,
|
|
"I2C Request (Server --> Client)");
|
|
}
|
|
}
|
|
|
|
if (check_col(pinfo->cinfo, COL_INFO)) {
|
|
if (to_server) {
|
|
col_append_str(pinfo->cinfo, COL_INFO, ", Response");
|
|
} else {
|
|
col_append_str(pinfo->cinfo, COL_INFO, ", Request");
|
|
}
|
|
}
|
|
break;
|
|
|
|
case SLIMP3_DATA_REQ:
|
|
if (tree) {
|
|
hidden_item = proto_tree_add_item(slimp3_tree, hf_slimp3_data_request,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
PROTO_ITEM_SET_HIDDEN(hidden_item);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+2, 2,
|
|
"Requested offset: %d bytes.",
|
|
tvb_get_ntohs(tvb, offset+2)*2);
|
|
}
|
|
|
|
if (check_col(pinfo->cinfo, COL_INFO)) {
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", Offset: %d bytes",
|
|
tvb_get_ntohs(tvb, offset+2)*2);
|
|
}
|
|
break;
|
|
|
|
case SLIMP3_DATA:
|
|
/* MPEG data (v1.3 and later)
|
|
*
|
|
* [0] 'm'
|
|
* [1..5] reserved
|
|
* [6..7] Write pointer (in words)
|
|
* [8..9] reserved
|
|
* [10..11] Sequence number
|
|
* [12..17] reserved
|
|
* [18..] MPEG data
|
|
*/
|
|
if (tree) {
|
|
hidden_item = proto_tree_add_item(slimp3_tree, hf_slimp3_data,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
PROTO_ITEM_SET_HIDDEN(hidden_item);
|
|
if (old_protocol) {
|
|
proto_tree_add_text(slimp3_tree, tvb, offset, -1,
|
|
"Length: %d bytes",
|
|
tvb_reported_length_remaining(tvb, offset+18));
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+2, 2,
|
|
"Buffer offset: %d bytes.",
|
|
tvb_get_ntohs(tvb, offset+2) * 2);
|
|
}
|
|
else {
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+1, 1, "Command: %s",
|
|
val_to_str(tvb_get_guint8(tvb, offset+1),
|
|
slimp3_mpg_control, "Unknown (0x%0x)"));
|
|
proto_tree_add_text(slimp3_tree, tvb, offset, -1,
|
|
"Length: %d bytes",
|
|
tvb_reported_length_remaining(tvb, offset+18));
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+6, 2,
|
|
"Write Pointer: %d",
|
|
tvb_get_ntohs(tvb, offset+6) * 2);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+10, 2,
|
|
"Sequence: %d",
|
|
tvb_get_ntohs(tvb, offset+10));
|
|
}
|
|
}
|
|
|
|
if (check_col(pinfo->cinfo, COL_INFO)) {
|
|
if (old_protocol) {
|
|
col_append_fstr(pinfo->cinfo, COL_INFO,
|
|
", Length: %d bytes, Offset: %d bytes.",
|
|
tvb_reported_length_remaining(tvb, offset+18),
|
|
tvb_get_ntohs(tvb, offset+2) * 2);
|
|
}
|
|
else {
|
|
col_append_fstr(pinfo->cinfo, COL_INFO,
|
|
", %s, %d bytes at %d, Sequence: %d",
|
|
val_to_str(tvb_get_guint8(tvb, offset+1),
|
|
slimp3_mpg_control, "Unknown (0x%0x)"),
|
|
tvb_reported_length_remaining(tvb, offset+18),
|
|
tvb_get_ntohs(tvb, offset+6) * 2,
|
|
tvb_get_ntohs(tvb, offset+10));
|
|
}
|
|
}
|
|
break;
|
|
|
|
case SLIMP3_DISC_REQ:
|
|
if (tree) {
|
|
guint8 fw_ver;
|
|
hidden_item = proto_tree_add_item(slimp3_tree, hf_slimp3_discover_request,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
PROTO_ITEM_SET_HIDDEN(hidden_item);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+1, 1,
|
|
"Device ID: %d.", tvb_get_guint8(tvb, offset+1));
|
|
fw_ver = tvb_get_guint8(tvb, offset+2);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+2, 1, "Firmware Revision: %d.%d (0x%0x)",
|
|
fw_ver>>4, fw_ver & 0xf, fw_ver);
|
|
}
|
|
|
|
if (check_col(pinfo->cinfo, COL_INFO)) {
|
|
guint8 fw_ver = tvb_get_guint8(tvb, offset+2);
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", Device ID: %d. Firmware: %d.%d",
|
|
tvb_get_guint8(tvb, offset+1), fw_ver>>4, fw_ver & 0xf);
|
|
}
|
|
break;
|
|
|
|
case SLIMP3_DISC_RSP:
|
|
if (tree) {
|
|
hidden_item = proto_tree_add_item(slimp3_tree, hf_slimp3_discover_response,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
PROTO_ITEM_SET_HIDDEN(hidden_item);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+2, 4,
|
|
"Server Address: %s.",
|
|
tvb_ip_to_str(tvb, offset+2));
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+6, 2,
|
|
"Server Port: %d", tvb_get_ntohs(tvb, offset + 6));
|
|
}
|
|
|
|
if (check_col(pinfo->cinfo, COL_INFO)) {
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", Server Address: %s. Server Port: %d",
|
|
tvb_ip_to_str(tvb, offset+2),
|
|
tvb_get_ntohs(tvb, offset + 6));
|
|
}
|
|
break;
|
|
|
|
case SLIMP3_DATA_ACK:
|
|
/* Acknowledge MPEG data
|
|
*
|
|
* [0] 'a'
|
|
* [1..5]
|
|
* [6..7] Write pointer (in words)
|
|
* [8..9] Read pointer (in words)
|
|
* [10..11] Sequence number
|
|
* [12..17] client MAC address (v1.3 and later)
|
|
*/
|
|
if (tree) {
|
|
hidden_item = proto_tree_add_item(slimp3_tree, hf_slimp3_data_ack,
|
|
tvb, offset, 1, ENC_BIG_ENDIAN);
|
|
PROTO_ITEM_SET_HIDDEN(hidden_item);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+6, 2,
|
|
"Write Pointer: %d",
|
|
tvb_get_ntohs(tvb, offset+6) * 2);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+8, 2,
|
|
"Read Pointer: %d",
|
|
tvb_get_ntohs(tvb, offset+8) * 2);
|
|
proto_tree_add_text(slimp3_tree, tvb, offset+10, 2,
|
|
"Sequence: %d",
|
|
tvb_get_ntohs(tvb, offset+10));
|
|
}
|
|
if (check_col(pinfo->cinfo, COL_INFO)) {
|
|
col_append_fstr(pinfo->cinfo, COL_INFO, ", Sequence: %d",
|
|
tvb_get_ntohs(tvb, offset+10));
|
|
}
|
|
break;
|
|
|
|
default:
|
|
if (tree) {
|
|
proto_tree_add_text(slimp3_tree, tvb, offset, -1,
|
|
"Data (%d bytes)", tvb_reported_length_remaining(tvb, offset));
|
|
}
|
|
break;
|
|
|
|
}
|
|
return tvb_length(tvb);
|
|
}
|
|
|
|
void
|
|
proto_register_slimp3(void)
|
|
{
|
|
static hf_register_info hf[] = {
|
|
{ &hf_slimp3_opcode,
|
|
{ "Opcode", "slimp3.opcode",
|
|
FT_UINT8, BASE_DEC, VALS(slimp3_opcode_vals), 0x0,
|
|
"SLIMP3 message type", HFILL }},
|
|
|
|
{ &hf_slimp3_ir,
|
|
{ "Infrared", "slimp3.ir",
|
|
FT_UINT32, BASE_HEX, NULL, 0x0,
|
|
"SLIMP3 Infrared command", HFILL }},
|
|
|
|
{ &hf_slimp3_control,
|
|
{ "Control Packet", "slimp3.control",
|
|
FT_BOOLEAN, BASE_NONE, NULL, 0x0,
|
|
"SLIMP3 control", HFILL }},
|
|
|
|
{ &hf_slimp3_display,
|
|
{ "Display", "slimp3.display",
|
|
FT_BOOLEAN, BASE_NONE, NULL, 0x0,
|
|
"SLIMP3 display", HFILL }},
|
|
|
|
{ &hf_slimp3_hello,
|
|
{ "Hello", "slimp3.hello",
|
|
FT_BOOLEAN, BASE_NONE, NULL, 0x0,
|
|
"SLIMP3 hello", HFILL }},
|
|
|
|
{ &hf_slimp3_i2c,
|
|
{ "I2C", "slimp3.i2c",
|
|
FT_BOOLEAN, BASE_NONE, NULL, 0x0,
|
|
"SLIMP3 I2C", HFILL }},
|
|
|
|
{ &hf_slimp3_data,
|
|
{ "Data", "slimp3.data",
|
|
FT_BOOLEAN, BASE_NONE, NULL, 0x0,
|
|
"SLIMP3 Data", HFILL }},
|
|
|
|
{ &hf_slimp3_data_request,
|
|
{ "Data Request", "slimp3.data_req",
|
|
FT_BOOLEAN, BASE_NONE, NULL, 0x0,
|
|
"SLIMP3 Data Request", HFILL }},
|
|
|
|
{ &hf_slimp3_discover_request,
|
|
{ "Discovery Request", "slimp3.discovery_req",
|
|
FT_BOOLEAN, BASE_NONE, NULL, 0x0,
|
|
"SLIMP3 Discovery Request", HFILL }},
|
|
|
|
{ &hf_slimp3_discover_response,
|
|
{ "Discovery Response", "slimp3.discovery_response",
|
|
FT_BOOLEAN, BASE_NONE, NULL, 0x0,
|
|
"SLIMP3 Discovery Response", HFILL }},
|
|
|
|
{ &hf_slimp3_data_ack,
|
|
{ "Data Ack", "slimp3.data_ack",
|
|
FT_BOOLEAN, BASE_NONE, NULL, 0x0,
|
|
"SLIMP3 Data Ack", HFILL }},
|
|
|
|
};
|
|
static gint *ett[] = {
|
|
&ett_slimp3,
|
|
};
|
|
|
|
proto_slimp3 = proto_register_protocol("SliMP3 Communication Protocol",
|
|
"SliMP3", "slimp3");
|
|
proto_register_field_array(proto_slimp3, hf, array_length(hf));
|
|
proto_register_subtree_array(ett, array_length(ett));
|
|
}
|
|
|
|
void
|
|
proto_reg_handoff_slimp3(void)
|
|
{
|
|
dissector_handle_t slimp3_handle;
|
|
|
|
slimp3_handle = new_create_dissector_handle(dissect_slimp3, proto_slimp3);
|
|
dissector_add_uint("udp.port", UDP_PORT_SLIMP3_V1, slimp3_handle);
|
|
dissector_add_uint("udp.port", UDP_PORT_SLIMP3_V2, slimp3_handle);
|
|
}
|