Open-Mesh » batman-adv

#define BATADV_OGM2_V15 0x04

struct ogm2_packet_v15 {

guint8 packet_type;

guint8 version;

guint8 ttl;

guint8 flags;

guint32 seqno;

address orig;

guint16 tvlv_len;

guint32 throughput;

};

#define OGM2_PACKET_V15_SIZE 20

static gint ett_batadv_ogm2 = -1;

static gint ett_batadv_ogm2_flags = -1;

static int hf_batadv_ogm2_version = -1;

static int hf_batadv_ogm2_ttl = -1;

static int hf_batadv_ogm2_flags = -1;

static int hf_batadv_ogm2_seqno = -1;

static int hf_batadv_ogm2_orig = -1;

static int hf_batadv_ogm2_tvlv_len = -1;

static int hf_batadv_ogm2_throughput = -1;

static void dissect_batadv_ogm2(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree);

static int dissect_batadv_ogm2_v15(tvbuff_t *tvb, int offset, packet_info *pinfo, proto_tree *tree);

case BATADV_OGM2_V15:

dissect_batadv_ogm2(tvb, pinfo, tree);

break;

static void dissect_batadv_ogm2(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree)

{

guint8 version;

int offset = 0;

/* set protocol name */

col_set_str(pinfo->cinfo, COL_PROTOCOL, "BATADV_OGM2");

version = tvb_get_guint8(tvb, 1);

switch (version) {

case 15:

while (offset != -1 &&

tvb_reported_length_remaining(tvb, offset) >= OGM2_PACKET_V15_SIZE) {

offset = dissect_batadv_ogm2_v15(tvb, offset, pinfo, tree);

}

break;

default:

col_add_fstr(pinfo->cinfo, COL_INFO, "Unsupported Version %d", version);

call_data_dissector(tvb, pinfo, tree);

break;

}

}

static int dissect_batadv_ogm2_v15(tvbuff_t *tvb, int offset,

packet_info *pinfo, proto_tree *tree)

{

proto_tree *batadv_ogm2_tree = NULL;

proto_item *throughput_item;

guint8 type, version;

struct ogm2_packet_v15 *ogm2_packeth;

tvbuff_t *next_tvb;

static const int * flags[] = {

NULL

};

type = tvb_get_guint8(tvb, offset+0);

version = tvb_get_guint8(tvb, offset+1);

/* don't interpret padding as B.A.T.M.A.N. advanced packet */

if (version == 0 || type != BATADV_OGM2_V15)

return -1;

ogm2_packeth = (struct ogm2_packet_v15 *)wmem_alloc(wmem_packet_scope(),

sizeof(struct ogm2_packet_v15));

/* Set tree info */

if (tree) {

proto_item *ti;

ogm2_packeth->tvlv_len = tvb_get_ntohs(tvb, 16);

ti = proto_tree_add_protocol_format(tree, proto_batadv_plugin,

tvb, offset,

OGM2_PACKET_V15_SIZE + ogm2_packeth->tvlv_len,

"B.A.T.M.A.N. OGM2, Orig: %s",

tvb_address_with_resolution_to_str(wmem_packet_scope(), tvb, AT_ETHER, offset + 8));

batadv_ogm2_tree = proto_item_add_subtree(ti, ett_batadv_ogm2);

}

/* items */

ogm2_packeth->packet_type = tvb_get_guint8(tvb, offset);

proto_tree_add_uint_format_value(batadv_ogm2_tree,

hf_batadv_packet_type,

tvb, offset, 1, BATADV_OGM2_V15,

"%s (%u)", "BATADV_OGM2",

BATADV_OGM2_V15);

offset += 1;

ogm2_packeth->version = tvb_get_guint8(tvb, offset);

proto_tree_add_item(batadv_ogm2_tree, hf_batadv_ogm2_version, tvb,

offset, 1, ENC_BIG_ENDIAN);

offset += 1;

ogm2_packeth->ttl = tvb_get_guint8(tvb, offset);

proto_tree_add_item(batadv_ogm2_tree, hf_batadv_ogm2_ttl, tvb,

offset, 1, ENC_BIG_ENDIAN);

offset += 1;

ogm2_packeth->flags = tvb_get_guint8(tvb, offset);

proto_tree_add_bitmask(batadv_ogm2_tree, tvb, offset,

hf_batadv_ogm2_flags, ett_batadv_ogm2_flags,

flags, ENC_NA);

offset += 1;

ogm2_packeth->seqno = tvb_get_ntohl(tvb, offset);

proto_tree_add_item(batadv_ogm2_tree, hf_batadv_ogm2_seqno, tvb,

offset, 4, ENC_BIG_ENDIAN);

col_add_fstr(pinfo->cinfo, COL_INFO, "Seq=%u", ogm2_packeth->seqno);

offset += 4;

set_address_tvb(&ogm2_packeth->orig, AT_ETHER, 6, tvb, offset);

set_address_tvb(&pinfo->dl_src, AT_ETHER, 6, tvb, offset);

set_address_tvb(&pinfo->src, AT_ETHER, 6, tvb, offset);

proto_tree_add_item(batadv_ogm2_tree, hf_batadv_ogm2_orig, tvb,

offset, 6, ENC_NA);

offset += 6;

ogm2_packeth->tvlv_len = tvb_get_ntohs(tvb, offset);

proto_tree_add_item(batadv_ogm2_tree, hf_batadv_ogm2_tvlv_len, tvb,

offset, 2, ENC_BIG_ENDIAN);

offset += 2;

ogm2_packeth->throughput = tvb_get_ntohl(tvb, offset);

throughput_item = proto_tree_add_item(batadv_ogm2_tree,

hf_batadv_ogm2_throughput, tvb,

offset, 4, ENC_BIG_ENDIAN);

proto_item_set_text(throughput_item, "Throughput: %u.%u Mbit/s",

ogm2_packeth->throughput / 10,

ogm2_packeth->throughput % 10);

offset += 4;

tap_queue_packet(batadv_tap, pinfo, ogm2_packeth);

if (ogm2_packeth->tvlv_len > 0) {

next_tvb = tvb_new_subset_length(tvb, offset,

ogm2_packeth->tvlv_len);

if (have_tap_listener(batadv_follow_tap)) {

tap_queue_packet(batadv_follow_tap, pinfo, next_tvb);

}

dissect_batadv_tvlv_v15(next_tvb, pinfo, batadv_ogm2_tree);

offset += ogm2_packeth->tvlv_len;

}

return offset;

}

{ &hf_batadv_ogm2_version,

{ "Version", "batadv.ogm2.version",

FT_UINT8, BASE_DEC, NULL, 0x0,

NULL, HFILL }

},

{ &hf_batadv_ogm2_ttl,

{ "Time to Live", "batadv.ogm2.ttl",

FT_UINT8, BASE_DEC, NULL, 0x0,

NULL, HFILL }

},

{ &hf_batadv_ogm2_flags,

{ "Flags", "batadv.ogm2.flags",

FT_UINT8, BASE_HEX, NULL, 0x0,

NULL, HFILL }

},

{ &hf_batadv_ogm2_seqno,

{ "Sequence number", "batadv.ogm2.seq",

FT_UINT32, BASE_DEC, NULL, 0x0,

NULL, HFILL }

},

{ &hf_batadv_ogm2_orig,

{ "Originator", "batadv.ogm2.orig",

FT_ETHER, BASE_NONE, NULL, 0x0,

NULL, HFILL }

},

{ &hf_batadv_ogm2_tvlv_len,

{ "Length of TVLV", "batadv.ogm2.tvlv_len",

FT_UINT16, BASE_DEC, NULL, 0x0,

NULL, HFILL }

},

{ &hf_batadv_ogm2_throughput,

{ "Throughput", "batadv.ogm2.throughput",

FT_UINT32, BASE_DEC, NULL, 0x0,

NULL, HFILL }

},

&ett_batadv_ogm2,

&ett_batadv_ogm2_flags,