[mirror_ubuntu-bionic-kernel.git] / net / bridge / netfilter / ebt_log.c

/*
 *  ebt_log
 *
 *	Authors:
 *	Bart De Schuymer <bdschuym@pandora.be>
 *
 *  April, 2002
 *
 */

#include <linux/netfilter_bridge/ebtables.h>
#include <linux/netfilter_bridge/ebt_log.h>
#include <linux/module.h>
#include <linux/ip.h>
#include <linux/if_arp.h>
#include <linux/spinlock.h>

static DEFINE_SPINLOCK(ebt_log_lock);

static int ebt_log_check(const char *tablename, unsigned int hookmask,
   const struct ebt_entry *e, void *data, unsigned int datalen)
{
	struct ebt_log_info *info = (struct ebt_log_info *)data;

	if (datalen != EBT_ALIGN(sizeof(struct ebt_log_info)))
		return -EINVAL;
	if (info->bitmask & ~EBT_LOG_MASK)
		return -EINVAL;
	if (info->loglevel >= 8)
		return -EINVAL;
	info->prefix[EBT_LOG_PREFIX_SIZE - 1] = '\0';
	return 0;
}

struct tcpudphdr
{
	uint16_t src;
	uint16_t dst;
};

struct arppayload
{
	unsigned char mac_src[ETH_ALEN];
	unsigned char ip_src[4];
	unsigned char mac_dst[ETH_ALEN];
	unsigned char ip_dst[4];
};

static void print_MAC(unsigned char *p)
{
	int i;

	for (i = 0; i < ETH_ALEN; i++, p++)
		printk("%02x%c", *p, i == ETH_ALEN - 1 ? ' ':':');
}

#define myNIPQUAD(a) a[0], a[1], a[2], a[3]
static void ebt_log(const struct sk_buff *skb, unsigned int hooknr,
   const struct net_device *in, const struct net_device *out,
   const void *data, unsigned int datalen)
{
	struct ebt_log_info *info = (struct ebt_log_info *)data;
	char level_string[4] = "< >";
	union {struct iphdr iph; struct tcpudphdr ports;
	       struct arphdr arph; struct arppayload arpp;} u;

	level_string[1] = '0' + info->loglevel;
	spin_lock_bh(&ebt_log_lock);
	printk(level_string);
	printk("%s IN=%s OUT=%s ", info->prefix, in ? in->name : "",
	   out ? out->name : "");

	printk("MAC source = ");
	print_MAC(eth_hdr(skb)->h_source);
	printk("MAC dest = ");
	print_MAC(eth_hdr(skb)->h_dest);

	printk("proto = 0x%04x", ntohs(eth_hdr(skb)->h_proto));

	if ((info->bitmask & EBT_LOG_IP) && eth_hdr(skb)->h_proto ==
	   htons(ETH_P_IP)){
		struct iphdr _iph, *ih;

		ih = skb_header_pointer(skb, 0, sizeof(_iph), &_iph);
		if (ih == NULL) {
			printk(" INCOMPLETE IP header");
			goto out;
		}
		printk(" IP SRC=%u.%u.%u.%u IP DST=%u.%u.%u.%u,",
		   NIPQUAD(ih->saddr), NIPQUAD(ih->daddr));
		printk(" IP tos=0x%02X, IP proto=%d", u.iph.tos,
		       ih->protocol);
		if (ih->protocol == IPPROTO_TCP ||
		    ih->protocol == IPPROTO_UDP) {
			struct tcpudphdr _ports, *pptr;

			pptr = skb_header_pointer(skb, ih->ihl*4,
						  sizeof(_ports), &_ports);
			if (pptr == NULL) {
				printk(" INCOMPLETE TCP/UDP header");
				goto out;
			}
			printk(" SPT=%u DPT=%u", ntohs(pptr->src),
			   ntohs(pptr->dst));
		}
		goto out;
	}

	if ((info->bitmask & EBT_LOG_ARP) &&
	    ((eth_hdr(skb)->h_proto == htons(ETH_P_ARP)) ||
	     (eth_hdr(skb)->h_proto == htons(ETH_P_RARP)))) {
		struct arphdr _arph, *ah;

		ah = skb_header_pointer(skb, 0, sizeof(_arph), &_arph);
		if (ah == NULL) {
			printk(" INCOMPLETE ARP header");
			goto out;
		}
		printk(" ARP HTYPE=%d, PTYPE=0x%04x, OPCODE=%d",
		       ntohs(ah->ar_hrd), ntohs(ah->ar_pro),
		       ntohs(ah->ar_op));

		/* If it's for Ethernet and the lengths are OK,
		 * then log the ARP payload */
		if (ah->ar_hrd == htons(1) &&
		    ah->ar_hln == ETH_ALEN &&
		    ah->ar_pln == sizeof(uint32_t)) {
			struct arppayload _arpp, *ap;

			ap = skb_header_pointer(skb, sizeof(u.arph),
						sizeof(_arpp), &_arpp);
			if (ap == NULL) {
				printk(" INCOMPLETE ARP payload");
				goto out;
			}
			printk(" ARP MAC SRC=");
			print_MAC(ap->mac_src);
			printk(" ARP IP SRC=%u.%u.%u.%u",
			       myNIPQUAD(ap->ip_src));
			printk(" ARP MAC DST=");
			print_MAC(ap->mac_dst);
			printk(" ARP IP DST=%u.%u.%u.%u",
			       myNIPQUAD(ap->ip_dst));
		}
	}
out:
	printk("\n");
	spin_unlock_bh(&ebt_log_lock);
}

static struct ebt_watcher log =
{
	.name		= EBT_LOG_WATCHER,
	.watcher	= ebt_log,
	.check		= ebt_log_check,
	.me		= THIS_MODULE,
};

static int __init init(void)
{
	return ebt_register_watcher(&log);
}

static void __exit fini(void)
{
	ebt_unregister_watcher(&log);
}

module_init(init);
module_exit(fini);
MODULE_LICENSE("GPL");
Commit	Line	Data
1da177e4 LT	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 DEFINE_SPINLOCK(ebt_log_lock);
	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, unsigned int hooknr,
	59	const struct net_device in, const struct net_device out,
	60	const void *data, unsigned int datalen)
	61	{
	62	struct ebt_log_info info = (struct ebt_log_info )data;
	63	char level_string[4] = "< >";
	64	union {struct iphdr iph; struct tcpudphdr ports;
65	struct arphdr arph; struct arppayload arpp;} u;
66
67	level_string[1] = '0' + info->loglevel;
68	spin_lock_bh(&ebt_log_lock);
69	printk(level_string);
70	printk("%s IN=%s OUT=%s ", info->prefix, in ? in->name : "",
71	out ? out->name : "");
72
73	printk("MAC source = ");
74	print_MAC(eth_hdr(skb)->h_source);
75	printk("MAC dest = ");
76	print_MAC(eth_hdr(skb)->h_dest);
77
78	printk("proto = 0x%04x", ntohs(eth_hdr(skb)->h_proto));
79
80	if ((info->bitmask & EBT_LOG_IP) && eth_hdr(skb)->h_proto ==
81	htons(ETH_P_IP)){
82	struct iphdr _iph, *ih;
83
84	ih = skb_header_pointer(skb, 0, sizeof(_iph), &_iph);
85	if (ih == NULL) {
86	printk(" INCOMPLETE IP header");
87	goto out;
88	}
89	printk(" IP SRC=%u.%u.%u.%u IP DST=%u.%u.%u.%u,",
90	NIPQUAD(ih->saddr), NIPQUAD(ih->daddr));
91	printk(" IP tos=0x%02X, IP proto=%d", u.iph.tos,
92	ih->protocol);
93	if (ih->protocol == IPPROTO_TCP \|\|
94	ih->protocol == IPPROTO_UDP) {
95	struct tcpudphdr _ports, *pptr;
96
97	pptr = skb_header_pointer(skb, ih->ihl*4,
98	sizeof(_ports), &_ports);
99	if (pptr == NULL) {
100	printk(" INCOMPLETE TCP/UDP header");
101	goto out;
102	}
103	printk(" SPT=%u DPT=%u", ntohs(pptr->src),
104	ntohs(pptr->dst));
105	}
106	goto out;
107	}
108
109	if ((info->bitmask & EBT_LOG_ARP) &&
110	((eth_hdr(skb)->h_proto == htons(ETH_P_ARP)) \|\|
111	(eth_hdr(skb)->h_proto == htons(ETH_P_RARP)))) {
112	struct arphdr _arph, *ah;
113
114	ah = skb_header_pointer(skb, 0, sizeof(_arph), &_arph);
115	if (ah == NULL) {
116	printk(" INCOMPLETE ARP header");
117	goto out;
118	}
119	printk(" ARP HTYPE=%d, PTYPE=0x%04x, OPCODE=%d",
120	ntohs(ah->ar_hrd), ntohs(ah->ar_pro),
121	ntohs(ah->ar_op));
122
123	/* If it's for Ethernet and the lengths are OK,
124	* then log the ARP payload */
125	if (ah->ar_hrd == htons(1) &&
126	ah->ar_hln == ETH_ALEN &&
127	ah->ar_pln == sizeof(uint32_t)) {
128	struct arppayload _arpp, *ap;
129
130	ap = skb_header_pointer(skb, sizeof(u.arph),
131	sizeof(_arpp), &_arpp);
132	if (ap == NULL) {
133	printk(" INCOMPLETE ARP payload");
134	goto out;
135	}
136	printk(" ARP MAC SRC=");
137	print_MAC(ap->mac_src);
138	printk(" ARP IP SRC=%u.%u.%u.%u",
139	myNIPQUAD(ap->ip_src));
140	printk(" ARP MAC DST=");
141	print_MAC(ap->mac_dst);
142	printk(" ARP IP DST=%u.%u.%u.%u",
143	myNIPQUAD(ap->ip_dst));
144	}
145	}
146	out:
147	printk("\n");
148	spin_unlock_bh(&ebt_log_lock);
149	}
150
151	static struct ebt_watcher log =
152	{
153	.name = EBT_LOG_WATCHER,
154	.watcher = ebt_log,
155	.check = ebt_log_check,
156	.me = THIS_MODULE,
157	};
158
159	static int __init init(void)
160	{
161	return ebt_register_watcher(&log);
162	}
163
164	static void __exit fini(void)
165	{
166	ebt_unregister_watcher(&log);
167	}
168
169	module_init(init);
170	module_exit(fini);
171	MODULE_LICENSE("GPL");