2 * $Id: tst-raw-filter.c,v 2.0 2006/04/13 10:37:21 ethuerm Exp $
8 * Copyright (c) 2002-2005 Volkswagen Group Electronic Research
11 * Redistribution and use in source and binary forms, with or without
12 * modification, are permitted provided that the following conditions
14 * 1. Redistributions of source code must retain the above copyright
15 * notice, this list of conditions, the following disclaimer and
16 * the referenced file 'COPYING'.
17 * 2. Redistributions in binary form must reproduce the above copyright
18 * notice, this list of conditions and the following disclaimer in the
19 * documentation and/or other materials provided with the distribution.
20 * 3. Neither the name of Volkswagen nor the names of its contributors
21 * may be used to endorse or promote products derived from this software
22 * without specific prior written permission.
24 * Alternatively, provided that this notice is retained in full, this
25 * software may be distributed under the terms of the GNU General
26 * Public License ("GPL") version 2 as distributed in the 'COPYING'
27 * file from the main directory of the linux kernel source.
29 * The provided data structures and external interfaces from this code
30 * are not restricted to be used by modules with a GPL compatible license.
32 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
33 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
34 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
35 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
36 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
37 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
38 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
39 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
40 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
41 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
42 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH
45 * Send feedback to <llcf@volkswagen.de>
54 #include <sys/types.h>
55 #include <sys/socket.h>
56 #include <sys/ioctl.h>
63 int main(int argc, char **argv)
66 struct sockaddr_can addr;
67 struct can_filter rfilter[MAXFILTERS];
68 struct can_frame frame;
76 while ((opt = getopt(argc, argv, "i:f:")) != -1) {
82 if (nfilters >= MAXFILTERS) {
83 fputs("too many filters\n", stderr);
86 rfilter[nfilters].can_id = strtol(strtok(optarg, ":"), NULL, 0);
87 rfilter[nfilters].can_mask = strtol(strtok(NULL, ":"), NULL, 0);
91 fprintf(stderr, "Unknown option %c\n", opt);
97 if ((s = socket(PF_CAN, SOCK_RAW, CAN_RAW)) < 0) {
103 setsockopt(s, SOL_CAN_RAW, CAN_RAW_FILTER, &rfilter,
104 sizeof(*rfilter) * nfilters);
106 if (strcmp(ifname, "any") == 0)
109 strcpy(ifr.ifr_name, ifname);
110 ioctl(s, SIOCGIFINDEX, &ifr);
111 ifindex = ifr.ifr_ifindex;
114 addr.can_family = AF_CAN;
115 addr.can_ifindex = ifindex;
117 if (bind(s, (struct sockaddr *)&addr, sizeof(addr)) < 0) {
123 socklen_t len = sizeof(addr);
124 nbytes = recvfrom(s, &frame, sizeof(struct can_frame),
125 0, (struct sockaddr*)&addr, &len);
129 } else if (nbytes < sizeof(struct can_frame)) {
130 fprintf(stderr, "read: incomplete CAN frame from iface %d\n",
134 ifr.ifr_ifindex = addr.can_ifindex;
135 ioctl(s, SIOCGIFNAME, &ifr);
136 printf(" %-5s ", ifr.ifr_name);
137 if (frame.can_id & CAN_EFF_FLAG)
138 printf("%8X ", frame.can_id & CAN_EFF_MASK);
140 printf("%3X ", frame.can_id & CAN_SFF_MASK);
142 printf("[%d] ", frame.can_dlc);
144 for (i = 0; i < frame.can_dlc; i++) {
145 printf("%02X ", frame.data[i]);
147 if (frame.can_id & CAN_RTR_FLAG)
148 printf("remote request");