123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603 |
- /* $Id$ */
- /*
- * Copyright (c) 2006-2007 Aaron Turner.
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- *
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- * 3. Neither the names of the copyright owners nor the names of its
- * contributors may be used to endorse or promote products derived from
- * this software without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
- * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
- * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
- * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
- * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
- * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
- * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
- * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
- * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- */
- #include <stdlib.h>
- #include <string.h>
- #include "en10mb.h"
- #include "dlt_plugins-int.h"
- #include "tcpedit.h"
- #include "common.h"
- #include "tcpr.h"
- #include "dlt_utils.h"
- #include "tcpedit_stub.h"
- #include "../ethernet.h"
- static char __attribute__((unused)) dlt_name[] = "en10mb";
- static char dlt_prefix[] = "enet";
- static u_int16_t dlt_value = DLT_EN10MB;
- /*
- * Function to register ourselves. This function is always called, regardless
- * of what DLT types are being used, so it shouldn't be allocating extra buffers
- * or anything like that (use the dlt_en10mb_init() function below for that).
- * Tasks:
- * - Create a new plugin struct
- * - Fill out the provides/requires bit masks. Note: Only specify which fields are
- * actually in the header.
- * - Add the plugin to the context's plugin chain
- * Returns: TCPEDIT_ERROR | TCPEDIT_OK | TCPEDIT_WARN
- */
- int
- dlt_en10mb_register(tcpeditdlt_t *ctx)
- {
- tcpeditdlt_plugin_t *plugin;
- assert(ctx);
- /* create a new plugin structure */
- plugin = tcpedit_dlt_newplugin();
- /* set what we provide & require */
- plugin->provides += PLUGIN_MASK_PROTO + PLUGIN_MASK_SRCADDR + PLUGIN_MASK_DSTADDR;
- plugin->requires += PLUGIN_MASK_PROTO + PLUGIN_MASK_SRCADDR + PLUGIN_MASK_DSTADDR;
- /* what is our dlt type? */
- plugin->dlt = dlt_value;
- /* set the prefix name of our plugin. This is also used as the prefix for our options */
- plugin->name = safe_strdup(dlt_prefix);
- /*
- * Point to our functions, note, you need a function for EVERY method.
- * Even if it is only an empty stub returning success.
- */
- plugin->plugin_init = dlt_en10mb_init;
- plugin->plugin_cleanup = dlt_en10mb_cleanup;
- plugin->plugin_parse_opts = dlt_en10mb_parse_opts;
- plugin->plugin_decode = dlt_en10mb_decode;
- plugin->plugin_encode = dlt_en10mb_encode;
- plugin->plugin_proto = dlt_en10mb_proto;
- plugin->plugin_l2addr_type = dlt_en10mb_l2addr_type;
- plugin->plugin_l2len = dlt_en10mb_l2len;
- plugin->plugin_get_layer3 = dlt_en10mb_get_layer3;
- plugin->plugin_merge_layer3 = dlt_en10mb_merge_layer3;
- /* add it to the available plugin list */
- return tcpedit_dlt_addplugin(ctx, plugin);
- }
-
- /*
- * Initializer function. This function is called only once, if and only iif
- * this plugin will be utilized. Remember, if you need to keep track of any state,
- * store it in your plugin->config, not a global!
- * Returns: TCPEDIT_ERROR | TCPEDIT_OK | TCPEDIT_WARN
- */
- int
- dlt_en10mb_init(tcpeditdlt_t *ctx)
- {
- tcpeditdlt_plugin_t *plugin;
- en10mb_config_t *config;
- assert(ctx);
-
- /* vlan tags need an additional 4 bytes */
- if ((plugin = tcpedit_dlt_getplugin(ctx, dlt_value)) == NULL) {
- tcpedit_seterr(ctx->tcpedit, "%s", "Unable to initalize unregistered plugin en10mb");
- return TCPEDIT_ERROR;
- }
-
- ctx->decoded_extra = safe_malloc(sizeof(en10mb_extra_t));
- plugin->config = safe_malloc(sizeof(en10mb_config_t));
- config = (en10mb_config_t *)plugin->config;
-
- /* init vlan user values to -1 to indicate not set */
- config->vlan_tag = 65535;
- config->vlan_pri = 255;
- config->vlan_cfi = 255;
-
-
- return TCPEDIT_OK; /* success */
- }
- /*
- * Since this is used in a library, we should manually clean up after ourselves
- * Unless you allocated some memory in dlt_en10mb_init(), this is just an stub.
- * Returns: TCPEDIT_ERROR | TCPEDIT_OK | TCPEDIT_WARN
- */
- int
- dlt_en10mb_cleanup(tcpeditdlt_t *ctx)
- {
- tcpeditdlt_plugin_t *plugin;
-
- assert(ctx);
-
- if ((plugin = tcpedit_dlt_getplugin(ctx, dlt_value)) == NULL)
- return TCPEDIT_OK;
- if (ctx->decoded_extra != NULL) {
- free(ctx->decoded_extra);
- ctx->decoded_extra = NULL;
- }
- if (plugin->config != NULL) {
- free(plugin->config);
- plugin->config = NULL;
- }
-
- return TCPEDIT_OK; /* success */
- }
- /*
- * This is where you should define all your AutoGen AutoOpts option parsing.
- * Any user specified option should have it's bit turned on in the 'provides'
- * bit mask.
- * Returns: TCPEDIT_ERROR | TCPEDIT_OK | TCPEDIT_WARN
- */
- int
- dlt_en10mb_parse_opts(tcpeditdlt_t *ctx)
- {
- tcpeditdlt_plugin_t *plugin;
- en10mb_config_t *config;
- assert(ctx);
- plugin = tcpedit_dlt_getplugin(ctx, dlt_value);
- config = (en10mb_config_t *)plugin->config;
- /* --dmac */
- if (HAVE_OPT(ENET_DMAC)) {
- int macparse;
- macparse = dualmac2hex(OPT_ARG(ENET_DMAC), config->intf1_dmac,
- config->intf2_dmac, strlen(OPT_ARG(ENET_DMAC)));
- switch (macparse) {
- case 1:
- config->mac_mask += TCPEDIT_MAC_MASK_DMAC1;
- break;
- case 2:
- config->mac_mask += TCPEDIT_MAC_MASK_DMAC2;
- break;
- case 3:
- config->mac_mask += TCPEDIT_MAC_MASK_DMAC1;
- config->mac_mask += TCPEDIT_MAC_MASK_DMAC2;
- break;
- case 0:
- /* nothing to do */
- break;
- default:
- tcpedit_seterr(ctx->tcpedit,
- "Unable to parse --enet-dmac=%s", OPT_ARG(ENET_DMAC));
- return TCPEDIT_ERROR;
- break;
- }
- plugin->requires -= PLUGIN_MASK_DSTADDR;
- }
- /* --smac */
- if (HAVE_OPT(ENET_SMAC)) {
- int macparse;
- macparse = dualmac2hex(OPT_ARG(ENET_SMAC), config->intf1_smac,
- config->intf2_smac, strlen(OPT_ARG(ENET_SMAC)));
- switch (macparse) {
- case 1:
- config->mac_mask += TCPEDIT_MAC_MASK_SMAC1;
- break;
- case 2:
- config->mac_mask += TCPEDIT_MAC_MASK_SMAC2;
- break;
- case 3:
- config->mac_mask += TCPEDIT_MAC_MASK_SMAC1;
- config->mac_mask += TCPEDIT_MAC_MASK_SMAC2;
- break;
- case 0:
- /* nothing to do */
- break;
- default:
- tcpedit_seterr(ctx->tcpedit,
- "Unable to parse --enet-smac=%s", OPT_ARG(ENET_SMAC));
- return TCPEDIT_ERROR;
- break;
- }
- plugin->requires -= PLUGIN_MASK_SRCADDR;
- }
- /*
- * Validate 802.1q vlan args and populate tcpedit->vlan_record
- */
- if (HAVE_OPT(ENET_VLAN)) {
- if (strcmp(OPT_ARG(ENET_VLAN), "add") == 0) { // add or change
- config->vlan = TCPEDIT_VLAN_ADD;
- } else if (strcmp(OPT_ARG(ENET_VLAN), "del") == 0) {
- config->vlan = TCPEDIT_VLAN_DEL;
- } else {
- tcpedit_seterr(ctx->tcpedit, "Invalid --enet-vlan=%s", OPT_ARG(ENET_VLAN));
- return -1;
- }
- if (config->vlan != TCPEDIT_VLAN_OFF) {
- if (config->vlan == TCPEDIT_VLAN_ADD) {
- if (! HAVE_OPT(ENET_VLAN_TAG)) {
- tcpedit_seterr(ctx->tcpedit, "%s",
- "Must specify a new 802.1 VLAN tag if vlan "
- "mode is add");
- return TCPEDIT_ERROR;
- }
- /*
- * fill out the 802.1q header
- */
- config->vlan_tag = OPT_VALUE_ENET_VLAN_TAG;
- dbgx(1, "We will %s 802.1q headers",
- config->vlan == TCPEDIT_VLAN_DEL ? "delete" : "add/modify");
- if (HAVE_OPT(ENET_VLAN_PRI))
- config->vlan_pri = OPT_VALUE_ENET_VLAN_PRI;
- if (HAVE_OPT(ENET_VLAN_CFI))
- config->vlan_cfi = OPT_VALUE_ENET_VLAN_CFI;
- }
- }
- }
- return TCPEDIT_OK; /* success */
- }
- /*
- * Function to decode the layer 2 header in the packet
- * Returns: TCPEDIT_ERROR | TCPEDIT_OK | TCPEDIT_WARN
- */
- int
- dlt_en10mb_decode(tcpeditdlt_t *ctx, const u_char *packet, const int pktlen)
- {
- tcpeditdlt_plugin_t *plugin = NULL;
- struct tcpr_ethernet_hdr *eth = NULL;
- struct tcpr_802_1q_hdr *vlan = NULL;
- en10mb_extra_t *extra = NULL;
- en10mb_config_t *config = NULL;
-
- assert(ctx);
- assert(packet);
- assert(pktlen >= 14);
- plugin = tcpedit_dlt_getplugin(ctx, dlt_value);
- config = plugin->config;
- /* get our src & dst address */
- eth = (struct tcpr_ethernet_hdr *)packet;
- memcpy(&(ctx->dstaddr.ethernet), eth, ETHER_ADDR_LEN);
- memcpy(&(ctx->srcaddr.ethernet), &(eth->ether_shost), ETHER_ADDR_LEN);
- extra = (en10mb_extra_t *)ctx->decoded_extra;
- extra->vlan = 0;
-
- /* get the L3 protocol type & L2 len*/
- switch (eth->ether_type) {
- case ETHERTYPE_VLAN:
- vlan = (struct tcpr_802_1q_hdr *)packet;
- ctx->proto = vlan->vlan_len;
-
- /* Get VLAN tag info */
- extra->vlan = 1;
- /* must use these mask values, rather then what's in the tcpr.h since it assumes you're shifting */
- extra->vlan_tag = vlan->vlan_priority_c_vid & 0x0FFF;
- extra->vlan_pri = vlan->vlan_priority_c_vid & 0xE000;
- extra->vlan_cfi = vlan->vlan_priority_c_vid & 0x1000;
- ctx->l2len = TCPR_802_1Q_H;
- break;
-
- /* we don't properly handle SNAP encoding */
- default:
- ctx->proto = eth->ether_type;
- ctx->l2len = TCPR_802_3_H;
- break;
- }
- return TCPEDIT_OK; /* success */
- }
- /*
- * Function to encode the layer 2 header back into the packet.
- * Returns: TCPEDIT_ERROR | TCPEDIT_OK | TCPEDIT_WARN
- */
- int
- dlt_en10mb_encode(tcpeditdlt_t *ctx, u_char **packet_ex, int pktlen, tcpr_dir_t dir)
- {
- u_char *packet;
- tcpeditdlt_plugin_t *plugin = NULL;
- struct tcpr_ethernet_hdr *eth = NULL;
- struct tcpr_802_1q_hdr *vlan = NULL;
- en10mb_config_t *config = NULL;
- en10mb_extra_t *extra = NULL;
-
- int newl2len = 0;
- u_char tmpbuff[MAXPACKET];
- assert(ctx);
- assert(packet_ex);
- assert(pktlen >= 14);
-
- packet = *packet_ex;
- assert(packet);
- plugin = tcpedit_dlt_getplugin(ctx, dlt_value);
- config = plugin->config;
- extra = (en10mb_extra_t *)ctx->decoded_extra;
-
- /* figure out the new layer2 length, first for the case: ethernet -> ethernet? */
- if (ctx->decoder->dlt == dlt_value) {
- if ((ctx->l2len == TCPR_802_1Q_H && config->vlan == TCPEDIT_VLAN_OFF) ||
- (config->vlan == TCPEDIT_VLAN_ADD)) {
- newl2len = TCPR_802_1Q_H;
- } else if ((ctx->l2len == TCPR_802_3_H && config->vlan == TCPEDIT_VLAN_OFF) ||
- (config->vlan == TCPEDIT_VLAN_DEL)) {
- newl2len = TCPR_802_3_H;
- }
- }
-
- /* newl2len for some other DLT -> ethernet */
- else {
- /* if add a vlan then 18, else 14 bytes */
- newl2len = config->vlan == TCPEDIT_VLAN_ADD ? TCPR_802_1Q_H : TCPR_802_3_H;
- }
- /* Make space for our new L2 header */
- if (newl2len > ctx->l2len) {
- memcpy(tmpbuff, packet, pktlen);
- memcpy(packet + newl2len, (tmpbuff + ctx->l2len), pktlen - ctx->l2len);
- } else if (newl2len < ctx->l2len) {
- memmove(packet + newl2len, packet + ctx->l2len, pktlen - ctx->l2len);
- } /* else same size, so do nothing */
- /* update the total packet length */
- pktlen += newl2len - ctx->l2len;
-
- /* always set the src & dst address as the first 12 bytes */
- eth = (struct tcpr_ethernet_hdr *)packet;
-
- if (dir == TCPR_DIR_C2S) {
- /* copy user supplied SRC MAC if provided or from original packet */
- if (config->mac_mask & TCPEDIT_MAC_MASK_SMAC1) {
- if ((ctx->addr_type == ETHERNET &&
- ((ctx->skip_broadcast &&
- is_unicast_ethernet(ctx, ctx->srcaddr.ethernet)) || !ctx->skip_broadcast))
- || ctx->addr_type != ETHERNET) {
- memcpy(eth->ether_shost, config->intf1_smac, ETHER_ADDR_LEN);
- } else {
- memcpy(eth->ether_shost, ctx->srcaddr.ethernet, ETHER_ADDR_LEN);
- }
- } else if (ctx->addr_type == ETHERNET) {
- memcpy(eth->ether_shost, ctx->srcaddr.ethernet, ETHER_ADDR_LEN);
- } else {
- tcpedit_seterr(ctx->tcpedit, "%s", "Please provide a source address");
- return TCPEDIT_ERROR;
- }
- /* copy user supplied DMAC MAC if provided or from original packet */
- if (config->mac_mask & TCPEDIT_MAC_MASK_DMAC1) {
- if ((ctx->addr_type == ETHERNET &&
- ((ctx->skip_broadcast && is_unicast_ethernet(ctx, ctx->dstaddr.ethernet)) || !ctx->skip_broadcast))
- || ctx->addr_type != ETHERNET) {
- memcpy(eth->ether_dhost, config->intf1_dmac, ETHER_ADDR_LEN);
- } else {
- memcpy(eth->ether_dhost, ctx->dstaddr.ethernet, ETHER_ADDR_LEN);
- }
- } else if (ctx->addr_type == ETHERNET) {
- memcpy(eth->ether_dhost, ctx->dstaddr.ethernet, ETHER_ADDR_LEN);
- } else {
- tcpedit_seterr(ctx->tcpedit, "%s", "Please provide a destination address");
- return TCPEDIT_ERROR;
- }
-
- } else if (dir == TCPR_DIR_S2C) {
- /* copy user supplied SRC MAC if provided or from original packet */
- if (config->mac_mask & TCPEDIT_MAC_MASK_SMAC2) {
- if ((ctx->addr_type == ETHERNET &&
- ((ctx->skip_broadcast && is_unicast_ethernet(ctx, ctx->srcaddr.ethernet)) || !ctx->skip_broadcast))
- || ctx->addr_type != ETHERNET) {
- memcpy(eth->ether_shost, config->intf2_smac, ETHER_ADDR_LEN);
- } else {
- memcpy(eth->ether_shost, ctx->srcaddr.ethernet, ETHER_ADDR_LEN);
- }
- } else if (ctx->addr_type == ETHERNET) {
- memcpy(eth->ether_shost, ctx->srcaddr.ethernet, ETHER_ADDR_LEN);
- } else {
- tcpedit_seterr(ctx->tcpedit, "%s", "Please provide a source address");
- return TCPEDIT_ERROR;
- }
-
- /* copy user supplied DMAC MAC if provided or from original packet */
- if (config->mac_mask & TCPEDIT_MAC_MASK_DMAC2) {
- if ((ctx->addr_type == ETHERNET &&
- ((ctx->skip_broadcast && is_unicast_ethernet(ctx, ctx->dstaddr.ethernet)) || !ctx->skip_broadcast))
- || ctx->addr_type != ETHERNET) {
- memcpy(eth->ether_dhost, config->intf2_dmac, ETHER_ADDR_LEN);
- } else {
- memcpy(eth->ether_dhost, ctx->dstaddr.ethernet, ETHER_ADDR_LEN);
- }
- } else if (ctx->addr_type == ETHERNET) {
- memcpy(eth->ether_dhost, ctx->dstaddr.ethernet, ETHER_ADDR_LEN);
- } else {
- tcpedit_seterr(ctx->tcpedit, "%s", "Please provide a destination address");
- return TCPEDIT_ERROR;
- }
-
- } else {
- tcpedit_seterr(ctx->tcpedit, "%s", "Encoders only support C2S or C2S!");
- return TCPEDIT_ERROR;
- }
-
- if (newl2len == TCPR_802_3_H) {
- /* all we need for 802.3 is the proto */
- eth->ether_type = ctx->proto;
-
- } else if (newl2len == TCPR_802_1Q_H) {
- /* VLAN tags need a bit more */
- vlan = (struct tcpr_802_1q_hdr *)packet;
- vlan->vlan_len = ctx->proto;
- vlan->vlan_tpi = htons(ETHERTYPE_VLAN);
-
- /* are we changing VLAN info? */
- if (config->vlan_tag < 65535) {
- vlan->vlan_priority_c_vid =
- htons((u_int16_t)config->vlan_tag & TCPR_802_1Q_VIDMASK);
- } else if (extra->vlan) {
- vlan->vlan_priority_c_vid = extra->vlan_tag;
- } else {
- tcpedit_seterr(ctx->tcpedit, "%s", "Non-VLAN tagged packet requires --enet-vlan-tag");
- return TCPEDIT_ERROR;
- }
-
- if (config->vlan_pri < 255) {
- vlan->vlan_priority_c_vid += htons((u_int16_t)config->vlan_pri << 13);
- } else if (extra->vlan) {
- vlan->vlan_priority_c_vid += extra->vlan_pri;
- } else {
- tcpedit_seterr(ctx->tcpedit, "%s", "Non-VLAN tagged packet requires --enet-vlan-pri");
- return TCPEDIT_ERROR;
- }
-
- if (config->vlan_cfi < 255) {
- vlan->vlan_priority_c_vid += htons((u_int16_t)config->vlan_cfi << 12);
- } else if (extra->vlan) {
- vlan->vlan_priority_c_vid += extra->vlan_cfi;
- } else {
- tcpedit_seterr(ctx->tcpedit, "%s", "Non-VLAN tagged packet requires --enet-vlan-cfi");
- return TCPEDIT_ERROR;
- }
-
- } else {
- tcpedit_seterr(ctx->tcpedit, "Unsupported new layer 2 length: %d", newl2len);
- return TCPEDIT_ERROR;
- }
- return pktlen;
- }
- /*
- * Function returns the Layer 3 protocol type of the given packet, or TCPEDIT_ERROR on error
- */
- int
- dlt_en10mb_proto(tcpeditdlt_t *ctx, const u_char *packet, const int pktlen)
- {
- struct tcpr_ethernet_hdr *eth = NULL;
- struct tcpr_802_1q_hdr *vlan = NULL;
-
- assert(ctx);
- assert(packet);
- assert(pktlen);
-
- eth = (struct tcpr_ethernet_hdr *)packet;
- switch (eth->ether_type) {
- case ETHERTYPE_VLAN:
- vlan = (struct tcpr_802_1q_hdr *)packet;
- return ntohs(vlan->vlan_len);
- break;
-
- default:
- return ntohs(eth->ether_type);
- break;
- }
- return TCPEDIT_ERROR;
- }
- /*
- * Function returns a pointer to the layer 3 protocol header or NULL on error
- */
- u_char *
- dlt_en10mb_get_layer3(tcpeditdlt_t *ctx, u_char *packet, const int pktlen)
- {
- int l2len;
- assert(ctx);
- assert(packet);
- assert(pktlen);
-
- l2len = dlt_en10mb_l2len(ctx, packet, pktlen);
- return tcpedit_dlt_l3data_copy(ctx, packet, pktlen, l2len);
- }
- /*
- * function merges the packet (containing L2 and old L3) with the l3data buffer
- * containing the new l3 data. Note, if L2 % 4 == 0, then they're pointing to the
- * same buffer, otherwise there was a memcpy involved on strictly aligned architectures
- * like SPARC
- */
- u_char *
- dlt_en10mb_merge_layer3(tcpeditdlt_t *ctx, u_char *packet, const int pktlen, u_char *l3data)
- {
- int l2len;
- assert(ctx);
- assert(packet);
- assert(l3data);
-
- l2len = dlt_en10mb_l2len(ctx, packet, pktlen);
-
- assert(pktlen >= l2len);
-
- return tcpedit_dlt_l3data_merge(ctx, packet, pktlen, l3data, l2len);
- }
- /*
- * return the length of the L2 header of the current packet
- */
- int
- dlt_en10mb_l2len(tcpeditdlt_t *ctx, const u_char *packet, const int pktlen)
- {
- struct tcpr_ethernet_hdr *eth = NULL;
-
- assert(ctx);
- assert(packet);
- assert(pktlen);
-
- eth = (struct tcpr_ethernet_hdr *)packet;
- switch (eth->ether_type) {
- case ETHERTYPE_VLAN:
- return 18;
- break;
-
- default:
- return 14;
- break;
- }
- tcpedit_seterr(ctx->tcpedit, "%s", "Whoops! Bug in my code!");
- return -1;
- }
- tcpeditdlt_l2addr_type_t
- dlt_en10mb_l2addr_type(void)
- {
- return ETHERNET;
- }
|