1dbddf429SAlex Dewar // SPDX-License-Identifier: GPL-2.0
21da177e4SLinus Torvalds /*
3cd1ae0e4SJeff Dike * Copyright (C) 2002 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
41da177e4SLinus Torvalds */
51da177e4SLinus Torvalds
61da177e4SLinus Torvalds #include <errno.h>
71da177e4SLinus Torvalds #include <pcap.h>
8cd1ae0e4SJeff Dike #include <string.h>
91da177e4SLinus Torvalds #include <asm/types.h>
1037185b33SAl Viro #include <net_user.h>
111da177e4SLinus Torvalds #include "pcap_user.h"
1237185b33SAl Viro #include <um_malloc.h>
131da177e4SLinus Torvalds
141da177e4SLinus Torvalds #define PCAP_FD(p) (*(int *)(p))
151da177e4SLinus Torvalds
pcap_user_init(void * data,void * dev)16f34d9d2dSJeff Dike static int pcap_user_init(void *data, void *dev)
171da177e4SLinus Torvalds {
181da177e4SLinus Torvalds struct pcap_data *pri = data;
191da177e4SLinus Torvalds pcap_t *p;
201da177e4SLinus Torvalds char errors[PCAP_ERRBUF_SIZE];
211da177e4SLinus Torvalds
22b53f35a8SJeff Dike p = pcap_open_live(pri->host_if, ETH_MAX_PACKET + ETH_HEADER_OTHER,
23b53f35a8SJeff Dike pri->promisc, 0, errors);
241da177e4SLinus Torvalds if (p == NULL) {
257d98230aSJeff Dike printk(UM_KERN_ERR "pcap_user_init : pcap_open_live failed - "
267d98230aSJeff Dike "'%s'\n", errors);
27f34d9d2dSJeff Dike return -EINVAL;
281da177e4SLinus Torvalds }
291da177e4SLinus Torvalds
301da177e4SLinus Torvalds pri->dev = dev;
311da177e4SLinus Torvalds pri->pcap = p;
32f34d9d2dSJeff Dike return 0;
331da177e4SLinus Torvalds }
341da177e4SLinus Torvalds
pcap_user_open(void * data)355e1121cdSIgnat Korchagin static int pcap_user_open(void *data)
361da177e4SLinus Torvalds {
371da177e4SLinus Torvalds struct pcap_data *pri = data;
381da177e4SLinus Torvalds __u32 netmask;
391da177e4SLinus Torvalds int err;
401da177e4SLinus Torvalds
411da177e4SLinus Torvalds if (pri->pcap == NULL)
4256bd194bSJeff Dike return -ENODEV;
431da177e4SLinus Torvalds
441da177e4SLinus Torvalds if (pri->filter != NULL) {
451da177e4SLinus Torvalds err = dev_netmask(pri->dev, &netmask);
461da177e4SLinus Torvalds if (err < 0) {
475e1121cdSIgnat Korchagin printk(UM_KERN_ERR "pcap_user_open : dev_netmask failed\n");
4856bd194bSJeff Dike return -EIO;
491da177e4SLinus Torvalds }
501da177e4SLinus Torvalds
51296cd66fSAl Viro pri->compiled = uml_kmalloc(sizeof(struct bpf_program),
52cd1ae0e4SJeff Dike UM_GFP_KERNEL);
531da177e4SLinus Torvalds if (pri->compiled == NULL) {
545e1121cdSIgnat Korchagin printk(UM_KERN_ERR "pcap_user_open : kmalloc failed\n");
5556bd194bSJeff Dike return -ENOMEM;
561da177e4SLinus Torvalds }
571da177e4SLinus Torvalds
581da177e4SLinus Torvalds err = pcap_compile(pri->pcap,
591da177e4SLinus Torvalds (struct bpf_program *) pri->compiled,
601da177e4SLinus Torvalds pri->filter, pri->optimize, netmask);
611da177e4SLinus Torvalds if (err < 0) {
625e1121cdSIgnat Korchagin printk(UM_KERN_ERR "pcap_user_open : pcap_compile failed - "
637d98230aSJeff Dike "'%s'\n", pcap_geterr(pri->pcap));
64cd1ae0e4SJeff Dike goto out;
651da177e4SLinus Torvalds }
661da177e4SLinus Torvalds
671da177e4SLinus Torvalds err = pcap_setfilter(pri->pcap, pri->compiled);
681da177e4SLinus Torvalds if (err < 0) {
695e1121cdSIgnat Korchagin printk(UM_KERN_ERR "pcap_user_open : pcap_setfilter "
707d98230aSJeff Dike "failed - '%s'\n", pcap_geterr(pri->pcap));
71cd1ae0e4SJeff Dike goto out;
721da177e4SLinus Torvalds }
731da177e4SLinus Torvalds }
741da177e4SLinus Torvalds
7556bd194bSJeff Dike return PCAP_FD(pri->pcap);
76cd1ae0e4SJeff Dike
77cd1ae0e4SJeff Dike out:
78cd1ae0e4SJeff Dike kfree(pri->compiled);
79cd1ae0e4SJeff Dike return -EIO;
801da177e4SLinus Torvalds }
811da177e4SLinus Torvalds
pcap_remove(void * data)821da177e4SLinus Torvalds static void pcap_remove(void *data)
831da177e4SLinus Torvalds {
841da177e4SLinus Torvalds struct pcap_data *pri = data;
851da177e4SLinus Torvalds
861da177e4SLinus Torvalds if (pri->compiled != NULL)
871da177e4SLinus Torvalds pcap_freecode(pri->compiled);
881da177e4SLinus Torvalds
897d98230aSJeff Dike if (pri->pcap != NULL)
901da177e4SLinus Torvalds pcap_close(pri->pcap);
911da177e4SLinus Torvalds }
921da177e4SLinus Torvalds
931da177e4SLinus Torvalds struct pcap_handler_data {
941da177e4SLinus Torvalds char *buffer;
951da177e4SLinus Torvalds int len;
961da177e4SLinus Torvalds };
971da177e4SLinus Torvalds
handler(u_char * data,const struct pcap_pkthdr * header,const u_char * packet)981da177e4SLinus Torvalds static void handler(u_char *data, const struct pcap_pkthdr *header,
991da177e4SLinus Torvalds const u_char *packet)
1001da177e4SLinus Torvalds {
1011da177e4SLinus Torvalds int len;
1021da177e4SLinus Torvalds
1031da177e4SLinus Torvalds struct pcap_handler_data *hdata = (struct pcap_handler_data *) data;
1041da177e4SLinus Torvalds
1051da177e4SLinus Torvalds len = hdata->len < header->caplen ? hdata->len : header->caplen;
1061da177e4SLinus Torvalds memcpy(hdata->buffer, packet, len);
1071da177e4SLinus Torvalds hdata->len = len;
1081da177e4SLinus Torvalds }
1091da177e4SLinus Torvalds
pcap_user_read(int fd,void * buffer,int len,struct pcap_data * pri)1101da177e4SLinus Torvalds int pcap_user_read(int fd, void *buffer, int len, struct pcap_data *pri)
1111da177e4SLinus Torvalds {
1121da177e4SLinus Torvalds struct pcap_handler_data hdata = ((struct pcap_handler_data)
1131da177e4SLinus Torvalds { .buffer = buffer,
1141da177e4SLinus Torvalds .len = len });
1151da177e4SLinus Torvalds int n;
1161da177e4SLinus Torvalds
1171da177e4SLinus Torvalds n = pcap_dispatch(pri->pcap, 1, handler, (u_char *) &hdata);
1181da177e4SLinus Torvalds if (n < 0) {
1197d98230aSJeff Dike printk(UM_KERN_ERR "pcap_dispatch failed - %s\n",
1207d98230aSJeff Dike pcap_geterr(pri->pcap));
12156bd194bSJeff Dike return -EIO;
1221da177e4SLinus Torvalds }
1231da177e4SLinus Torvalds else if (n == 0)
12456bd194bSJeff Dike return 0;
12556bd194bSJeff Dike return hdata.len;
1261da177e4SLinus Torvalds }
1271da177e4SLinus Torvalds
1285e7672ecSJeff Dike const struct net_user_info pcap_user_info = {
1291da177e4SLinus Torvalds .init = pcap_user_init,
1305e1121cdSIgnat Korchagin .open = pcap_user_open,
1311da177e4SLinus Torvalds .close = NULL,
1321da177e4SLinus Torvalds .remove = pcap_remove,
1331da177e4SLinus Torvalds .add_address = NULL,
1341da177e4SLinus Torvalds .delete_address = NULL,
135b53f35a8SJeff Dike .mtu = ETH_MAX_PACKET,
136b53f35a8SJeff Dike .max_packet = ETH_MAX_PACKET + ETH_HEADER_OTHER,
1371da177e4SLinus Torvalds };
138