trema 0.1.3

data/src/lib/packet_info.h

@@ -0,0 +1,209 @@
+/*
+ * Functions for accessing commonly-used header fields values.
+ *
+ * Author: Kazuya Suzuki
+ *
+ * Copyright (C) 2008-2012 NEC Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License, version 2, as
+ * published by the Free Software Foundation.
+ *
+ * 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.
+ */
+
+
+#ifndef PACKET_INFO_H
+#define PACKET_INFO_H
+
+
+#include "arp.h"
+#include "checks.h"
+#include "bool.h"
+#include "ether.h"
+#include "icmp.h"
+#include "igmp.h"
+#include "ipv4.h"
+#include "tcp.h"
+#include "udp.h"
+#include "etherip.h"
+
+
+enum {
+  ETH_DIX = 0x00000001,
+  ETH_8023_RAW = 0x00000002,
+  ETH_8023_LLC = 0x00000004,
+  ETH_8023_SNAP = 0x00000008,
+  ETH_8021Q = 0x00000010,
+  NW_IPV4 = 0x00000100,
+  NW_ICMPV4 = 0x00000200,
+  NW_IPV6 = 0x00000400,
+  NW_ICMPV6 = 0x00000800,
+  NW_ARP = 0x00001000,
+  NW_IGMP = 0x00002000,
+  NW_LLDP = 0x00004000,
+  TP_TCP = 0x00010000,
+  TP_UDP = 0x00020000,
+  TP_ETHERIP = 0x00040000,
+
+  ETH_VTAG_DIX = ETH_8021Q | ETH_DIX,
+  ETH_VTAG_RAW = ETH_8021Q | ETH_8023_RAW,
+  ETH_VTAG_LLC = ETH_8021Q | ETH_8023_LLC,
+  ETH_VTAG_SNAP = ETH_8021Q | ETH_8023_SNAP,
+  ETH_ARP = ETH_DIX | NW_ARP,
+  ETH_LLDP = ETH_DIX | NW_LLDP,
+  ETH_IPV4 = ETH_DIX | NW_IPV4,
+  ETH_IPV4_ICMPV4 = ETH_IPV4 | NW_ICMPV4,
+  ETH_IPV4_IGMP = ETH_IPV4 | NW_IGMP,
+  ETH_IPV4_TCP = ETH_IPV4 | TP_TCP,
+  ETH_IPV4_UDP = ETH_IPV4 | TP_UDP,
+  ETH_IPV4_ETHERIP = ETH_IPV4 | TP_ETHERIP,
+  ETH_VTAG_ARP = ETH_VTAG_DIX | NW_ARP,
+  ETH_VTAG_IPV4 = ETH_VTAG_DIX | NW_IPV4,
+  ETH_VTAG_IPV4_ICMPV4 = ETH_VTAG_IPV4 | NW_ICMPV4,
+  ETH_VTAG_IPV4_TCP = ETH_VTAG_IPV4 | TP_TCP,
+  ETH_VTAG_IPV4_UDP = ETH_VTAG_IPV4 | TP_UDP,
+  ETH_SNAP_ARP = ETH_8023_SNAP | NW_ARP,
+  ETH_SNAP_IPV4 = ETH_8023_SNAP | NW_IPV4,
+  ETH_SNAP_IPV4_ICMPV4 = ETH_SNAP_IPV4 | NW_ICMPV4,
+  ETH_SNAP_IPV4_TCP = ETH_SNAP_IPV4 | TP_TCP,
+  ETH_SNAP_IPV4_UDP = ETH_SNAP_IPV4 | TP_UDP,
+  ETH_VTAG_SNAP_ARP = ETH_VTAG_SNAP | NW_ARP,
+  ETH_VTAG_SNAP_IPV4 = ETH_VTAG_SNAP | NW_IPV4,
+  ETH_VTAG_SNAP_IPV4_ICMPV4 = ETH_VTAG_SNAP_IPV4 | NW_ICMPV4,
+  ETH_VTAG_SNAP_IPV4_TCP = ETH_VTAG_SNAP_IPV4 | TP_TCP,
+  ETH_VTAG_SNAP_IPV4_UDP = ETH_VTAG_SNAP_IPV4 | TP_UDP,
+};
+
+
+enum {
+  SNAP_LLC_LENGTH = 3,
+  SNAP_OUI_LENGTH = 3,
+};
+
+
+typedef struct {
+  uint32_t format;
+  
+  uint8_t eth_macda[ ETH_ADDRLEN ];
+  uint8_t eth_macsa[ ETH_ADDRLEN ];
+  uint16_t eth_type;
+
+  uint16_t vlan_tci;
+  uint16_t vlan_tpid;
+  uint8_t vlan_prio;
+  uint8_t vlan_cfi;
+  uint16_t vlan_vid;
+
+  uint8_t snap_llc[ SNAP_LLC_LENGTH ];
+  uint8_t snap_oui[ SNAP_OUI_LENGTH ];
+  uint16_t snap_type;
+
+  uint16_t arp_ar_hrd;
+  uint16_t arp_ar_pro;
+  uint8_t arp_ar_hln;
+  uint8_t arp_ar_pln;
+  uint16_t arp_ar_op;
+  uint8_t arp_sha[ ETH_ADDRLEN ];
+  uint32_t arp_spa;
+  uint8_t arp_tha[ ETH_ADDRLEN ];
+  uint32_t arp_tpa;
+
+  uint8_t ipv4_version;
+  uint8_t ipv4_ihl;
+  uint8_t ipv4_tos;
+  uint16_t ipv4_tot_len;
+  uint16_t ipv4_id;
+  uint16_t ipv4_frag_off;
+  uint8_t ipv4_ttl;
+  uint8_t ipv4_protocol;
+  uint16_t ipv4_checksum;
+  uint32_t ipv4_saddr;
+  uint32_t ipv4_daddr;
+
+  uint8_t icmpv4_type;
+  uint8_t icmpv4_code;
+  uint16_t icmpv4_checksum;
+  uint16_t icmpv4_id;
+  uint16_t icmpv4_seq;
+  uint32_t icmpv4_gateway;
+
+  uint8_t igmp_type;
+  uint8_t igmp_code;
+  uint16_t igmp_cksum;
+  uint32_t igmp_group;
+
+  uint16_t tcp_src_port;
+  uint16_t tcp_dst_port;
+  uint32_t tcp_seq_no;
+  uint32_t tcp_ack_no;
+  uint8_t tcp_offset;
+  uint8_t tcp_flags;
+  uint16_t tcp_window;
+  uint16_t tcp_checksum;
+  uint16_t tcp_urgent;
+
+  uint16_t udp_src_port;
+  uint16_t udp_dst_port;
+  uint16_t udp_len;
+  uint16_t udp_checksum;
+
+  uint16_t etherip_version;
+  uint16_t etherip_offset;
+
+  void *l2_header;
+  void *l2_payload;
+  size_t l2_payload_length;
+  void *l3_header;
+  void *l3_payload;
+  size_t l3_payload_length;
+  void *l4_header;
+  void *l4_payload;
+  size_t l4_payload_length;
+} packet_info;
+
+
+bool parse_packet( buffer *buf );
+
+void calloc_packet_info( buffer *frame );
+void free_packet_info( buffer *frame );
+packet_info get_packet_info( const buffer *frame );
+
+bool packet_type_eth_dix( const buffer *frame );
+bool packet_type_eth_vtag( const buffer *frame );
+bool packet_type_eth_raw( const buffer *frame );
+bool packet_type_eth_llc( const buffer *frame );
+bool packet_type_eth_snap( const buffer *frame );
+bool packet_type_ether( const buffer *frame );
+bool packet_type_arp( const buffer *frame );
+bool packet_type_ipv4( const buffer *frame );
+bool packet_type_lldp( const buffer *frame );
+bool packet_type_icmpv4( const buffer *frame );
+bool packet_type_igmp( const buffer *frame );
+bool packet_type_ipv4_tcp( const buffer *frame );
+bool packet_type_ipv4_udp( const buffer *frame );
+bool packet_type_ipv4_etherip( const buffer *frame );
+
+bool packet_type_igmp_membership_query( const buffer *frame );
+bool packet_type_igmp_v1_membership_report( const buffer *frame );
+bool packet_type_igmp_v2_membership_report( const buffer *frame );
+bool packet_type_igmp_v2_leave_group( const buffer *frame );
+bool packet_type_igmp_v3_membership_report( const buffer *frame );
+
+
+#endif // PACKET_INFO_H
+
+
+/*
+ * Local variables:
+ * c-basic-offset: 2
+ * indent-tabs-mode: nil
+ * End:
+ */

data/src/lib/packet_parser.c

@@ -0,0 +1,502 @@
+/*
+ * Author: Kazuya Suzuki
+ *
+ * Copyright (C) 2008-2012 NEC Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License, version 2, as
+ * published by the Free Software Foundation.
+ *
+ * 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 <assert.h>
+#include <stdint.h>
+#include <net/ethernet.h>
+#include <netinet/ip.h>
+#include "packet_info.h"
+#include "log.h"
+#include "wrapper.h"
+
+
+#define REMAINED_BUFFER_LENGTH( buf, ptr )  \
+  ( buf->length - ( size_t ) ( ( char * ) ptr - ( char * ) buf->data ) )
+
+
+static void
+parse_ether( buffer *buf ) {
+  assert( buf != NULL );
+
+  packet_info *packet_info = buf->user_data;
+  void *ptr = packet_info->l2_header;
+  assert( ptr != NULL );
+
+  // Check the length of remained buffer
+  size_t length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( length < sizeof( ether_header_t ) ) {
+    return;
+  }
+
+  // Ethernet header
+  ether_header_t *ether_header = ptr;
+  memcpy( packet_info->eth_macsa, ether_header->macsa, ETH_ADDRLEN );
+  memcpy( packet_info->eth_macda, ether_header->macda, ETH_ADDRLEN );
+  packet_info->eth_type = ntohs( ether_header->type );
+
+  ptr = ( void * ) ( ether_header + 1 );
+
+  // vlan tag
+  if ( packet_info->eth_type == ETH_ETHTYPE_TPID ) {
+    // Check the length of remained buffer
+    length = REMAINED_BUFFER_LENGTH( buf, ptr );
+    if ( length < sizeof( vlantag_header_t ) ) {
+      return;
+    }
+    vlantag_header_t *vlantag_header = ptr;
+
+    packet_info->vlan_tci = ntohs( vlantag_header->tci );
+    packet_info->vlan_tpid = packet_info->eth_type;
+    packet_info->vlan_prio =TCI_GET_PRIO( packet_info->vlan_tci );
+    packet_info->vlan_cfi = TCI_GET_CFI( packet_info->vlan_tci );
+    packet_info->vlan_vid = TCI_GET_VID( packet_info->vlan_tci );
+
+    // Rewrite eth_type
+    packet_info->eth_type = ntohs( vlantag_header->type );
+
+    packet_info->format |= ETH_8021Q;
+
+    ptr = ( void * ) ( vlantag_header + 1 );
+  }
+
+  // Skip nested vlan headers.
+  while (  packet_info->eth_type == ETH_ETHTYPE_TPID ) {
+    // Check the length of remained buffer
+    length = REMAINED_BUFFER_LENGTH( buf, ptr );
+    if ( length < sizeof( vlantag_header_t ) ) {
+      return;
+    }
+    vlantag_header_t *vlantag_header = ptr;
+
+    // Rewrite eth_type
+    packet_info->eth_type = ntohs( vlantag_header->type );
+    ptr = ( void * ) ( vlantag_header + 1 );
+  }
+
+  // snap header.
+  if ( packet_info->eth_type <= ETH_MTU ) {
+    // Check the length of remained buffer
+    length = REMAINED_BUFFER_LENGTH( buf, ptr );
+    if ( length < sizeof( snap_header_t ) ) {
+      return;
+    }
+    snap_header_t *snap_header = ptr;
+
+    memcpy( packet_info->snap_llc, snap_header->llc, SNAP_LLC_LENGTH );
+    memcpy( packet_info->snap_oui, snap_header->oui, SNAP_OUI_LENGTH );
+    packet_info->snap_type = ntohs( snap_header->type );
+
+    packet_info->format |= ETH_8023_SNAP;
+
+    ptr = ( void * ) ( snap_header + 1 );
+  }
+  else {
+    packet_info->format |= ETH_DIX;
+  }
+
+  size_t payload_length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( payload_length > 0 ) {
+    packet_info->l2_payload = ptr;
+    packet_info->l2_payload_length = payload_length;
+  }
+
+  return;
+}
+
+
+static void
+parse_arp( buffer *buf ) {
+  assert( buf != NULL );
+
+  packet_info *packet_info = buf->user_data;
+  void *ptr = packet_info->l3_header;
+  assert( ptr != NULL );
+
+  // Check the length of remained buffer
+  size_t length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( length < sizeof( arp_header_t ) ) {
+    return;
+  }
+
+  // Ethernet header
+  arp_header_t *arp_header = ptr;
+  packet_info->arp_ar_hrd = ntohs( arp_header->ar_hrd );
+  packet_info->arp_ar_pro = ntohs( arp_header->ar_pro );
+  packet_info->arp_ar_hln = arp_header->ar_hln;
+  packet_info->arp_ar_pln = arp_header->ar_pln;
+  packet_info->arp_ar_op = ntohs( arp_header->ar_op );
+  memcpy( packet_info->arp_sha, arp_header->sha, ETH_ADDRLEN );
+  packet_info->arp_spa = ntohl( arp_header->sip );
+  memcpy( packet_info->arp_tha, arp_header->tha, ETH_ADDRLEN );
+  packet_info->arp_tpa = ntohl( arp_header->tip );
+
+  packet_info->format |= NW_ARP;
+
+  return;
+};
+
+
+static void
+parse_ipv4( buffer *buf ) {
+  assert( buf != NULL );
+
+  packet_info *packet_info = buf->user_data;
+  void *ptr = packet_info->l3_header;
+  assert( ptr != NULL );
+
+  // Check the length of remained buffer for an ipv4 header without options.
+  size_t length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( length < sizeof( ipv4_header_t ) ) {
+    return;
+  }
+
+  // Check the length of remained buffer for an ipv4 header with options.
+  ipv4_header_t *ipv4_header = ptr;
+  if ( ipv4_header->ihl < 5 ) {
+    return;
+  }
+  if ( length < ( size_t ) ipv4_header->ihl * 4 ) {
+    return;
+  }
+
+  // Parses IPv4 header
+  packet_info->ipv4_version = ipv4_header->version;
+  packet_info->ipv4_ihl = ipv4_header->ihl;
+  packet_info->ipv4_tos = ipv4_header->tos;
+  packet_info->ipv4_tot_len = ntohs( ipv4_header->tot_len );
+  packet_info->ipv4_id = ntohs( ipv4_header->id );
+  packet_info->ipv4_frag_off = ntohs( ipv4_header->frag_off );
+  packet_info->ipv4_ttl = ipv4_header->ttl;
+  packet_info->ipv4_protocol = ipv4_header->protocol;
+  packet_info->ipv4_checksum = ntohs( ipv4_header->check );
+  packet_info->ipv4_saddr = ntohl( ipv4_header->saddr );
+  packet_info->ipv4_daddr = ntohl( ipv4_header->daddr );
+
+  ptr = ( char * ) ipv4_header + packet_info->ipv4_ihl * 4;
+  size_t payload_length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( payload_length > 0 ) {
+    packet_info->l3_payload = ptr;
+    packet_info->l3_payload_length = payload_length;
+  }
+
+  packet_info->format |= NW_IPV4;
+
+  return;
+}
+
+
+static void
+parse_lldp( buffer *buf ) {
+  assert( buf != NULL );
+
+  packet_info *packet_info = buf->user_data;
+  void *ptr = packet_info->l3_header;
+  assert( ptr != NULL );
+
+  size_t payload_length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( payload_length > 0 ) {
+    packet_info->l3_payload = ptr;
+    packet_info->l3_payload_length = payload_length;
+  }
+
+  packet_info->format |= NW_LLDP;
+
+  return;
+}
+
+
+static void
+parse_icmp( buffer *buf ) {
+  assert( buf != NULL );
+
+  packet_info *packet_info = buf->user_data;
+  void *ptr = packet_info->l4_header;
+  assert( ptr != NULL );
+
+  // Check the length of remained buffer
+  size_t length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( length < sizeof( icmp_header_t ) ) {
+    return;
+  }
+
+  // ICMPV4 header
+  icmp_header_t *icmp_header = ptr;
+  packet_info->icmpv4_type = icmp_header->type;
+  packet_info->icmpv4_code = icmp_header->code;
+  packet_info->icmpv4_checksum = ntohs( icmp_header->csum );
+
+  switch ( packet_info->icmpv4_type ) {
+  case ICMP_TYPE_ECHOREP:
+  case ICMP_TYPE_ECHOREQ:
+    packet_info->icmpv4_id = ntohs( icmp_header->icmp_data.echo.ident );
+    packet_info->icmpv4_seq = ntohs( icmp_header->icmp_data.echo.seq );
+    break;
+
+  case ICMP_TYPE_REDIRECT:
+    packet_info->icmpv4_gateway = ntohl( icmp_header->icmp_data.gateway );
+    break;
+
+  default:
+    break;
+  }
+
+  ptr = ( void * ) ( icmp_header + 1 );
+  size_t payload_length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( payload_length > 0 ) {
+    packet_info->l4_payload = ptr;
+    packet_info->l4_payload_length = payload_length;
+  }
+
+  packet_info->format |= NW_ICMPV4;
+
+  return;
+};
+
+
+static void
+parse_udp( buffer *buf ) {
+  assert( buf != NULL );
+
+  packet_info *packet_info = buf->user_data;
+  void *ptr = packet_info->l4_header;
+  assert( ptr != NULL );
+
+  // Check the length of remained buffer
+  size_t length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( length < sizeof( udp_header_t ) ) {
+    return;
+  }
+
+  // UDP header
+  udp_header_t *udp_header = ptr;
+  packet_info->udp_src_port = ntohs( udp_header->src_port );
+  packet_info->udp_dst_port = ntohs( udp_header->dst_port );
+  packet_info->udp_len = ntohs( udp_header->len );
+  packet_info->udp_checksum = ntohs( udp_header->csum );
+
+  ptr = ( void * ) ( udp_header + 1 );
+  size_t payload_length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( payload_length > 0 ) {
+    packet_info->l4_payload = ptr;
+    packet_info->l4_payload_length = payload_length;
+  }
+
+  packet_info->format |= TP_UDP;
+
+  return;
+};
+
+
+static void
+parse_tcp( buffer *buf ) {
+  assert( buf != NULL );
+
+  packet_info *packet_info = buf->user_data;
+  void *ptr = packet_info->l4_header;
+  assert( ptr != NULL );
+
+  // Check the length of remained buffer for the tcp header without options
+  size_t length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( length < sizeof( tcp_header_t ) ) {
+    return;
+  }
+
+  // Check the length of remained buffer for the tcp header with options
+  tcp_header_t *tcp_header = ptr;
+  if ( tcp_header->offset < 5 ) {
+    return;
+  }
+  if ( length < ( size_t ) tcp_header->offset * 4 ) {
+    return;
+  }
+
+  // TCP header
+  packet_info->tcp_src_port = ntohs( tcp_header->src_port );
+  packet_info->tcp_dst_port = ntohs( tcp_header->dst_port );
+  packet_info->tcp_seq_no = ntohl( tcp_header->seq_no );
+  packet_info->tcp_ack_no = ntohl( tcp_header->ack_no );
+  packet_info->tcp_offset = tcp_header->offset;
+  packet_info->tcp_flags = tcp_header->flags;
+  packet_info->tcp_window = ntohs( tcp_header->window );
+  packet_info->tcp_checksum = ntohs( tcp_header->csum );
+  packet_info->tcp_urgent = ntohs( tcp_header->urgent );
+
+  ptr = ( char * ) tcp_header + packet_info->tcp_offset * 4;
+  size_t payload_length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( payload_length > 0 ) {
+    packet_info->l4_payload = ptr;
+    packet_info->l4_payload_length = payload_length;
+  }
+
+  packet_info->format |= TP_TCP;
+
+  return;
+};
+
+
+
+static void
+parse_igmp( buffer *buf ) {
+  assert( buf != NULL );
+
+  packet_info *packet_info = buf->user_data;
+  void *ptr = packet_info->l4_header;
+  assert( ptr != NULL );
+
+  // Check the length of remained buffer
+  size_t length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( length < sizeof( igmp_header_t ) ) {
+    return;
+  }
+
+  igmp_header_t *igmp = ptr;
+  packet_info->igmp_type = igmp->type;
+  packet_info->igmp_code = igmp->code;
+  packet_info->igmp_cksum = ntohs( igmp->csum );
+  packet_info->igmp_group = ntohl( igmp->group );
+
+  packet_info->format |= NW_IGMP;
+
+  return;
+}
+
+
+static void
+parse_etherip( buffer *buf ) {
+  assert( buf != NULL );
+
+  packet_info *packet_info = buf->user_data;
+  void *ptr = packet_info->l4_header;
+  assert( ptr != NULL );
+
+  // Check the length of remained buffer
+  size_t length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( length < sizeof( etherip_header ) ) {
+    return;
+  }
+
+  // Ether header
+  etherip_header *etherip_header = ptr;
+  packet_info->etherip_version = ntohs( etherip_header->version );
+  packet_info->etherip_offset = 0;
+
+  ptr = ( void * ) ( etherip_header + 1 );
+  size_t payload_length = REMAINED_BUFFER_LENGTH( buf, ptr );
+  if ( payload_length > 0 ) {
+    packet_info->l4_payload = ptr;
+    packet_info->l4_payload_length = payload_length;
+    packet_info->etherip_offset = ( uint16_t ) ( ( char * ) ptr - ( char *) buf->data );
+  }
+
+  packet_info->format |= TP_ETHERIP;
+
+  return;
+}
+
+
+bool
+parse_packet( buffer *buf ) {
+  assert( buf != NULL );
+  assert( buf->data != NULL );
+
+  calloc_packet_info( buf );
+  if ( buf->user_data == NULL ) {
+    error( "Can't alloc memory for packet_info." );
+    return false;
+  }
+
+  // Parse the L2 header.
+  packet_info *packet_info = buf->user_data;
+  packet_info->l2_header = buf->data;
+  parse_ether( buf );
+
+  // Parse the L3 header.
+  switch ( packet_info->eth_type ) {
+  case ETH_ETHTYPE_ARP:
+    packet_info->l3_header = packet_info->l2_payload;
+    parse_arp( buf );
+    break;
+
+  case ETH_ETHTYPE_IPV4:
+    packet_info->l3_header = packet_info->l2_payload;
+    parse_ipv4( buf );
+    break;
+
+  case ETH_ETHTYPE_LLDP:
+    packet_info->l3_header = packet_info->l2_payload;
+    parse_lldp( buf );
+    break;
+
+  default:
+    // Unknown L3 type
+    return true;
+  }
+
+  if ( !( packet_info->format & NW_IPV4 ) ) {
+    return true;
+  }
+  else if ( ( packet_info->ipv4_frag_off & IP_OFFMASK ) != 0 ) {
+    // The ipv4 packet is fragmented.
+    return true;
+  }
+
+  // Parse the L4 header.
+  switch ( packet_info->ipv4_protocol ) {
+  case IPPROTO_ICMP:
+    packet_info->l4_header = packet_info->l3_payload;
+    parse_icmp( buf );
+    break;
+
+  case IPPROTO_TCP:
+    packet_info->l4_header = packet_info->l3_payload;
+    parse_tcp( buf );
+    break;
+
+  case IPPROTO_UDP:
+    packet_info->l4_header = packet_info->l3_payload;
+    parse_udp( buf );
+    break;
+
+  case IPPROTO_IGMP:
+    packet_info->l4_header = packet_info->l3_payload;
+    parse_igmp( buf );
+    break;
+
+  case IPPROTO_ETHERIP:
+    packet_info->l4_header = packet_info->l3_payload;
+    parse_etherip( buf );
+    break;
+
+  default:
+    // Unknown L4 type
+    break;
+  }
+
+  return true;
+
+}
+
+
+/*
+ * Local variables:
+ * c-basic-offset: 2
+ * indent-tabs-mode: nil
+ * End:
+ */