source: libpacketdump/link_6.c @ e78e408

/*
 *
 * Copyright (c) 2007-2016 The University of Waikato, Hamilton, New Zealand.
 * All rights reserved.
 *
 * This file is part of libtrace.
 *
 * This code has been developed by the University of Waikato WAND
 * research group. For further information please see http://www.wand.net.nz/
 *
 * libtrace is free software; you can redistribute it and/or modify
 * it under the terms of the GNU Lesser General Public License as published by
 * the Free Software Foundation; either version 3 of the License, or
 * (at your option) any later version.
 *
 * libtrace 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 Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 *
 *
 */
/* 
 * Linux SLL Decoder 
 * 
 */

#include "config.h"
//#include "libtrace_int.h"
#include <sys/types.h>
#include <netinet/in.h>
#include <stdio.h>
#include "libpacketdump.h"
#include "libtrace.h"

#include "libtrace_arphrd.h"

/* Copied this here because this isn't currently part of our external API -
 * maybe we need to think about doing that? */
static libtrace_linktype_t arphrd_type_to_libtrace(unsigned int arphrd) {
        switch(arphrd) {
                case LIBTRACE_ARPHRD_ETHER: return TRACE_TYPE_ETH;
                case LIBTRACE_ARPHRD_EETHER: return TRACE_TYPE_ETH;
                case LIBTRACE_ARPHRD_IEEE80211: return TRACE_TYPE_80211;
                case LIBTRACE_ARPHRD_IEEE80211_RADIOTAP: return TRACE_TYPE_80211_RADIO;
                case LIBTRACE_ARPHRD_PPP: return TRACE_TYPE_NONE;
                case LIBTRACE_ARPHRD_LOOPBACK: return TRACE_TYPE_NONE;
                case LIBTRACE_ARPHRD_NONE: return TRACE_TYPE_NONE;
        }
        printf("Unknown ARPHRD: %u\n", arphrd);
        return ~0U;
}

DLLEXPORT void decode(int link_type ,const char *pkt,unsigned len) 
{
        libtrace_sll_header_t *sll = (libtrace_sll_header_t *) pkt;
        libtrace_linktype_t linktype = link_type;
        void *ret;      

        if (len < sizeof(*sll)) {
                printf(" Linux SLL: Truncated (len = %u)\n", len);
                return;
        }

        printf(" Linux SLL: Packet Type = ");
        switch(ntohs(sll->pkttype)) {
                case TRACE_SLL_HOST: printf("HOST\n"); break;
                case TRACE_SLL_BROADCAST: printf("BROADCAST\n"); break;
                case TRACE_SLL_MULTICAST: printf("MULTICAST\n"); break;
                case TRACE_SLL_OTHERHOST: printf("OTHERHOST\n"); break;
                case TRACE_SLL_OUTGOING: printf("OUTGOING\n"); break;
                default: printf("Unknown (0x%04x)\n", ntohs(sll->pkttype));
        }
        
        printf(" Linux SLL: Hardware Address Type = 0x%04x\n", ntohs(sll->hatype));
        printf(" Linux SLL: Hardware Address Length = %u\n", ntohs(sll->halen));
        printf(" Linux SLL: Hardware Address = %s\n", trace_ether_ntoa( (sll->addr), NULL));

        printf(" Linux SLL: Protocol = 0x%04x\n", ntohs(sll->protocol));

        /* Decide how to continue processing... */
        
        /* Do we recognise the hardware address type? */
        ret=trace_get_payload_from_meta(pkt, &linktype, &len);
        
        if (ntohs(sll->hatype) == LIBTRACE_ARPHRD_ETHER || 
                                ntohs(sll->hatype) == LIBTRACE_ARPHRD_LOOPBACK) { 
                
                if (ntohs(sll->protocol) == 0x0060) {
                        decode_next(ret, len, "link", 
                                arphrd_type_to_libtrace(ntohs(sll->hatype)));
                }
                else
                        decode_next(pkt + sizeof(*sll), len - sizeof(*sll), 
                                        "eth", ntohs(sll->protocol));
        }
        else {
                decode_next(ret, len, "link", 
                                arphrd_type_to_libtrace(ntohs(sll->hatype)));
        }
        return;
        
}