1511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall/* 2511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * Copyright (c) 2009 Felix Obenhuber 3511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * All rights reserved. 4511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * 5511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * Redistribution and use in source and binary forms, with or without 6511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * modification, are permitted provided that the following conditions 7511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * are met: 8511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * 9511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * 1. Redistributions of source code must retain the above copyright 10511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * notice, this list of conditions and the following disclaimer. 11511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * 2. Redistributions in binary form must reproduce the above copyright 12511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * notice, this list of conditions and the following disclaimer in the 13511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * documentation and/or other materials provided with the distribution. 14511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * 3. The name of the author may not be used to endorse or promote 15511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * products derived from this software without specific prior written 16511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * permission. 17511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * 18511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 19511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 20511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 21511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 22511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 23511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 24511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 25511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 26511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 27511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 28511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 29511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * 30511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * SocketCan sniffing API implementation for Linux platform 31511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * By Felix Obenhuber <felix@obenhuber.de> 32511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * 33511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall */ 34511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 35511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#ifdef HAVE_CONFIG_H 36511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include "config.h" 37511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#endif 38511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 39511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include "pcap-int.h" 40511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include "pcap-can-linux.h" 41511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 42511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#ifdef NEED_STRERROR_H 43511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include "strerror.h" 44511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#endif 45511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 46511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include <errno.h> 47511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include <stdlib.h> 48511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include <unistd.h> 49511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include <fcntl.h> 50511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include <string.h> 51511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include <sys/ioctl.h> 52511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include <sys/socket.h> 53511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include <net/if.h> 54511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include <arpa/inet.h> 55511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 56511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include <linux/can.h> 57511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#include <linux/can/raw.h> 58511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 59511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall/* not yet defined anywhere */ 60511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#ifndef PF_CAN 61511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#define PF_CAN 29 62511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#endif 63511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#ifndef AF_CAN 64511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#define AF_CAN PF_CAN 65511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall#endif 66511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 67511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall/* forward declaration */ 68511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int can_activate(pcap_t *); 69511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int can_read_linux(pcap_t *, int , pcap_handler , u_char *); 70511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int can_inject_linux(pcap_t *, const void *, size_t); 71511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int can_setfilter_linux(pcap_t *, struct bpf_program *); 72511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int can_setdirection_linux(pcap_t *, pcap_direction_t); 73511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int can_stats_linux(pcap_t *, struct pcap_stat *); 74511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 75511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall/* 76511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * Private data for capturing on Linux CANbus devices. 77511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall */ 78511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstruct pcap_can { 79511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall int ifindex; /* interface index of device we're bound to */ 80511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall}; 81511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 82511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallint 83511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallcan_findalldevs(pcap_if_t **devlistp, char *errbuf) 84511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall{ 85511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* 86511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * There are no platform-specific devices since each device 87511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * exists as a regular network interface. 88511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * 89511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall * XXX - true? 90511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall */ 91511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return 0; 92511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall} 93511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 94511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallpcap_t * 95511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallcan_create(const char *device, char *ebuf, int *is_ours) 96511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall{ 97511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall const char *cp; 98511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall char *cpend; 99511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall long devnum; 100511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall pcap_t* p; 101511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 102511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Does this look like a CANbus device? */ 103511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall cp = strrchr(device, '/'); 104511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (cp == NULL) 105511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall cp = device; 106511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Does it begin with "can" or "vcan"? */ 107511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (strncmp(cp, "can", 3) == 0) { 108511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Begins with "can" */ 109511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall cp += 3; /* skip past "can" */ 110511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } else if (strncmp(cp, "vcan", 4) == 0) { 111511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Begins with "vcan" */ 112511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall cp += 4; 113511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } else { 114511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Nope, doesn't begin with "can" or "vcan" */ 115511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall *is_ours = 0; 116511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return NULL; 117511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 118511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Yes - is "can" or "vcan" followed by a number from 0? */ 119511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall devnum = strtol(cp, &cpend, 10); 120511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (cpend == cp || *cpend != '\0') { 121511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Not followed by a number. */ 122511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall *is_ours = 0; 123511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return NULL; 124511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 125511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (devnum < 0) { 126511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Followed by a non-valid number. */ 127511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall *is_ours = 0; 128511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return NULL; 129511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 130511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 131511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* OK, it's probably ours. */ 132511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall *is_ours = 1; 133511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 134511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall p = pcap_create_common(device, ebuf, sizeof (struct pcap_can)); 135511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (p == NULL) 136511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return (NULL); 137511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 138511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall p->activate_op = can_activate; 139511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return (p); 140511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall} 141511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 142511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 143511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int 144511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallcan_activate(pcap_t* handle) 145511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall{ 146511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall struct pcap_can *handlep = handle->priv; 147511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall struct sockaddr_can addr; 148511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall struct ifreq ifr; 149511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 150511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Initialize some components of the pcap structure. */ 151511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->bufsize = 24; 152511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->offset = 8; 153511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->linktype = DLT_CAN_SOCKETCAN; 154511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->read_op = can_read_linux; 155511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->inject_op = can_inject_linux; 156511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->setfilter_op = can_setfilter_linux; 157511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->setdirection_op = can_setdirection_linux; 158511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->set_datalink_op = NULL; 159511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->getnonblock_op = pcap_getnonblock_fd; 160511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->setnonblock_op = pcap_setnonblock_fd; 161511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->stats_op = can_stats_linux; 162511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 163511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Create socket */ 164511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->fd = socket(PF_CAN, SOCK_RAW, CAN_RAW); 165511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (handle->fd < 0) 166511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall { 167511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall snprintf(handle->errbuf, PCAP_ERRBUF_SIZE, "Can't create raw socket %d:%s", 168511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall errno, strerror(errno)); 169511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return PCAP_ERROR; 170511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 171511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 172511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* get interface index */ 173511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall memset(&ifr, 0, sizeof(ifr)); 174511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall strncpy(ifr.ifr_name, handle->opt.source, sizeof(ifr.ifr_name)); 175511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (ioctl(handle->fd, SIOCGIFINDEX, &ifr) < 0) 176511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall { 177511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall snprintf(handle->errbuf, PCAP_ERRBUF_SIZE, 178511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall "Unable to get interface index: %s", 179511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall pcap_strerror(errno)); 180511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall pcap_cleanup_live_common(handle); 181511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return PCAP_ERROR; 182511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 183511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handlep->ifindex = ifr.ifr_ifindex; 184511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 185511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* allocate butter */ 186511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->buffer = malloc(handle->bufsize); 187511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (!handle->buffer) 188511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall { 189511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall snprintf(handle->errbuf, PCAP_ERRBUF_SIZE, "Can't allocate dump buffer: %s", 190511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall pcap_strerror(errno)); 191511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall pcap_cleanup_live_common(handle); 192511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return PCAP_ERROR; 193511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 194511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 195511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Bind to the socket */ 196511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall addr.can_family = AF_CAN; 197511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall addr.can_ifindex = handlep->ifindex; 198511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if( bind( handle->fd, (struct sockaddr*)&addr, sizeof(addr) ) < 0 ) 199511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall { 200511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall snprintf(handle->errbuf, PCAP_ERRBUF_SIZE, "Can't attach to device %d %d:%s", 201511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handlep->ifindex, errno, strerror(errno)); 202511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall pcap_cleanup_live_common(handle); 203511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return PCAP_ERROR; 204511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 205511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 206511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (handle->opt.rfmon) 207511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall { 208511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* Monitor mode doesn't apply to CAN devices. */ 209511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall pcap_cleanup_live_common(handle); 210511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return PCAP_ERROR_RFMON_NOTSUP; 211511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 212511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 213511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->selectable_fd = handle->fd; 214511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return 0; 215511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 216511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall} 217511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 218511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 219511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int 220511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallcan_read_linux(pcap_t *handle, int max_packets, pcap_handler callback, u_char *user) 221511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall{ 222511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall struct msghdr msg; 223511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall struct pcap_pkthdr pkth; 224511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall struct iovec iv; 225511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall struct can_frame* cf; 226511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 227511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall iv.iov_base = &handle->buffer[handle->offset]; 228511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall iv.iov_len = handle->snapshot; 229511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 230511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall memset(&msg, 0, sizeof(msg)); 231511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall msg.msg_iov = &iv; 232511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall msg.msg_iovlen = 1; 233511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall msg.msg_control = handle->buffer; 234511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall msg.msg_controllen = handle->offset; 235511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 236511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall do 237511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall { 238511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall pkth.caplen = recvmsg(handle->fd, &msg, 0); 239511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (handle->break_loop) 240511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall { 241511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall handle->break_loop = 0; 242511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return -2; 243511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 244511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } while ((pkth.caplen == -1) && (errno == EINTR)); 245511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 246511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (pkth.caplen < 0) 247511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall { 248511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall snprintf(handle->errbuf, PCAP_ERRBUF_SIZE, "Can't receive packet %d:%s", 249511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall errno, strerror(errno)); 250511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return -1; 251511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 252511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 253511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* adjust capture len according to frame len */ 254511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall cf = (struct can_frame*)&handle->buffer[8]; 255511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall pkth.caplen -= 8 - cf->can_dlc; 256511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall pkth.len = pkth.caplen; 257511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 258511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall cf->can_id = htonl( cf->can_id ); 259511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 260511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if( -1 == gettimeofday(&pkth.ts, NULL) ) 261511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall { 262511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall snprintf(handle->errbuf, PCAP_ERRBUF_SIZE, "Can't get time of day %d:%s", 263511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall errno, strerror(errno)); 264511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return -1; 265511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 266511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 267511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall callback(user, &pkth, &handle->buffer[8]); 268511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 269511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return 1; 270511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall} 271511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 272511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 273511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int 274511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallcan_inject_linux(pcap_t *handle, const void *buf, size_t size) 275511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall{ 276511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* not yet implemented */ 277511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall snprintf(handle->errbuf, PCAP_ERRBUF_SIZE, "inject not supported on " 278511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall "can devices"); 279511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return (-1); 280511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall} 281511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 282511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 283511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int 284511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallcan_stats_linux(pcap_t *handle, struct pcap_stat *stats) 285511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall{ 286511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* not yet implemented */ 287511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall stats->ps_recv = 0; /* number of packets received */ 288511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall stats->ps_drop = 0; /* number of packets dropped */ 289511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall stats->ps_ifdrop = 0; /* drops by interface -- only supported on some platforms */ 290511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return 0; 291511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall} 292511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 293511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 294511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int 295511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallcan_setfilter_linux(pcap_t *p, struct bpf_program *fp) 296511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall{ 297511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* not yet implemented */ 298511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return 0; 299511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall} 300511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 301511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 302511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallstatic int 303511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrallcan_setdirection_linux(pcap_t *p, pcap_direction_t d) 304511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall{ 305511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall /* no support for PCAP_D_OUT */ 306511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall if (d == PCAP_D_OUT) 307511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall { 308511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall snprintf(p->errbuf, sizeof(p->errbuf), 309511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall "Setting direction to PCAP_D_OUT is not supported on can"); 310511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return -1; 311511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall } 312511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 313511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall p->direction = d; 314511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 315511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall return 0; 316511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall} 317511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 318511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall 319511eca30a483e912c274e1d8ba3a0f8f081e2227JP Abgrall/* eof */ 320