153f17a9db278d33517d9888dd77848f554522a38JP Abgrall/* 253f17a9db278d33517d9888dd77848f554522a38JP Abgrall * Copyright (c) 2013, Petar Alilovic, 353f17a9db278d33517d9888dd77848f554522a38JP Abgrall * Faculty of Electrical Engineering and Computing, University of Zagreb 453f17a9db278d33517d9888dd77848f554522a38JP Abgrall * All rights reserved 553f17a9db278d33517d9888dd77848f554522a38JP Abgrall * 653f17a9db278d33517d9888dd77848f554522a38JP Abgrall * Redistribution and use in source and binary forms, with or without 753f17a9db278d33517d9888dd77848f554522a38JP Abgrall * modification, are permitted provided that the following conditions are met: 853f17a9db278d33517d9888dd77848f554522a38JP Abgrall * 953f17a9db278d33517d9888dd77848f554522a38JP Abgrall * * Redistributions of source code must retain the above copyright notice, 1053f17a9db278d33517d9888dd77848f554522a38JP Abgrall * this list of conditions and the following disclaimer. 1153f17a9db278d33517d9888dd77848f554522a38JP Abgrall * * Redistributions in binary form must reproduce the above copyright 1253f17a9db278d33517d9888dd77848f554522a38JP Abgrall * notice, this list of conditions and the following disclaimer in the 1353f17a9db278d33517d9888dd77848f554522a38JP Abgrall * documentation and/or other materials provided with the distribution. 1453f17a9db278d33517d9888dd77848f554522a38JP Abgrall * 1553f17a9db278d33517d9888dd77848f554522a38JP Abgrall * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND ANY 1653f17a9db278d33517d9888dd77848f554522a38JP Abgrall * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 1753f17a9db278d33517d9888dd77848f554522a38JP Abgrall * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 1853f17a9db278d33517d9888dd77848f554522a38JP Abgrall * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY 1953f17a9db278d33517d9888dd77848f554522a38JP Abgrall * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 2053f17a9db278d33517d9888dd77848f554522a38JP Abgrall * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 2153f17a9db278d33517d9888dd77848f554522a38JP Abgrall * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER 2253f17a9db278d33517d9888dd77848f554522a38JP Abgrall * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2353f17a9db278d33517d9888dd77848f554522a38JP Abgrall * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2453f17a9db278d33517d9888dd77848f554522a38JP Abgrall * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH 2553f17a9db278d33517d9888dd77848f554522a38JP Abgrall * DAMAGE. 2653f17a9db278d33517d9888dd77848f554522a38JP Abgrall */ 2753f17a9db278d33517d9888dd77848f554522a38JP Abgrall 2853f17a9db278d33517d9888dd77848f554522a38JP Abgrall#ifdef HAVE_CONFIG_H 2953f17a9db278d33517d9888dd77848f554522a38JP Abgrall#include "config.h" 3053f17a9db278d33517d9888dd77848f554522a38JP Abgrall#endif 3153f17a9db278d33517d9888dd77848f554522a38JP Abgrall 3253f17a9db278d33517d9888dd77848f554522a38JP Abgrall#include <tcpdump-stdinc.h> 3353f17a9db278d33517d9888dd77848f554522a38JP Abgrall 3453f17a9db278d33517d9888dd77848f554522a38JP Abgrall#include <stdio.h> 3553f17a9db278d33517d9888dd77848f554522a38JP Abgrall#include <pcap.h> 3653f17a9db278d33517d9888dd77848f554522a38JP Abgrall 3753f17a9db278d33517d9888dd77848f554522a38JP Abgrall#include "netdissect.h" 3853f17a9db278d33517d9888dd77848f554522a38JP Abgrall#include "interface.h" 3953f17a9db278d33517d9888dd77848f554522a38JP Abgrall 4053f17a9db278d33517d9888dd77848f554522a38JP Abgrall#if defined(DLT_NFLOG) && defined(HAVE_PCAP_NFLOG_H) 4153f17a9db278d33517d9888dd77848f554522a38JP Abgrall#include <pcap/nflog.h> 4253f17a9db278d33517d9888dd77848f554522a38JP Abgrall 4353f17a9db278d33517d9888dd77848f554522a38JP Abgrallstatic const struct tok nflog_values[] = { 4453f17a9db278d33517d9888dd77848f554522a38JP Abgrall { AF_INET, "IPv4" }, 4553f17a9db278d33517d9888dd77848f554522a38JP Abgrall { AF_INET6, "IPv6" }, 4653f17a9db278d33517d9888dd77848f554522a38JP Abgrall { 0, NULL } 4753f17a9db278d33517d9888dd77848f554522a38JP Abgrall}; 4853f17a9db278d33517d9888dd77848f554522a38JP Abgrall 4953f17a9db278d33517d9888dd77848f554522a38JP Abgrallstatic inline void 5053f17a9db278d33517d9888dd77848f554522a38JP Abgrallnflog_hdr_print(struct netdissect_options *ndo, const nflog_hdr_t *hdr, u_int length) 5153f17a9db278d33517d9888dd77848f554522a38JP Abgrall{ 5253f17a9db278d33517d9888dd77848f554522a38JP Abgrall ND_PRINT((ndo, "version %d, resource ID %d", hdr->nflog_version, ntohs(hdr->nflog_rid))); 5353f17a9db278d33517d9888dd77848f554522a38JP Abgrall 5453f17a9db278d33517d9888dd77848f554522a38JP Abgrall if (!ndo->ndo_qflag) { 5553f17a9db278d33517d9888dd77848f554522a38JP Abgrall ND_PRINT((ndo,", family %s (%d)", 5653f17a9db278d33517d9888dd77848f554522a38JP Abgrall tok2str(nflog_values, "Unknown", 5753f17a9db278d33517d9888dd77848f554522a38JP Abgrall hdr->nflog_family), 5853f17a9db278d33517d9888dd77848f554522a38JP Abgrall hdr->nflog_family)); 5953f17a9db278d33517d9888dd77848f554522a38JP Abgrall } else { 6053f17a9db278d33517d9888dd77848f554522a38JP Abgrall ND_PRINT((ndo,", %s", 6153f17a9db278d33517d9888dd77848f554522a38JP Abgrall tok2str(nflog_values, 6253f17a9db278d33517d9888dd77848f554522a38JP Abgrall "Unknown NFLOG (0x%02x)", 6353f17a9db278d33517d9888dd77848f554522a38JP Abgrall hdr->nflog_family))); 6453f17a9db278d33517d9888dd77848f554522a38JP Abgrall } 6553f17a9db278d33517d9888dd77848f554522a38JP Abgrall 6653f17a9db278d33517d9888dd77848f554522a38JP Abgrall ND_PRINT((ndo, ", length %u: ", length)); 6753f17a9db278d33517d9888dd77848f554522a38JP Abgrall} 6853f17a9db278d33517d9888dd77848f554522a38JP Abgrall 6953f17a9db278d33517d9888dd77848f554522a38JP Abgrallu_int 7053f17a9db278d33517d9888dd77848f554522a38JP Abgrallnflog_if_print(struct netdissect_options *ndo, 7153f17a9db278d33517d9888dd77848f554522a38JP Abgrall const struct pcap_pkthdr *h, const u_char *p) 7253f17a9db278d33517d9888dd77848f554522a38JP Abgrall{ 7353f17a9db278d33517d9888dd77848f554522a38JP Abgrall const nflog_hdr_t *hdr = (const nflog_hdr_t *)p; 7453f17a9db278d33517d9888dd77848f554522a38JP Abgrall const nflog_tlv_t *tlv; 7553f17a9db278d33517d9888dd77848f554522a38JP Abgrall u_int16_t size; 7653f17a9db278d33517d9888dd77848f554522a38JP Abgrall u_int16_t h_size = sizeof(nflog_hdr_t); 7753f17a9db278d33517d9888dd77848f554522a38JP Abgrall u_int caplen = h->caplen; 7853f17a9db278d33517d9888dd77848f554522a38JP Abgrall u_int length = h->len; 7953f17a9db278d33517d9888dd77848f554522a38JP Abgrall 8053f17a9db278d33517d9888dd77848f554522a38JP Abgrall if (caplen < (int) sizeof(nflog_hdr_t) || length < (int) sizeof(nflog_hdr_t)) { 8153f17a9db278d33517d9888dd77848f554522a38JP Abgrall ND_PRINT((ndo, "[|nflog]")); 8253f17a9db278d33517d9888dd77848f554522a38JP Abgrall return h_size; 8353f17a9db278d33517d9888dd77848f554522a38JP Abgrall } 8453f17a9db278d33517d9888dd77848f554522a38JP Abgrall 8553f17a9db278d33517d9888dd77848f554522a38JP Abgrall if (!(hdr->nflog_version) == 0) { 8653f17a9db278d33517d9888dd77848f554522a38JP Abgrall ND_PRINT((ndo, "version %u (unknown)", hdr->nflog_version)); 8753f17a9db278d33517d9888dd77848f554522a38JP Abgrall return h_size; 8853f17a9db278d33517d9888dd77848f554522a38JP Abgrall } 8953f17a9db278d33517d9888dd77848f554522a38JP Abgrall 9053f17a9db278d33517d9888dd77848f554522a38JP Abgrall if (ndo->ndo_eflag) 9153f17a9db278d33517d9888dd77848f554522a38JP Abgrall nflog_hdr_print(ndo, hdr, length); 9253f17a9db278d33517d9888dd77848f554522a38JP Abgrall 9353f17a9db278d33517d9888dd77848f554522a38JP Abgrall p += sizeof(nflog_hdr_t); 9453f17a9db278d33517d9888dd77848f554522a38JP Abgrall length -= sizeof(nflog_hdr_t); 9553f17a9db278d33517d9888dd77848f554522a38JP Abgrall caplen -= sizeof(nflog_hdr_t); 9653f17a9db278d33517d9888dd77848f554522a38JP Abgrall 9753f17a9db278d33517d9888dd77848f554522a38JP Abgrall while (length > 0) { 9853f17a9db278d33517d9888dd77848f554522a38JP Abgrall /* We have some data. Do we have enough for the TLV header? */ 9953f17a9db278d33517d9888dd77848f554522a38JP Abgrall if (caplen < sizeof(nflog_tlv_t) || length < sizeof(nflog_tlv_t)) { 10053f17a9db278d33517d9888dd77848f554522a38JP Abgrall /* No. */ 10153f17a9db278d33517d9888dd77848f554522a38JP Abgrall ND_PRINT((ndo, "[|nflog]")); 10253f17a9db278d33517d9888dd77848f554522a38JP Abgrall return h_size; 10353f17a9db278d33517d9888dd77848f554522a38JP Abgrall } 10453f17a9db278d33517d9888dd77848f554522a38JP Abgrall 10553f17a9db278d33517d9888dd77848f554522a38JP Abgrall tlv = (const nflog_tlv_t *) p; 10653f17a9db278d33517d9888dd77848f554522a38JP Abgrall size = tlv->tlv_length; 10753f17a9db278d33517d9888dd77848f554522a38JP Abgrall if (size % 4 != 0) 10853f17a9db278d33517d9888dd77848f554522a38JP Abgrall size += 4 - size % 4; 10953f17a9db278d33517d9888dd77848f554522a38JP Abgrall 11053f17a9db278d33517d9888dd77848f554522a38JP Abgrall /* Is the TLV's length less than the minimum? */ 11153f17a9db278d33517d9888dd77848f554522a38JP Abgrall if (size < sizeof(nflog_tlv_t)) { 11253f17a9db278d33517d9888dd77848f554522a38JP Abgrall /* Yes. Give up now. */ 11353f17a9db278d33517d9888dd77848f554522a38JP Abgrall ND_PRINT((ndo, "[|nflog]")); 11453f17a9db278d33517d9888dd77848f554522a38JP Abgrall return h_size; 11553f17a9db278d33517d9888dd77848f554522a38JP Abgrall } 11653f17a9db278d33517d9888dd77848f554522a38JP Abgrall 11753f17a9db278d33517d9888dd77848f554522a38JP Abgrall /* Do we have enough data for the full TLV? */ 11853f17a9db278d33517d9888dd77848f554522a38JP Abgrall if (caplen < size || length < size) { 11953f17a9db278d33517d9888dd77848f554522a38JP Abgrall /* No. */ 12053f17a9db278d33517d9888dd77848f554522a38JP Abgrall ND_PRINT((ndo, "[|nflog]")); 12153f17a9db278d33517d9888dd77848f554522a38JP Abgrall return h_size; 12253f17a9db278d33517d9888dd77848f554522a38JP Abgrall } 12353f17a9db278d33517d9888dd77848f554522a38JP Abgrall 12453f17a9db278d33517d9888dd77848f554522a38JP Abgrall if (tlv->tlv_type == NFULA_PAYLOAD) { 12553f17a9db278d33517d9888dd77848f554522a38JP Abgrall /* 12653f17a9db278d33517d9888dd77848f554522a38JP Abgrall * This TLV's data is the packet payload. 12753f17a9db278d33517d9888dd77848f554522a38JP Abgrall * Skip past the TLV header, and break out 12853f17a9db278d33517d9888dd77848f554522a38JP Abgrall * of the loop so we print the packet data. 12953f17a9db278d33517d9888dd77848f554522a38JP Abgrall */ 13053f17a9db278d33517d9888dd77848f554522a38JP Abgrall p += sizeof(nflog_tlv_t); 13153f17a9db278d33517d9888dd77848f554522a38JP Abgrall h_size += sizeof(nflog_tlv_t); 13253f17a9db278d33517d9888dd77848f554522a38JP Abgrall length -= sizeof(nflog_tlv_t); 13353f17a9db278d33517d9888dd77848f554522a38JP Abgrall caplen -= sizeof(nflog_tlv_t); 13453f17a9db278d33517d9888dd77848f554522a38JP Abgrall break; 13553f17a9db278d33517d9888dd77848f554522a38JP Abgrall } 13653f17a9db278d33517d9888dd77848f554522a38JP Abgrall 13753f17a9db278d33517d9888dd77848f554522a38JP Abgrall p += size; 13853f17a9db278d33517d9888dd77848f554522a38JP Abgrall h_size += size; 13953f17a9db278d33517d9888dd77848f554522a38JP Abgrall length -= size; 14053f17a9db278d33517d9888dd77848f554522a38JP Abgrall caplen -= size; 14153f17a9db278d33517d9888dd77848f554522a38JP Abgrall } 14253f17a9db278d33517d9888dd77848f554522a38JP Abgrall 14353f17a9db278d33517d9888dd77848f554522a38JP Abgrall switch (hdr->nflog_family) { 14453f17a9db278d33517d9888dd77848f554522a38JP Abgrall 14553f17a9db278d33517d9888dd77848f554522a38JP Abgrall case AF_INET: 14653f17a9db278d33517d9888dd77848f554522a38JP Abgrall ip_print(ndo, p, length); 14753f17a9db278d33517d9888dd77848f554522a38JP Abgrall break; 14853f17a9db278d33517d9888dd77848f554522a38JP Abgrall 14953f17a9db278d33517d9888dd77848f554522a38JP Abgrall#ifdef INET6 15053f17a9db278d33517d9888dd77848f554522a38JP Abgrall case AF_INET6: 15153f17a9db278d33517d9888dd77848f554522a38JP Abgrall ip6_print(ndo, p, length); 15253f17a9db278d33517d9888dd77848f554522a38JP Abgrall break; 15353f17a9db278d33517d9888dd77848f554522a38JP Abgrall#endif /*INET6*/ 15453f17a9db278d33517d9888dd77848f554522a38JP Abgrall 15553f17a9db278d33517d9888dd77848f554522a38JP Abgrall default: 15653f17a9db278d33517d9888dd77848f554522a38JP Abgrall if (!ndo->ndo_eflag) 15753f17a9db278d33517d9888dd77848f554522a38JP Abgrall nflog_hdr_print(ndo, hdr, 15853f17a9db278d33517d9888dd77848f554522a38JP Abgrall length + sizeof(nflog_hdr_t)); 15953f17a9db278d33517d9888dd77848f554522a38JP Abgrall 16053f17a9db278d33517d9888dd77848f554522a38JP Abgrall if (!ndo->ndo_suppress_default_print) 16153f17a9db278d33517d9888dd77848f554522a38JP Abgrall ndo->ndo_default_print(ndo, p, caplen); 16253f17a9db278d33517d9888dd77848f554522a38JP Abgrall break; 16353f17a9db278d33517d9888dd77848f554522a38JP Abgrall } 16453f17a9db278d33517d9888dd77848f554522a38JP Abgrall 16553f17a9db278d33517d9888dd77848f554522a38JP Abgrall return h_size; 16653f17a9db278d33517d9888dd77848f554522a38JP Abgrall} 16753f17a9db278d33517d9888dd77848f554522a38JP Abgrall 16853f17a9db278d33517d9888dd77848f554522a38JP Abgrall#endif /* defined(DLT_NFLOG) && defined(HAVE_PCAP_NFLOG_H) */ 169