/* * Copyright (c) 2001-2003 Swedish Institute of Computer Science. * All rights reserved. * * Redistribution and use in source and binary forms, with or without modification, * are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT * SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY * OF SUCH DAMAGE. * * This file is part of the lwIP TCP/IP stack. * * Author: Adam Dunkels * */ #ifndef linux /* Apparently, this doesn't work under Linux. */ #include "lwip/debug.h" #include #include #include #include #include #include #include #include #include #include #include #include #include "netif/etharp.h" #include "lwip/stats.h" #include "lwip/def.h" #include "lwip/mem.h" #include "lwip/pbuf.h" #include "lwip/sys.h" #include "lwip/ip.h" struct pcapif { pcap_t *pd; sys_sem_t sem; u8_t pkt[2048]; u32_t len; u32_t lasttime; struct pbuf *p; struct eth_addr *ethaddr; }; static char errbuf[PCAP_ERRBUF_SIZE]; /*-----------------------------------------------------------------------------------*/ static err_t pcapif_output(struct netif *netif, struct pbuf *p, ip_addr_t *ipaddr) { return ERR_OK; } /*-----------------------------------------------------------------------------------*/ static void timeout(void *arg) { struct netif *netif; struct pcapif *pcapif; struct pbuf *p; struct eth_hdr *ethhdr; netif = (struct netif *)arg; pcapif = netif->state; ethhdr = (struct eth_hdr *)pcapif->pkt; if (lwip_htons(ethhdr->type) != ETHTYPE_IP || ip_lookup(pcapif->pkt + 14, netif)) { /* We allocate a pbuf chain of pbufs from the pool. */ p = pbuf_alloc(PBUF_LINK, pcapif->len, PBUF_POOL); if (p != NULL) { pbuf_take(p, pcapif->pkt, pcapif->len); ethhdr = p->payload; switch (lwip_htons(ethhdr->type)) { /* IP or ARP packet? */ case ETHTYPE_IP: case ETHTYPE_ARP: #if PPPOE_SUPPORT /* PPPoE packet? */ case ETHTYPE_PPPOEDISC: case ETHTYPE_PPPOE: #endif /* PPPOE_SUPPORT */ /* full packet send to tcpip_thread to process */ if (netif->input(p, netif) != ERR_OK) { LWIP_DEBUGF(NETIF_DEBUG, ("ethernetif_input: IP input error\n")); pbuf_free(p); p = NULL; } break; default: pbuf_free(p); break; } } } else { printf("ip_lookup dropped\n"); } sys_sem_signal(&pcapif->sem); } /*-----------------------------------------------------------------------------------*/ static void callback(u_char *arg, const struct pcap_pkthdr *hdr, const u_char *pkt) { struct netif *netif; struct pcapif *pcapif; u32_t time, lasttime; netif = (struct netif *)arg; pcapif = netif->state; pcapif->len = hdr->len; bcopy(pkt, pcapif->pkt, hdr->len); time = hdr->ts.tv_sec * 1000 + hdr->ts.tv_usec / 1000; lasttime = pcapif->lasttime; pcapif->lasttime = time; if (lasttime == 0) { sys_timeout(1000, timeout, netif); } else { sys_timeout(time - lasttime, timeout, netif); } } /*-----------------------------------------------------------------------------------*/ static void pcapif_thread(void *arg) { struct netif *netif; struct pcapif *pcapif; netif = arg; pcapif = netif->state; while (1) { pcap_loop(pcapif->pd, 1, callback, (u_char *)netif); sys_sem_wait(&pcapif->sem); if (pcapif->p != NULL) { netif->input(pcapif->p, netif); } } } /*-----------------------------------------------------------------------------------*/ err_t pcapif_init(struct netif *netif) { struct pcapif *p; p = malloc(sizeof(struct pcapif)); if (p == NULL) return ERR_MEM; netif->state = p; netif->name[0] = 'p'; netif->name[1] = 'c'; netif->output = pcapif_output; p->pd = pcap_open_offline("pcapdump", errbuf); if (p->pd == NULL) { printf("pcapif_init: failed %s\n", errbuf); return ERR_IF; } if(sys_sem_new(&p->sem, 0) != ERR_OK) { LWIP_ASSERT("Failed to create semaphore", 0); } p->p = NULL; p->lasttime = 0; sys_thread_new("pcapif_thread", pcapif_thread, netif, DEFAULT_THREAD_STACKSIZE, DEFAULT_THREAD_PRIO); return ERR_OK; } /*-----------------------------------------------------------------------------------*/ #endif /* linux */