net/bridge/netfilter/ebt_log.c

   1 /*
   2  *  ebt_log
   3  *
   4  *      Authors:
   5  *      Bart De Schuymer <bdschuym@pandora.be>
   6  *
   7  *  April, 2002
   8  *
   9  */
  10
  11 #include <linux/netfilter_bridge/ebtables.h>
  12 #include <linux/netfilter_bridge/ebt_log.h>
  13 #include <linux/module.h>
  14 #include <linux/ip.h>
  15 #include <linux/if_arp.h>
  16 #include <linux/spinlock.h>
  17
  18 static spinlock_t ebt_log_lock = SPIN_LOCK_UNLOCKED;
  19
  20 static int ebt_log_check(const char *tablename, unsigned int hookmask,
  21    const struct ebt_entry *e, void *data, unsigned int datalen)
  22 {
  23         struct ebt_log_info *info = (struct ebt_log_info *)data;
  24
  25         if (datalen != EBT_ALIGN(sizeof(struct ebt_log_info)))
  26                 return -EINVAL;
  27         if (info->bitmask & ~EBT_LOG_MASK)
  28                 return -EINVAL;
  29         if (info->loglevel >= 8)
  30                 return -EINVAL;
  31         info->prefix[EBT_LOG_PREFIX_SIZE - 1] = '\0';
  32         return 0;
  33 }
  34
  35 struct tcpudphdr
  36 {
  37         uint16_t src;
  38         uint16_t dst;
  39 };
  40
  41 struct arppayload
  42 {
  43         unsigned char mac_src[ETH_ALEN];
  44         unsigned char ip_src[4];
  45         unsigned char mac_dst[ETH_ALEN];
  46         unsigned char ip_dst[4];
  47 };
  48
  49 static void print_MAC(unsigned char *p)
  50 {
  51         int i;
  52
  53         for (i = 0; i < ETH_ALEN; i++, p++)
  54                 printk("%02x%c", *p, i == ETH_ALEN - 1 ? ' ':':');
  55 }
  56
  57 #define myNIPQUAD(a) a[0], a[1], a[2], a[3]
  58 static void ebt_log(const struct sk_buff *skb, const struct net_device *in,
  59    const struct net_device *out, const void *data, unsigned int datalen)
  60 {
  61         struct ebt_log_info *info = (struct ebt_log_info *)data;
  62         char level_string[4] = "< >";
  63         union {struct iphdr iph; struct tcpudphdr ports;
  64                struct arphdr arph; struct arppayload arpp;} u;
  65
  66         level_string[1] = '0' + info->loglevel;
  67         spin_lock_bh(&ebt_log_lock);
  68         printk(level_string);
  69         printk("%s IN=%s OUT=%s ", info->prefix, in ? in->name : "",
  70            out ? out->name : "");
  71
  72         printk("MAC source = ");
  73         print_MAC(eth_hdr(skb)->h_source);
  74         printk("MAC dest = ");
  75         print_MAC(eth_hdr(skb)->h_dest);
  76
  77         printk("proto = 0x%04x", ntohs(eth_hdr(skb)->h_proto));
  78
  79         if ((info->bitmask & EBT_LOG_IP) && eth_hdr(skb)->h_proto ==
  80            htons(ETH_P_IP)){
  81                 struct iphdr _iph, *ih;
  82
  83                 ih = skb_header_pointer(skb, 0, sizeof(_iph), &_iph);
  84                 if (ih == NULL) {
  85                         printk(" INCOMPLETE IP header");
  86                         goto out;
  87                 }
  88                 printk(" IP SRC=%u.%u.%u.%u IP DST=%u.%u.%u.%u,",
  89                    NIPQUAD(ih->saddr), NIPQUAD(ih->daddr));
  90                 printk(" IP tos=0x%02X, IP proto=%d", u.iph.tos,
  91                        ih->protocol);
  92                 if (ih->protocol == IPPROTO_TCP ||
  93                     ih->protocol == IPPROTO_UDP) {
  94                         struct tcpudphdr _ports, *pptr;
  95
  96                         pptr = skb_header_pointer(skb, ih->ihl*4,
  97                                                   sizeof(_ports), &_ports);
  98                         if (pptr == NULL) {
  99                                 printk(" INCOMPLETE TCP/UDP header");
 100                                 goto out;
 101                         }
 102                         printk(" SPT=%u DPT=%u", ntohs(pptr->src),
 103                            ntohs(pptr->dst));
 104                 }
 105                 goto out;
 106         }
 107
 108         if ((info->bitmask & EBT_LOG_ARP) &&
 109             ((eth_hdr(skb)->h_proto == htons(ETH_P_ARP)) ||
 110              (eth_hdr(skb)->h_proto == htons(ETH_P_RARP)))) {
 111                 struct arphdr _arph, *ah;
 112
 113                 ah = skb_header_pointer(skb, 0, sizeof(_arph), &_arph);
 114                 if (ah == NULL) {
 115                         printk(" INCOMPLETE ARP header");
 116                         goto out;
 117                 }
 118                 printk(" ARP HTYPE=%d, PTYPE=0x%04x, OPCODE=%d",
 119                        ntohs(ah->ar_hrd), ntohs(ah->ar_pro),
 120                        ntohs(ah->ar_op));
 121
 122                 /* If it's for Ethernet and the lengths are OK,
 123                  * then log the ARP payload */
 124                 if (ah->ar_hrd == htons(1) &&
 125                     ah->ar_hln == ETH_ALEN &&
 126                     ah->ar_pln == sizeof(uint32_t)) {
 127                         struct arppayload _arpp, *ap;
 128
 129                         ap = skb_header_pointer(skb, sizeof(u.arph),
 130                                                 sizeof(_arpp), &_arpp);
 131                         if (ap == NULL) {
 132                                 printk(" INCOMPLETE ARP payload");
 133                                 goto out;
 134                         }
 135                         printk(" ARP MAC SRC=");
 136                         print_MAC(ap->mac_src);
 137                         printk(" ARP IP SRC=%u.%u.%u.%u",
 138                                myNIPQUAD(ap->ip_src));
 139                         printk(" ARP MAC DST=");
 140                         print_MAC(ap->mac_dst);
 141                         printk(" ARP IP DST=%u.%u.%u.%u",
 142                                myNIPQUAD(ap->ip_dst));
 143                 }
 144         }
 145 out:
 146         printk("\n");
 147         spin_unlock_bh(&ebt_log_lock);
 148 }
 149
 150 static struct ebt_watcher log =
 151 {
 152         .name           = EBT_LOG_WATCHER,
 153         .watcher        = ebt_log,
 154         .check          = ebt_log_check,
 155         .me             = THIS_MODULE,
 156 };
 157
 158 static int __init init(void)
 159 {
 160         return ebt_register_watcher(&log);
 161 }
 162
 163 static void __exit fini(void)
 164 {
 165         ebt_unregister_watcher(&log);
 166 }
 167
 168 module_init(init);
 169 module_exit(fini);
 170 MODULE_LICENSE("GPL");