From Aaron Woo (via Jeff Weston): Optimized Link State Routing Protocol
(OLSR) support. svn path=/trunk/; revision=9673
This commit is contained in:
parent
baa2cb115f
commit
ba6b321e63
4
AUTHORS
4
AUTHORS
|
@ -1989,6 +1989,10 @@ Tadaaki Nagao <nagao [AT] iij.ad.jp> {
|
|||
Added a global version of disabled_protos
|
||||
}
|
||||
|
||||
Aaron Woo <woo [AT] itd.nrl.navy.mil> {
|
||||
Optimized Link State Routing Protocol (OLSR)
|
||||
}
|
||||
|
||||
And assorted fixes and enhancements by the people listed above and by:
|
||||
|
||||
Pavel Roskin <proski [AT] gnu.org>
|
||||
|
|
|
@ -1,7 +1,7 @@
|
|||
# Makefile.am
|
||||
# Automake file for Ethereal
|
||||
#
|
||||
# $Id: Makefile.am,v 1.690 2004/01/16 01:32:20 obiot Exp $
|
||||
# $Id: Makefile.am,v 1.691 2004/01/16 04:37:54 gerald Exp $
|
||||
#
|
||||
# Ethereal - Network traffic analyzer
|
||||
# By Gerald Combs <gerald@ethereal.com>
|
||||
|
@ -352,6 +352,7 @@ DISSECTOR_SRC = \
|
|||
packet-ntlmssp.c \
|
||||
packet-ntp.c \
|
||||
packet-null.c \
|
||||
packet-olsr.c \
|
||||
packet-osi.c \
|
||||
packet-osi-options.c \
|
||||
packet-ospf.c \
|
||||
|
|
|
@ -1,7 +1,7 @@
|
|||
## Makefile for building ethereal.exe with Microsoft C and nmake
|
||||
## Use: $(MAKE) /$(MAKEFLAGS) -f makefile.nmake
|
||||
#
|
||||
# $Id: Makefile.nmake,v 1.389 2004/01/16 01:32:20 obiot Exp $
|
||||
# $Id: Makefile.nmake,v 1.390 2004/01/16 04:37:54 gerald Exp $
|
||||
|
||||
include config.nmake
|
||||
include <win32.mak>
|
||||
|
@ -292,6 +292,7 @@ DISSECTOR_SRC = \
|
|||
packet-ntlmssp.c \
|
||||
packet-ntp.c \
|
||||
packet-null.c \
|
||||
packet-olsr.c \
|
||||
packet-osi.c \
|
||||
packet-osi-options.c \
|
||||
packet-ospf.c \
|
||||
|
|
|
@ -0,0 +1,667 @@
|
|||
/* packet-olsr.c
|
||||
* Routines for OLSR (IPv4 & IPv6 compatible) RFC parsing
|
||||
* Compatible with RFC-compliant OLSR implementations such as
|
||||
* NRLOLSRD (http://pf.itd.nrl.navy.mil/projects/olsr/).
|
||||
* Parser created by Aaron Woo <woo@itd.nrl.navy.mil> of
|
||||
* the Naval Research Laboratory
|
||||
*
|
||||
* http://www.ietf.org/rfc/rfc3626.txt
|
||||
*
|
||||
*
|
||||
* $Id: packet-olsr.c,v 1.1 2004/01/16 04:37:54 gerald Exp $
|
||||
*
|
||||
* Ethereal - Network traffic analyzer
|
||||
* By Gerald Combs <gerald@ethereal.com>
|
||||
* 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., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
||||
*/
|
||||
|
||||
#ifdef HAVE_CONFIG_H
|
||||
# include "config.h"
|
||||
#endif
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
|
||||
#ifdef HAVE_SYS_TYPES_H
|
||||
# include <sys/types.h>
|
||||
#endif
|
||||
|
||||
#ifdef HAVE_NETINET_IN_H
|
||||
# include <netinet/in.h>
|
||||
#endif
|
||||
|
||||
#include <glib.h>
|
||||
|
||||
#include <epan/packet.h>
|
||||
#include <epan/ipv6-utils.h>
|
||||
|
||||
#define UDP_PORT_OLSR 698
|
||||
#define HELLO 1
|
||||
#define TC 2
|
||||
#define MID 3
|
||||
#define HNA 4
|
||||
|
||||
/* Initialize the protocol and registered fields */
|
||||
static int proto_olsr = -1;
|
||||
static int hf_olsr_packet_len = -1;
|
||||
static int hf_olsr_packet_seq_num = -1;
|
||||
static int hf_olsr_message_type = -1;
|
||||
static int hf_olsr_vtime = -1;
|
||||
static int hf_olsr_message_size = -1;
|
||||
static int hf_olsr_ttl = -1;
|
||||
static int hf_olsr_hop_count = -1;
|
||||
static int hf_olsr_message_seq_num = -1;
|
||||
|
||||
static int hf_olsr_htime = -1;
|
||||
static int hf_olsr_willingness = -1;
|
||||
|
||||
static int hf_olsr_link_type = -1;
|
||||
static int hf_olsr_link_message_size = -1;
|
||||
static int hf_olsr_ansn = -1;
|
||||
|
||||
static int hf_olsr_origin_addr = -1;
|
||||
static int hf_olsr_neighbor_addr = -1;
|
||||
static int hf_olsr_interface_addr = -1;
|
||||
static int hf_olsr_netmask = -1;
|
||||
static int hf_olsr_network_addr = -1;
|
||||
static int hf_olsr_origin6_addr = -1;
|
||||
static int hf_olsr_neighbor6_addr = -1;
|
||||
static int hf_olsr_interface6_addr = -1;
|
||||
static int hf_olsr_netmask6 = -1;
|
||||
static int hf_olsr_network6_addr = -1;
|
||||
|
||||
/* Initialize the subtree pointers*/
|
||||
static gint ett_olsr = -1;
|
||||
|
||||
|
||||
/*------------------------- Packet Dissecting Code-------------------------*/
|
||||
static void
|
||||
dissect_olsr(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree)
|
||||
{
|
||||
proto_item *ti;
|
||||
proto_tree *olsr_tree;
|
||||
|
||||
int offset, link_message_size, message_size, message_type, packet_size, position;
|
||||
int high_bits, low_bits, vtime, htime;
|
||||
float Vtime, Htime;
|
||||
|
||||
guint16 packet_len;
|
||||
guint16 packet_seq_num;
|
||||
|
||||
guint32 origin_addr;
|
||||
guint32 neighbor_addr;
|
||||
guint32 interface_addr;
|
||||
guint32 network_addr;
|
||||
guint32 netmask;
|
||||
struct e_in6_addr origin6_addr, *origin=&origin6_addr;
|
||||
struct e_in6_addr neighbor6_addr, *neighbor=&neighbor6_addr;
|
||||
struct e_in6_addr interface6_addr, *theinterface=&interface6_addr;
|
||||
struct e_in6_addr network6_addr, *network=&network6_addr;
|
||||
struct e_in6_addr netmask6, *netmask_v6=&netmask6;
|
||||
|
||||
/*-------------Setting the Protocol and Info Columns in the Ethereal Display----------*/
|
||||
if (check_col(pinfo->cinfo, COL_PROTOCOL))
|
||||
col_set_str(pinfo->cinfo, COL_PROTOCOL, "UDP");
|
||||
if (check_col(pinfo->cinfo, COL_INFO))
|
||||
col_clear(pinfo->cinfo, COL_INFO);
|
||||
|
||||
packet_len = tvb_get_ntohs(tvb, 0);
|
||||
packet_seq_num = tvb_get_ntohs(tvb, 2);
|
||||
|
||||
if (check_col(pinfo->cinfo, COL_INFO) && (pinfo->src.type==AT_IPv4))
|
||||
col_add_fstr(pinfo->cinfo, COL_INFO, "OLSR (IPv4) Packet, Length: %u Bytes", packet_len);
|
||||
else if(check_col(pinfo->cinfo, COL_INFO) && (pinfo->src.type==AT_IPv6))
|
||||
col_add_fstr(pinfo->cinfo, COL_INFO, "OLSR (IPv6) Packet, Length: %u Bytes", packet_len);
|
||||
|
||||
/*-----------------------------------------------------Fetching Info from IPv4 Packet and Adding to Tree-------------------------------------------*/
|
||||
if (tree && (pinfo->src.type==AT_IPv4)) {
|
||||
ti = proto_tree_add_item(tree, proto_olsr, tvb, 0, -1, FALSE);
|
||||
olsr_tree = proto_item_add_subtree(ti, ett_olsr);
|
||||
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_packet_len, tvb, 0, 2, packet_len, "Packet Length: %u bytes", packet_len);
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_packet_seq_num, tvb, 2, 2, packet_seq_num, "Packet Sequence Number: %u", packet_seq_num);
|
||||
|
||||
packet_size = (packet_len - 4) / 4;
|
||||
position = 4;
|
||||
|
||||
while(packet_size>0) {
|
||||
message_type = tvb_get_guint8(tvb, position);
|
||||
switch(message_type) {
|
||||
case 1:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_type, tvb, position, 1, tvb_get_guint8(tvb, position), "Message Type: HELLO");
|
||||
break;
|
||||
case 2:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_type, tvb, position, 1, tvb_get_guint8(tvb, position), "Message Type: TC");
|
||||
break;
|
||||
case 3:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_type, tvb, position, 1, tvb_get_guint8(tvb, position), "Message Type: MID");
|
||||
break;
|
||||
case 4:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_type, tvb, position, 1, tvb_get_guint8(tvb, position), "Message Type: HNA");
|
||||
break;
|
||||
default:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_type, tvb, position, 1, tvb_get_guint8(tvb, position), "Message Type: Invalid!");
|
||||
break;
|
||||
}
|
||||
|
||||
/*-------------Dissect Validity Time-------------------------*/
|
||||
vtime = tvb_get_guint8(tvb, position+1);
|
||||
high_bits = ((vtime & 240) >> 4);
|
||||
low_bits = (vtime & 15);
|
||||
Vtime = ((1<<low_bits)/16.0)*(1+(high_bits/16.0));
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_vtime, tvb, position+1, 1, Vtime, "Validity Time: %.3f (in seconds)", Vtime);
|
||||
|
||||
/*-------------Dissect Message Size---------------------------*/
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_size, tvb, position+2, 2, tvb_get_ntohs(tvb, position+2),"Message Size: %u bytes", tvb_get_ntohs(tvb, position+2));
|
||||
|
||||
packet_size--;
|
||||
message_size = (tvb_get_ntohs(tvb, position+2) - 4) /4;
|
||||
offset = position + 4;
|
||||
position = offset;
|
||||
|
||||
/*-----------------Dissecting: Origin Addr, TTL, Hop Count, and Message Seq Number*/
|
||||
if(message_size > 0) {
|
||||
tvb_memcpy(tvb, (guint8*)&origin_addr, offset, 4);
|
||||
proto_tree_add_ipv4(olsr_tree, hf_olsr_origin_addr, tvb, offset, 4, origin_addr);
|
||||
message_size--;
|
||||
packet_size--;
|
||||
offset+=4;
|
||||
}
|
||||
if(message_size > 0) {
|
||||
proto_tree_add_item(olsr_tree, hf_olsr_ttl, tvb, offset, 1, FALSE);
|
||||
proto_tree_add_item(olsr_tree, hf_olsr_hop_count, tvb, offset+1, 1, FALSE);
|
||||
proto_tree_add_item(olsr_tree, hf_olsr_message_seq_num, tvb, offset+2, 2, FALSE);
|
||||
message_size--;
|
||||
packet_size--;
|
||||
offset+=4;
|
||||
}
|
||||
|
||||
position = offset;
|
||||
|
||||
/* --------------Dissecting TC message--------------------- */
|
||||
if(message_size>0 && message_type == TC) {
|
||||
proto_tree_add_item(olsr_tree, hf_olsr_ansn, tvb, offset, 2, FALSE);
|
||||
|
||||
offset+=4;
|
||||
message_size--;
|
||||
packet_size--;
|
||||
|
||||
while(message_size>0) {
|
||||
tvb_memcpy(tvb, (guint8*)&neighbor_addr, offset, 4);
|
||||
proto_tree_add_ipv4(olsr_tree, hf_olsr_neighbor_addr, tvb, offset, 4, neighbor_addr);
|
||||
message_size--;
|
||||
offset+=4;
|
||||
packet_size--;
|
||||
}
|
||||
position = offset;
|
||||
}
|
||||
|
||||
/* -------------Dissect HELLO message----------------------- */
|
||||
else if(message_size>0 && message_type == HELLO) {
|
||||
/*---------------------Dissect Hello Emission Invertal-------------------*/
|
||||
htime = tvb_get_guint8(tvb, offset+2);
|
||||
high_bits = ((htime & 240) >> 4);
|
||||
low_bits = (htime & 15);
|
||||
Htime = ((1<<low_bits)/16.0)*(1+(high_bits/16.0));
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_htime, tvb, offset+2, 1, Htime, "Hello Emission Interval: %.3f (in seconds)", Htime);
|
||||
|
||||
/*-------------------------Dissect Willingness---------------------------*/
|
||||
switch(tvb_get_guint8(tvb, offset+3)) {
|
||||
case 0:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: Never");
|
||||
break;
|
||||
case 1:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: Low");
|
||||
break;
|
||||
case 3:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: Default");
|
||||
break;
|
||||
case 6:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: High");
|
||||
break;
|
||||
case 7:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: Always");
|
||||
break;
|
||||
default :
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: Invalid!");
|
||||
break;
|
||||
}/* end switch Willingness */
|
||||
|
||||
offset+=4;
|
||||
message_size--;
|
||||
packet_size--;
|
||||
|
||||
while(message_size>0) {
|
||||
/*------------------------------Dissect Link Type---------------------------------- */
|
||||
switch(tvb_get_guint8(tvb, offset)) {
|
||||
case 0:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Unspecified Link");
|
||||
break;
|
||||
case 1:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Asymmetric Link");
|
||||
break;
|
||||
case 6:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Symmetric Link");
|
||||
break;
|
||||
case 3:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Lost Link");
|
||||
break;
|
||||
case 10:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: MPR Link");
|
||||
break;
|
||||
case 5:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Pending");
|
||||
break;
|
||||
default:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Invalid");
|
||||
break;
|
||||
}/* end switch Link Type */
|
||||
|
||||
/*----------------------Dissect Link Message Size--------------------------*/
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_message_size, tvb, offset+2, 2, tvb_get_ntohs(tvb, offset+2), "Link Message Size: %u bytes", tvb_get_ntohs(tvb, offset+2));
|
||||
|
||||
link_message_size = (tvb_get_ntohs(tvb, offset+2) - 4) / 4;
|
||||
offset+=4;
|
||||
message_size--;
|
||||
packet_size--;
|
||||
|
||||
/*-------------------Dissect Neighbor Addresses--------------------*/
|
||||
while(link_message_size>0) {
|
||||
tvb_memcpy(tvb, (guint8*)&neighbor_addr, offset, 4);
|
||||
proto_tree_add_ipv4(olsr_tree, hf_olsr_neighbor_addr, tvb, offset, 4, neighbor_addr);
|
||||
offset+=4;
|
||||
message_size--;
|
||||
packet_size--;
|
||||
link_message_size--;
|
||||
} /* end while */
|
||||
} /* end while */
|
||||
position = offset;
|
||||
} /* end if for Hello */
|
||||
/*---------------------------------Dissect MID Message----------------------------------*/
|
||||
else if(message_size>0 && message_type==MID) {
|
||||
while(message_size>0) {
|
||||
tvb_memcpy(tvb, (guint8*)&interface_addr, offset, 4);
|
||||
proto_tree_add_ipv4(olsr_tree, hf_olsr_interface_addr, tvb, offset, 4, interface_addr);
|
||||
message_size--;
|
||||
offset+=4;
|
||||
packet_size--;
|
||||
} /* end while for MID */
|
||||
position = offset;
|
||||
} /* end if for MID */
|
||||
/*-----------------------------Dissect HNA Message--------------------------------*/
|
||||
else if(message_size>0 && message_type==HNA) {
|
||||
while(message_size>0) {
|
||||
tvb_memcpy(tvb, (guint8*)&network_addr, offset, 4);
|
||||
proto_tree_add_ipv4(olsr_tree, hf_olsr_network_addr, tvb, offset, 4, network_addr);
|
||||
message_size--;
|
||||
packet_size--;
|
||||
offset+=4;
|
||||
tvb_memcpy(tvb, (guint8*)&netmask, offset, 4);
|
||||
proto_tree_add_ipv4(olsr_tree, hf_olsr_netmask, tvb, offset, 4, netmask);
|
||||
message_size--;
|
||||
packet_size--;
|
||||
offset+=4;
|
||||
} /* end while for HNA */
|
||||
position = offset;
|
||||
} /* end if for HNA */
|
||||
|
||||
} /* end while for message alive */
|
||||
} /* end if for IPV4 */
|
||||
|
||||
|
||||
/*-----------------------------------------------------Fetching Info from IPv6 Packet and Adding to Tree-------------------------------------------------*/
|
||||
if (tree && (pinfo->src.type==AT_IPv6)) {
|
||||
ti = proto_tree_add_item(tree, proto_olsr, tvb, 0, -1, FALSE);
|
||||
olsr_tree = proto_item_add_subtree(ti, ett_olsr);
|
||||
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_packet_len, tvb, 0, 2, packet_len, "Packet Length: %u bytes", packet_len);
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_packet_seq_num, tvb, 2, 2, packet_seq_num, "Packet Sequence Number: %u", packet_seq_num);
|
||||
|
||||
|
||||
packet_size = (packet_len - 4) / 4;
|
||||
position = 4;
|
||||
|
||||
while(packet_size>0) {
|
||||
message_type = tvb_get_guint8(tvb, position);
|
||||
switch(message_type) {
|
||||
case 1:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_type, tvb, position, 1, tvb_get_guint8(tvb, position), "Message Type: HELLO");
|
||||
break;
|
||||
case 2:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_type, tvb, position, 1, tvb_get_guint8(tvb, position), "Message Type: TC");
|
||||
break;
|
||||
case 3:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_type, tvb, position, 1, tvb_get_guint8(tvb, position), "Message Type: MID");
|
||||
break;
|
||||
case 4:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_type, tvb, position, 1, tvb_get_guint8(tvb, position), "Message Type: HNA");
|
||||
break;
|
||||
default:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_type, tvb, position, 1, tvb_get_guint8(tvb, position), "Message Type: Invalid!");
|
||||
break;
|
||||
}
|
||||
|
||||
/*-------------Dissect Validity Time-------------------------*/
|
||||
vtime = tvb_get_guint8(tvb, position+1);
|
||||
high_bits = ((vtime & 240) >> 4);
|
||||
low_bits = (vtime & 15);
|
||||
Vtime = ((1<<low_bits)/16.0)*(1.0+(high_bits/16.0));
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_vtime, tvb, position+1, 1, Vtime, "Validity Time: %.3f (in seconds)", Vtime);
|
||||
|
||||
/*--------------------Dissect Message Size-------------------------------*/
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_message_size, tvb, position+2, 2, tvb_get_ntohs(tvb, position+2),"Message Size: %u bytes", tvb_get_ntohs(tvb, position+2));
|
||||
|
||||
packet_size--;
|
||||
message_size = (tvb_get_ntohs(tvb, position+2) - 4) /4;
|
||||
|
||||
offset = position + 4;
|
||||
position = offset;
|
||||
|
||||
/*-----------------Dissecting: Origin Addr, TTL, Hop Count, and Message Seq Number */
|
||||
if(message_size > 0) {
|
||||
tvb_memcpy(tvb, (guint8*)&origin6_addr, offset, 16);
|
||||
proto_tree_add_ipv6(olsr_tree, hf_olsr_origin6_addr, tvb, offset, 16, (guint8*)origin);
|
||||
offset+=16;
|
||||
message_size-=4;
|
||||
packet_size-=4;
|
||||
}
|
||||
if(message_size > 0) {
|
||||
proto_tree_add_item(olsr_tree, hf_olsr_ttl, tvb, offset, 1, FALSE);
|
||||
proto_tree_add_item(olsr_tree, hf_olsr_hop_count, tvb, offset+1, 1, FALSE);
|
||||
proto_tree_add_item(olsr_tree, hf_olsr_message_seq_num, tvb, offset+2, 2, FALSE);
|
||||
message_size--;
|
||||
packet_size--;
|
||||
offset+=4;
|
||||
}
|
||||
|
||||
position = offset;
|
||||
|
||||
/* --------------Dissecting TC message--------------------- */
|
||||
if(message_size>0 && message_type == TC) {
|
||||
proto_tree_add_item(olsr_tree, hf_olsr_ansn, tvb, offset, 2, FALSE);
|
||||
|
||||
offset+=4;
|
||||
message_size--;
|
||||
packet_size--;
|
||||
|
||||
while(message_size>0) {
|
||||
tvb_memcpy(tvb, (guint8*)&neighbor6_addr, offset, 16);
|
||||
proto_tree_add_ipv6(olsr_tree, hf_olsr_neighbor6_addr, tvb, offset, 16, (guint8*)neighbor);
|
||||
message_size-=4;
|
||||
offset+=16;
|
||||
packet_size-=4;
|
||||
}
|
||||
position = offset;
|
||||
}
|
||||
|
||||
/* -------------Dissect HELLO message----------------------- */
|
||||
else if(message_size>0 && message_type == HELLO) {
|
||||
/*---------------------Dissect Hellow Emission Invertal-------------------*/
|
||||
htime = tvb_get_guint8(tvb, offset+2);
|
||||
high_bits = ((htime & 240) >> 4);
|
||||
low_bits = (htime & 15);
|
||||
Htime = ((1<<low_bits)/16.0)*(1.0+(high_bits/16.0));
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_htime, tvb, offset+2, 1, Htime, "Hello Emission Interval: %.3f (in seconds)", Htime);
|
||||
|
||||
/*---------------------Dissect Willingness----------------------------------*/
|
||||
switch(tvb_get_guint8(tvb, offset+3)) {
|
||||
case 0:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: Never");
|
||||
break;
|
||||
case 1:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: Low");
|
||||
break;
|
||||
case 3:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: Default");
|
||||
break;
|
||||
case 6:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: High");
|
||||
break;
|
||||
case 7:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: Always");
|
||||
break;
|
||||
default :
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_willingness, tvb, offset+3, 1, tvb_get_guint8(tvb, offset+2), "Willingness: Invalid!");
|
||||
break;
|
||||
} /* end switch for willingness */
|
||||
|
||||
offset+=4;
|
||||
message_size--;
|
||||
packet_size--;
|
||||
|
||||
while(message_size>0) {
|
||||
/*----------------------Dissect Link Type------------------------------------*/
|
||||
switch(tvb_get_guint8(tvb, offset)) {
|
||||
case 0:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Unspecified Link");
|
||||
break;
|
||||
case 1:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Asymmetric Link");
|
||||
break;
|
||||
case 6:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Symmetric Link");
|
||||
break;
|
||||
case 3:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Lost Link");
|
||||
break;
|
||||
case 10:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: MPR Link");
|
||||
break;
|
||||
case 5:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Pending");
|
||||
break;
|
||||
default:
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_type, tvb, offset, 1, tvb_get_guint8(tvb, offset), "Link Type: Invalid");
|
||||
break;
|
||||
} /* end switch Link Type */
|
||||
|
||||
/*-------------------------Dissect Link Message Size-----------------------------*/
|
||||
proto_tree_add_uint_format(olsr_tree, hf_olsr_link_message_size, tvb, offset+2, 2, tvb_get_ntohs(tvb, offset+2), "Link Message Size: %u bytes", tvb_get_ntohs(tvb, offset+2));
|
||||
|
||||
link_message_size = (tvb_get_ntohs(tvb, offset+2) - 4) / 4;
|
||||
offset+=4;
|
||||
message_size--;
|
||||
packet_size--;
|
||||
|
||||
/*--------------------------Dissect Neighbor Addresses---------------------------*/
|
||||
while(link_message_size>0) {
|
||||
tvb_memcpy(tvb, (guint8*)&neighbor6_addr, offset, 16);
|
||||
proto_tree_add_ipv6(olsr_tree, hf_olsr_neighbor6_addr, tvb, offset, 16, (guint8*)neighbor);
|
||||
offset+=16;
|
||||
message_size-=4;
|
||||
packet_size-=4;
|
||||
link_message_size-=4;
|
||||
} /* end while */
|
||||
} /* end while */
|
||||
position = offset;
|
||||
} /* end if for Hello */
|
||||
/*---------------------------------Dissect MID Message----------------------------------*/
|
||||
else if(message_size>0 && message_type==MID) {
|
||||
while(message_size>0) {
|
||||
tvb_memcpy(tvb, (guint8*)&interface6_addr, offset, 16);
|
||||
proto_tree_add_ipv6(olsr_tree, hf_olsr_interface6_addr, tvb, offset, 16, (guint8*)theinterface);
|
||||
message_size-=4;
|
||||
offset+=16;
|
||||
packet_size-=4;
|
||||
} /* end while for MID */
|
||||
position = offset;
|
||||
} /* end if for MID */
|
||||
/*-----------------------------Dissect HNA Message--------------------------------*/
|
||||
else if(message_size>0 && message_type==HNA) {
|
||||
while(message_size>0) {
|
||||
tvb_memcpy(tvb, (guint8*)&network6_addr, offset, 16);
|
||||
proto_tree_add_ipv6(olsr_tree, hf_olsr_network6_addr, tvb, offset, 16, (guint8*)network);
|
||||
offset+=16;
|
||||
message_size-=4;
|
||||
packet_size-=4;
|
||||
tvb_memcpy(tvb, (guint8*)&netmask6, offset, 16);
|
||||
proto_tree_add_ipv6(olsr_tree, hf_olsr_netmask6, tvb, offset, 16, (guint8*)netmask_v6);
|
||||
message_size-=4;
|
||||
packet_size-=4;
|
||||
offset+=16;
|
||||
} /* end while for HNA */
|
||||
position = offset;
|
||||
} /* end if for HNA */
|
||||
} /* end while for message alive */
|
||||
} /* end if for IPV6 */
|
||||
} /* end Dissecting */
|
||||
|
||||
/*-----------Register the Dissector for OLSR--------------*/
|
||||
void
|
||||
proto_register_olsr(void)
|
||||
{
|
||||
static hf_register_info hf[] = {
|
||||
{ &hf_olsr_packet_len,
|
||||
{ "Packet Length", "olsr.packet_len",
|
||||
FT_UINT16, BASE_DEC, NULL, 0,
|
||||
"Packet Length in Bytes", HFILL }},
|
||||
|
||||
{ &hf_olsr_packet_seq_num,
|
||||
{ "Packet Sequence Number", "olsr.packet_seq_num",
|
||||
FT_UINT16, BASE_DEC, NULL, 0,
|
||||
"Packet Sequence Number", HFILL }},
|
||||
|
||||
{ &hf_olsr_message_type,
|
||||
{ "Message Type", "olsr.message_type",
|
||||
FT_UINT8, BASE_DEC, NULL, 0,
|
||||
"Message Type", HFILL }},
|
||||
|
||||
{ &hf_olsr_message_size,
|
||||
{ "Message", "olsr.message_size",
|
||||
FT_UINT16, BASE_DEC, NULL, 0,
|
||||
"Message Size in Bytes", HFILL }},
|
||||
|
||||
{ &hf_olsr_message_seq_num,
|
||||
{ "Message Sequence Number", "olsr.message_seq_num",
|
||||
FT_UINT16, BASE_DEC, NULL, 0,
|
||||
"Message Sequence Number", HFILL }},
|
||||
|
||||
{ &hf_olsr_vtime,
|
||||
{ "Validity Time", "olsr.vtime",
|
||||
FT_UINT8, BASE_DEC, NULL, 0,
|
||||
"Validity Time", HFILL }},
|
||||
|
||||
{ &hf_olsr_ansn,
|
||||
{ "Advertised Neighbor Sequence Number (ANSN)", "olsr.ansn",
|
||||
FT_UINT16, BASE_DEC, NULL, 0,
|
||||
"Advertised Neighbor Sequence Number (ANSN)", HFILL }},
|
||||
|
||||
{ &hf_olsr_htime,
|
||||
{ "Hello emission interval", "olsr.htime",
|
||||
FT_UINT8, BASE_DEC, NULL, 0,
|
||||
"Hello emission interval", HFILL }},
|
||||
|
||||
{ &hf_olsr_willingness,
|
||||
{ "Willingness to Carry and Forward", "olsr.willingness",
|
||||
FT_UINT8, BASE_DEC, NULL, 0,
|
||||
"Willingness to Carry and Forward", HFILL }},
|
||||
|
||||
{ &hf_olsr_ttl,
|
||||
{ "Time to Live", "olsr.ttl",
|
||||
FT_UINT8, BASE_DEC, NULL, 0,
|
||||
"Time to Live", HFILL }},
|
||||
|
||||
{ &hf_olsr_link_type,
|
||||
{ "Link Type", "olsr.link_type",
|
||||
FT_UINT8, BASE_DEC, NULL, 0,
|
||||
"Link Type", HFILL }},
|
||||
|
||||
{ &hf_olsr_link_message_size,
|
||||
{ "Link Message Size", "olsr.link_message_size",
|
||||
FT_UINT16, BASE_DEC, NULL, 0,
|
||||
"Link Message Size", HFILL }},
|
||||
|
||||
{ &hf_olsr_hop_count,
|
||||
{ "Hop Count", "olsr.hop_count",
|
||||
FT_UINT8, BASE_DEC, NULL, 0,
|
||||
"Hop Count", HFILL }},
|
||||
|
||||
{ &hf_olsr_origin_addr,
|
||||
{ "Originator Address", "olsr.origin_addr",
|
||||
FT_IPv4, BASE_NONE, NULL, 0,
|
||||
"Originator Address", HFILL }},
|
||||
|
||||
{ &hf_olsr_neighbor_addr,
|
||||
{ "Neighbor Address", "olsr.neighbor_addr",
|
||||
FT_IPv4, BASE_NONE, NULL, 0,
|
||||
"Neighbor Address", HFILL }},
|
||||
|
||||
|
||||
{ &hf_olsr_network_addr,
|
||||
{ "Network Address", "olsr.network_addr",
|
||||
FT_IPv4, BASE_NONE, NULL, 0,
|
||||
"Network Address", HFILL }},
|
||||
|
||||
{ &hf_olsr_interface_addr,
|
||||
{ "Interface Address", "olsr.interface_addr",
|
||||
FT_IPv4, BASE_NONE, NULL, 0,
|
||||
"Interface Address", HFILL }},
|
||||
|
||||
{ &hf_olsr_netmask,
|
||||
{ "Netmask", "olsr.netmask",
|
||||
FT_IPv4, BASE_NONE, NULL, 0,
|
||||
"Netmask", HFILL }},
|
||||
|
||||
{ &hf_olsr_origin6_addr,
|
||||
{ "Originator Address", "olsr.origin6_addr",
|
||||
FT_IPv6, BASE_NONE, NULL, 0,
|
||||
"Originator Address", HFILL }},
|
||||
|
||||
{ &hf_olsr_neighbor6_addr,
|
||||
{ "Neighbor Address", "olsr.neighbor6_addr",
|
||||
FT_IPv6, BASE_NONE, NULL, 0,
|
||||
"Neighbor Address", HFILL }},
|
||||
|
||||
{ &hf_olsr_network6_addr,
|
||||
{ "Network Address", "olsr.network6_addr",
|
||||
FT_IPv6, BASE_NONE, NULL, 0,
|
||||
"Network Address", HFILL }},
|
||||
|
||||
{ &hf_olsr_interface6_addr,
|
||||
{ "Interface Address", "olsr.interface6_addr",
|
||||
FT_IPv6, BASE_NONE, NULL, 0,
|
||||
"Interface Address", HFILL }},
|
||||
|
||||
{ &hf_olsr_netmask6,
|
||||
{ "Netmask", "olsr.netmask6",
|
||||
FT_IPv6, BASE_NONE, NULL, 0,
|
||||
"Netmask", HFILL }},
|
||||
};
|
||||
|
||||
|
||||
static gint *ett[] = {
|
||||
&ett_olsr,
|
||||
};
|
||||
|
||||
|
||||
proto_olsr = proto_register_protocol("Optimized Link State Routing Protocol",
|
||||
"OLSR", "olsr");
|
||||
|
||||
proto_register_field_array(proto_olsr, hf, array_length(hf));
|
||||
proto_register_subtree_array(ett, array_length(ett));
|
||||
}
|
||||
|
||||
void
|
||||
proto_reg_handoff_olsr(void)
|
||||
{
|
||||
dissector_handle_t olsr_handle;
|
||||
|
||||
olsr_handle = create_dissector_handle(dissect_olsr, proto_olsr);
|
||||
dissector_add("udp.port", UDP_PORT_OLSR, olsr_handle);
|
||||
}
|
||||
|
Loading…
Reference in New Issue