[linux-2.6-block.git] / arch / um / drivers / pcap_user.c

/*
 * Copyright (C) 2002 Jeff Dike <jdike@karaya.com>
 * Licensed under the GPL.
 */

#include <unistd.h>
#include <stdlib.h>
#include <string.h>
#include <errno.h>
#include <pcap.h>
#include <asm/types.h>
#include "net_user.h"
#include "pcap_user.h"
#include "user.h"
#include "um_malloc.h"
#include "kern_constants.h"

#define MAX_PACKET (ETH_MAX_PACKET + ETH_HEADER_OTHER)

#define PCAP_FD(p) (*(int *)(p))

static int pcap_user_init(void *data, void *dev)
{
	struct pcap_data *pri = data;
	pcap_t *p;
	char errors[PCAP_ERRBUF_SIZE];

	p = pcap_open_live(pri->host_if, MAX_PACKET, pri->promisc, 0, errors);
	if(p == NULL){
		printk(UM_KERN_ERR "pcap_user_init : pcap_open_live failed - "
		       "'%s'\n", errors);
		return -EINVAL;
	}

	pri->dev = dev;
	pri->pcap = p;
	return 0;
}

static int pcap_open(void *data)
{
	struct pcap_data *pri = data;
	__u32 netmask;
	int err;

	if(pri->pcap == NULL)
		return -ENODEV;

	if(pri->filter != NULL){
		err = dev_netmask(pri->dev, &netmask);
		if(err < 0){
			printk(UM_KERN_ERR "pcap_open : dev_netmask failed\n");
			return -EIO;
		}

		pri->compiled = kmalloc(sizeof(struct bpf_program), UM_GFP_KERNEL);
		if(pri->compiled == NULL){
			printk(UM_KERN_ERR "pcap_open : kmalloc failed\n");
			return -ENOMEM;
		}

		err = pcap_compile(pri->pcap, 
				   (struct bpf_program *) pri->compiled, 
				   pri->filter, pri->optimize, netmask);
		if(err < 0){
			printk(UM_KERN_ERR "pcap_open : pcap_compile failed - "
			       "'%s'\n", pcap_geterr(pri->pcap));
			return -EIO;
		}

		err = pcap_setfilter(pri->pcap, pri->compiled);
		if(err < 0){
			printk(UM_KERN_ERR "pcap_open : pcap_setfilter "
			       "failed - '%s'\n", pcap_geterr(pri->pcap));
			return -EIO;
		}
	}

	return PCAP_FD(pri->pcap);
}

static void pcap_remove(void *data)
{
	struct pcap_data *pri = data;

	if(pri->compiled != NULL)
		pcap_freecode(pri->compiled);

	if(pri->pcap != NULL)
		pcap_close(pri->pcap);
}

struct pcap_handler_data {
	char *buffer;
	int len;
};

static void handler(u_char *data, const struct pcap_pkthdr *header, 
		    const u_char *packet)
{
	int len;

	struct pcap_handler_data *hdata = (struct pcap_handler_data *) data;

	len = hdata->len < header->caplen ? hdata->len : header->caplen;
	memcpy(hdata->buffer, packet, len);
	hdata->len = len;
}

int pcap_user_read(int fd, void *buffer, int len, struct pcap_data *pri)
{
	struct pcap_handler_data hdata = ((struct pcap_handler_data)
		                          { .buffer  	= buffer,
					    .len 	= len });
	int n;

	n = pcap_dispatch(pri->pcap, 1, handler, (u_char *) &hdata);
	if(n < 0){
		printk(UM_KERN_ERR "pcap_dispatch failed - %s\n",
		       pcap_geterr(pri->pcap));
		return -EIO;
	}
	else if(n == 0) 
		return 0;
	return hdata.len;
}

const struct net_user_info pcap_user_info = {
	.init		= pcap_user_init,
	.open		= pcap_open,
	.close	 	= NULL,
	.remove	 	= pcap_remove,
	.set_mtu	= NULL,
	.add_address	= NULL,
	.delete_address = NULL,
	.max_packet	= MAX_PACKET - ETH_HEADER_OTHER
};
Commit	Line	Data
1da177e4 LT	1	/*
	2	* Copyright (C) 2002 Jeff Dike <jdike@karaya.com>
	3	* Licensed under the GPL.
	4	*/
	5
	6	#include <unistd.h>
	7	#include <stdlib.h>
	8	#include <string.h>
	9	#include <errno.h>
	10	#include <pcap.h>
	11	#include <asm/types.h>
	12	#include "net_user.h"
	13	#include "pcap_user.h"
	14	#include "user.h"
c13e5690	15	#include "um_malloc.h"
7d98230a	16	#include "kern_constants.h"
1da177e4 LT	17
	18	#define MAX_PACKET (ETH_MAX_PACKET + ETH_HEADER_OTHER)
	19
	20	#define PCAP_FD(p) ((int )(p))
	21
f34d9d2d	22	static int pcap_user_init(void data, void dev)
1da177e4 LT	23	{
	24	struct pcap_data *pri = data;
	25	pcap_t *p;
	26	char errors[PCAP_ERRBUF_SIZE];
	27
	28	p = pcap_open_live(pri->host_if, MAX_PACKET, pri->promisc, 0, errors);
	29	if(p == NULL){
7d98230a JD	30	printk(UM_KERN_ERR "pcap_user_init : pcap_open_live failed - "
7d98230a JD	31	"'%s'\n", errors);
f34d9d2d	32	return -EINVAL;
1da177e4 LT	33	}
	34
	35	pri->dev = dev;
	36	pri->pcap = p;
f34d9d2d	37	return 0;
1da177e4 LT	38	}
	39
	40	static int pcap_open(void *data)
	41	{
	42	struct pcap_data *pri = data;
	43	__u32 netmask;
	44	int err;
	45
	46	if(pri->pcap == NULL)
56bd194b	47	return -ENODEV;
1da177e4 LT	48
	49	if(pri->filter != NULL){
	50	err = dev_netmask(pri->dev, &netmask);
	51	if(err < 0){
7d98230a	52	printk(UM_KERN_ERR "pcap_open : dev_netmask failed\n");
56bd194b	53	return -EIO;
1da177e4 LT	54	}
1da177e4 LT	55
6d0fd9c9	56	pri->compiled = kmalloc(sizeof(struct bpf_program), UM_GFP_KERNEL);
1da177e4	57	if(pri->compiled == NULL){
7d98230a	58	printk(UM_KERN_ERR "pcap_open : kmalloc failed\n");
56bd194b	59	return -ENOMEM;
1da177e4	60	}
56bd194b	61
1da177e4 LT	62	err = pcap_compile(pri->pcap,
	63	(struct bpf_program *) pri->compiled,
	64	pri->filter, pri->optimize, netmask);
	65	if(err < 0){
7d98230a JD	66	printk(UM_KERN_ERR "pcap_open : pcap_compile failed - "
7d98230a JD	67	"'%s'\n", pcap_geterr(pri->pcap));
56bd194b	68	return -EIO;
1da177e4 LT	69	}
	70
	71	err = pcap_setfilter(pri->pcap, pri->compiled);
	72	if(err < 0){
7d98230a JD	73	printk(UM_KERN_ERR "pcap_open : pcap_setfilter "
7d98230a JD	74	"failed - '%s'\n", pcap_geterr(pri->pcap));
56bd194b	75	return -EIO;
1da177e4 LT	76	}
1da177e4 LT	77	}
56bd194b JD	78
56bd194b JD	79	return PCAP_FD(pri->pcap);
1da177e4 LT	80	}
	81
	82	static void pcap_remove(void *data)
	83	{
	84	struct pcap_data *pri = data;
	85
	86	if(pri->compiled != NULL)
	87	pcap_freecode(pri->compiled);
	88
7d98230a JD	89	if(pri->pcap != NULL)
7d98230a JD	90	pcap_close(pri->pcap);
1da177e4 LT	91	}
	92
	93	struct pcap_handler_data {
	94	char *buffer;
	95	int len;
	96	};
	97
	98	static void handler(u_char data, const struct pcap_pkthdr header,
	99	const u_char *packet)
	100	{
	101	int len;
	102
	103	struct pcap_handler_data hdata = (struct pcap_handler_data ) data;
	104
	105	len = hdata->len < header->caplen ? hdata->len : header->caplen;
	106	memcpy(hdata->buffer, packet, len);
	107	hdata->len = len;
	108	}
	109
	110	int pcap_user_read(int fd, void buffer, int len, struct pcap_data pri)
	111	{
	112	struct pcap_handler_data hdata = ((struct pcap_handler_data)
	113	{ .buffer = buffer,
	114	.len = len });
	115	int n;
	116
	117	n = pcap_dispatch(pri->pcap, 1, handler, (u_char *) &hdata);
	118	if(n < 0){
7d98230a JD	119	printk(UM_KERN_ERR "pcap_dispatch failed - %s\n",
7d98230a JD	120	pcap_geterr(pri->pcap));
56bd194b	121	return -EIO;
1da177e4 LT	122	}
1da177e4 LT	123	else if(n == 0)
56bd194b JD	124	return 0;
56bd194b JD	125	return hdata.len;
1da177e4 LT	126	}
1da177e4 LT	127
5e7672ec	128	const struct net_user_info pcap_user_info = {
1da177e4 LT	129	.init = pcap_user_init,
	130	.open = pcap_open,
	131	.close = NULL,
	132	.remove = pcap_remove,
	133	.set_mtu = NULL,
	134	.add_address = NULL,
	135	.delete_address = NULL,
	136	.max_packet = MAX_PACKET - ETH_HEADER_OTHER
	137	};