1c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp/* 2c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * raw.c - Raw sockets for protocol family CAN 3c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * 4c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * Copyright (c) 2002-2007 Volkswagen Group Electronic Research 5c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * All rights reserved. 6c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * 7c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * Redistribution and use in source and binary forms, with or without 8c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * modification, are permitted provided that the following conditions 9c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * are met: 10c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * 1. Redistributions of source code must retain the above copyright 11c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * notice, this list of conditions and the following disclaimer. 12c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * 2. Redistributions in binary form must reproduce the above copyright 13c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * notice, this list of conditions and the following disclaimer in the 14c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * documentation and/or other materials provided with the distribution. 15c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * 3. Neither the name of Volkswagen nor the names of its contributors 16c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * may be used to endorse or promote products derived from this software 17c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * without specific prior written permission. 18c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * 19c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * Alternatively, provided that this notice is retained in full, this 20c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * software may be distributed under the terms of the GNU General 21c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * Public License ("GPL") version 2, in which case the provisions of the 22c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * GPL apply INSTEAD OF those given above. 23c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * 24c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * The provided data structures and external interfaces from this code 25c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * are not restricted to be used by modules with a GPL compatible license. 26c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * 27c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 28c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 29c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 30c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 31c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 32c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 33c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 34c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 35c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 36c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 37c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH 38c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * DAMAGE. 39c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * 40c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp */ 41c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 42c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <linux/module.h> 43c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <linux/init.h> 44c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <linux/uio.h> 45c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <linux/net.h> 465a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 47c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <linux/netdevice.h> 48c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <linux/socket.h> 49c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <linux/if_arp.h> 50c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <linux/skbuff.h> 51c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <linux/can.h> 52c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <linux/can/core.h> 53156c2bb9f88065c8da78814f98fde665a5cbb527Oliver Hartkopp#include <linux/can/skb.h> 54c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <linux/can/raw.h> 55c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <net/sock.h> 56c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#include <net/net_namespace.h> 57c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 58c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#define CAN_RAW_VERSION CAN_VERSION 596299b669b1340b9f7de2bc2bd565921a1494e7f7Andi Kleenstatic __initconst const char banner[] = 60c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp KERN_INFO "can: raw protocol (rev " CAN_RAW_VERSION ")\n"; 61c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 62c18ce101f2e47d97ace125033e2896895a6db3ddOliver HartkoppMODULE_DESCRIPTION("PF_CAN raw protocol"); 63c18ce101f2e47d97ace125033e2896895a6db3ddOliver HartkoppMODULE_LICENSE("Dual BSD/GPL"); 64c18ce101f2e47d97ace125033e2896895a6db3ddOliver HartkoppMODULE_AUTHOR("Urs Thuermann <urs.thuermann@volkswagen.de>"); 65b13bb2e9933b9dfa25c81d959d847c843481111eLothar WaßmannMODULE_ALIAS("can-proto-1"); 66c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 67c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp#define MASK_ALL 0 68c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 69c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp/* 70c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * A raw socket has a list of can_filters attached to it, each receiving 71c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * the CAN frames matching that filter. If the filter list is empty, 72c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * no CAN frames will be received by the socket. The default after 73c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * opening the socket, is to have one filter which receives all frames. 74c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * The filter list is allocated dynamically with the exception of the 75c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * list containing only one item. This common case is optimized by 76c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * storing the single filter in dfilter, to avoid using dynamic memory. 77c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp */ 78c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 79c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstruct raw_sock { 80c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock sk; 81c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int bound; 82c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int ifindex; 83c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct notifier_block notifier; 84c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int loopback; 85c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int recv_own_msgs; 86e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp int fd_frames; 87c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int count; /* number of active filters */ 88c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct can_filter dfilter; /* default/single filter */ 89c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct can_filter *filter; /* pointer to filter(s) */ 90c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp can_err_mask_t err_mask; 91c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp}; 92c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 931e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp/* 941e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp * Return pointer to store the extra msg flags for raw_recvmsg(). 951e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp * We use the space of one unsigned int beyond the 'struct sockaddr_can' 961e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp * in skb->cb. 971e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp */ 981e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkoppstatic inline unsigned int *raw_flags(struct sk_buff *skb) 991e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp{ 1001e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp BUILD_BUG_ON(sizeof(skb->cb) <= (sizeof(struct sockaddr_can) + 1011e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp sizeof(unsigned int))); 1021e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp 1031e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp /* return pointer after struct sockaddr_can */ 1041e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp return (unsigned int *)(&((struct sockaddr_can *)skb->cb)[1]); 1051e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp} 1061e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp 107c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic inline struct raw_sock *raw_sk(const struct sock *sk) 108c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 109c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return (struct raw_sock *)sk; 110c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 111c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 1121e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkoppstatic void raw_rcv(struct sk_buff *oskb, void *data) 113c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 114c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock *sk = (struct sock *)data; 115c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 116c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sockaddr_can *addr; 1171e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp struct sk_buff *skb; 1181e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp unsigned int *pflags; 119c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 1201fa17d4ba43d7e5aab5e90777b07da06524f6748Oliver Hartkopp /* check the received tx sock reference */ 1211e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp if (!ro->recv_own_msgs && oskb->sk == sk) 1221fa17d4ba43d7e5aab5e90777b07da06524f6748Oliver Hartkopp return; 1231fa17d4ba43d7e5aab5e90777b07da06524f6748Oliver Hartkopp 124821047c4055cca833c4674f172a9d73003563eb6Oliver Hartkopp /* do not pass non-CAN2.0 frames to a legacy socket */ 125821047c4055cca833c4674f172a9d73003563eb6Oliver Hartkopp if (!ro->fd_frames && oskb->len != CAN_MTU) 126821047c4055cca833c4674f172a9d73003563eb6Oliver Hartkopp return; 127e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp 1281fa17d4ba43d7e5aab5e90777b07da06524f6748Oliver Hartkopp /* clone the given skb to be able to enqueue it into the rcv queue */ 1291e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp skb = skb_clone(oskb, GFP_ATOMIC); 1301fa17d4ba43d7e5aab5e90777b07da06524f6748Oliver Hartkopp if (!skb) 1311fa17d4ba43d7e5aab5e90777b07da06524f6748Oliver Hartkopp return; 132c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 133c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* 134c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * Put the datagram to the queue so that raw_recvmsg() can 135c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * get it from there. We need to pass the interface index to 136c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * raw_recvmsg(). We pass a whole struct sockaddr_can in skb->cb 137c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp * containing the interface index. 138c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp */ 139c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 140c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp BUILD_BUG_ON(sizeof(skb->cb) < sizeof(struct sockaddr_can)); 141c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp addr = (struct sockaddr_can *)skb->cb; 142c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp memset(addr, 0, sizeof(*addr)); 143c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp addr->can_family = AF_CAN; 144c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp addr->can_ifindex = skb->dev->ifindex; 145c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 1461e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp /* add CAN specific message flags for raw_recvmsg() */ 1471e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp pflags = raw_flags(skb); 1481e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp *pflags = 0; 1491e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp if (oskb->sk) 1501e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp *pflags |= MSG_DONTROUTE; 1511e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp if (oskb->sk == sk) 1521e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp *pflags |= MSG_CONFIRM; 1531e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp 154a219994bf5cca1208fb741b20ea9eb78e1711f81Urs Thuermann if (sock_queue_rcv_skb(sk, skb) < 0) 155c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp kfree_skb(skb); 156c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 157c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 158c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_enable_filters(struct net_device *dev, struct sock *sk, 159a219994bf5cca1208fb741b20ea9eb78e1711f81Urs Thuermann struct can_filter *filter, int count) 160c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 161c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int err = 0; 162c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int i; 163c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 164c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp for (i = 0; i < count; i++) { 165c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = can_rx_register(dev, filter[i].can_id, 166c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp filter[i].can_mask, 167c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_rcv, sk, "raw"); 168c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (err) { 169c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* clean up successfully registered filters */ 170c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp while (--i >= 0) 171c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp can_rx_unregister(dev, filter[i].can_id, 172c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp filter[i].can_mask, 173c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_rcv, sk); 174c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp break; 175c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 176c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 177c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 178c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return err; 179c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 180c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 181c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_enable_errfilter(struct net_device *dev, struct sock *sk, 182c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp can_err_mask_t err_mask) 183c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 184c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int err = 0; 185c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 186c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (err_mask) 187c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = can_rx_register(dev, 0, err_mask | CAN_ERR_FLAG, 188c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_rcv, sk, "raw"); 189c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 190c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return err; 191c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 192c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 193c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic void raw_disable_filters(struct net_device *dev, struct sock *sk, 194a219994bf5cca1208fb741b20ea9eb78e1711f81Urs Thuermann struct can_filter *filter, int count) 195c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 196c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int i; 197c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 198c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp for (i = 0; i < count; i++) 199c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp can_rx_unregister(dev, filter[i].can_id, filter[i].can_mask, 200c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_rcv, sk); 201c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 202c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 203c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic inline void raw_disable_errfilter(struct net_device *dev, 204c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock *sk, 205c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp can_err_mask_t err_mask) 206c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 207c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 208c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (err_mask) 209c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp can_rx_unregister(dev, 0, err_mask | CAN_ERR_FLAG, 210c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_rcv, sk); 211c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 212c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 213c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic inline void raw_disable_allfilters(struct net_device *dev, 214c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock *sk) 215c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 216c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 217c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 218c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_disable_filters(dev, sk, ro->filter, ro->count); 219c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_disable_errfilter(dev, sk, ro->err_mask); 220c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 221c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 222c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_enable_allfilters(struct net_device *dev, struct sock *sk) 223c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 224c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 225c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int err; 226c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 227c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = raw_enable_filters(dev, sk, ro->filter, ro->count); 228c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (!err) { 229c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = raw_enable_errfilter(dev, sk, ro->err_mask); 230c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (err) 231c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_disable_filters(dev, sk, ro->filter, ro->count); 232c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 233c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 234c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return err; 235c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 236c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 237c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_notifier(struct notifier_block *nb, 238351638e7deeed2ec8ce451b53d33921b3da68f83Jiri Pirko unsigned long msg, void *ptr) 239c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 240351638e7deeed2ec8ce451b53d33921b3da68f83Jiri Pirko struct net_device *dev = netdev_notifier_info_to_dev(ptr); 241c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct raw_sock *ro = container_of(nb, struct raw_sock, notifier); 242c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock *sk = &ro->sk; 243c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 244721499e8931c5732202481ae24f2dfbf9910f129YOSHIFUJI Hideaki if (!net_eq(dev_net(dev), &init_net)) 245c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return NOTIFY_DONE; 246c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 247c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (dev->type != ARPHRD_CAN) 248c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return NOTIFY_DONE; 249c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 250c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->ifindex != dev->ifindex) 251c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return NOTIFY_DONE; 252c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 253c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp switch (msg) { 254c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 255c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp case NETDEV_UNREGISTER: 256c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp lock_sock(sk); 257c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* remove current filters & unregister */ 258c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->bound) 259c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_disable_allfilters(dev, sk); 260c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 261c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->count > 1) 262c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp kfree(ro->filter); 263c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 264c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->ifindex = 0; 265c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->bound = 0; 266c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->count = 0; 267c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp release_sock(sk); 268c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 269c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp sk->sk_err = ENODEV; 270c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (!sock_flag(sk, SOCK_DEAD)) 271c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp sk->sk_error_report(sk); 272c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp break; 273c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 274c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp case NETDEV_DOWN: 275c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp sk->sk_err = ENETDOWN; 276c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (!sock_flag(sk, SOCK_DEAD)) 277c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp sk->sk_error_report(sk); 278c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp break; 279c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 280c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 281c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return NOTIFY_DONE; 282c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 283c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 284c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_init(struct sock *sk) 285c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 286c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 287c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 288c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->bound = 0; 289c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->ifindex = 0; 290c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 291c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* set default filter to single entry dfilter */ 292c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->dfilter.can_id = 0; 293c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->dfilter.can_mask = MASK_ALL; 294c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->filter = &ro->dfilter; 295c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->count = 1; 296c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 297c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* set default loopback behaviour */ 298c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->loopback = 1; 299c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->recv_own_msgs = 0; 300e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp ro->fd_frames = 0; 301c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 302c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* set notifier */ 303c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->notifier.notifier_call = raw_notifier; 304c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 305c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp register_netdevice_notifier(&ro->notifier); 306c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 307c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return 0; 308c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 309c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 310c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_release(struct socket *sock) 311c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 312c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock *sk = sock->sk; 31310022a6c66e199d8f61d9044543f38785713cbbdOliver Hartkopp struct raw_sock *ro; 31410022a6c66e199d8f61d9044543f38785713cbbdOliver Hartkopp 31510022a6c66e199d8f61d9044543f38785713cbbdOliver Hartkopp if (!sk) 31610022a6c66e199d8f61d9044543f38785713cbbdOliver Hartkopp return 0; 31710022a6c66e199d8f61d9044543f38785713cbbdOliver Hartkopp 31810022a6c66e199d8f61d9044543f38785713cbbdOliver Hartkopp ro = raw_sk(sk); 319c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 320c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp unregister_netdevice_notifier(&ro->notifier); 321c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 322c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp lock_sock(sk); 323c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 324c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* remove current filters & unregister */ 325c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->bound) { 326c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->ifindex) { 327c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct net_device *dev; 328c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 329c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev = dev_get_by_index(&init_net, ro->ifindex); 330c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (dev) { 331c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_disable_allfilters(dev, sk); 332c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev_put(dev); 333c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 334c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } else 335c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_disable_allfilters(NULL, sk); 336c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 337c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 338c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->count > 1) 339c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp kfree(ro->filter); 340c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 341c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->ifindex = 0; 342c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->bound = 0; 343c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->count = 0; 344c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 345f7e5cc0c40dff92bad2894153f675c6c542ba2f0Lothar Waßmann sock_orphan(sk); 346f7e5cc0c40dff92bad2894153f675c6c542ba2f0Lothar Waßmann sock->sk = NULL; 347f7e5cc0c40dff92bad2894153f675c6c542ba2f0Lothar Waßmann 348c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp release_sock(sk); 349c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp sock_put(sk); 350c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 351c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return 0; 352c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 353c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 354c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_bind(struct socket *sock, struct sockaddr *uaddr, int len) 355c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 356c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sockaddr_can *addr = (struct sockaddr_can *)uaddr; 357c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock *sk = sock->sk; 358c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 359c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int ifindex; 360c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int err = 0; 361c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int notify_enetdown = 0; 362c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 363c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (len < sizeof(*addr)) 364c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EINVAL; 365c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 366c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp lock_sock(sk); 367c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 368c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->bound && addr->can_ifindex == ro->ifindex) 369c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp goto out; 370c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 371c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (addr->can_ifindex) { 372c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct net_device *dev; 373c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 374c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev = dev_get_by_index(&init_net, addr->can_ifindex); 375c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (!dev) { 376c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = -ENODEV; 377c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp goto out; 378c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 379c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (dev->type != ARPHRD_CAN) { 380c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev_put(dev); 381c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = -ENODEV; 382c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp goto out; 383c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 384c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (!(dev->flags & IFF_UP)) 385c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp notify_enetdown = 1; 386c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 387c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ifindex = dev->ifindex; 388c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 389c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* filters set by default/setsockopt */ 390c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = raw_enable_allfilters(dev, sk); 391c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev_put(dev); 392c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } else { 393c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ifindex = 0; 394c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 395c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* filters set by default/setsockopt */ 396c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = raw_enable_allfilters(NULL, sk); 397c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 398c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 399c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (!err) { 400c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->bound) { 401c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* unregister old filters */ 402c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->ifindex) { 403c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct net_device *dev; 404c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 405c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev = dev_get_by_index(&init_net, ro->ifindex); 406c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (dev) { 407c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_disable_allfilters(dev, sk); 408c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev_put(dev); 409c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 410c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } else 411c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_disable_allfilters(NULL, sk); 412c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 413c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->ifindex = ifindex; 414c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->bound = 1; 415c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 416c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 417c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp out: 418c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp release_sock(sk); 419c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 420c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (notify_enetdown) { 421c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp sk->sk_err = ENETDOWN; 422c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (!sock_flag(sk, SOCK_DEAD)) 423c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp sk->sk_error_report(sk); 424c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 425c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 426c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return err; 427c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 428c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 429c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_getname(struct socket *sock, struct sockaddr *uaddr, 430c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int *len, int peer) 431c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 432c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sockaddr_can *addr = (struct sockaddr_can *)uaddr; 433c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock *sk = sock->sk; 434c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 435c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 436c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (peer) 437c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EOPNOTSUPP; 438c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 439e84b90ae5eb3c112d1f208964df1d8156a538289Eric Dumazet memset(addr, 0, sizeof(*addr)); 440c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp addr->can_family = AF_CAN; 441c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp addr->can_ifindex = ro->ifindex; 442c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 443c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp *len = sizeof(*addr); 444c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 445c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return 0; 446c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 447c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 448c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_setsockopt(struct socket *sock, int level, int optname, 449b7058842c940ad2c08dd829b21e5c92ebe3b8758David S. Miller char __user *optval, unsigned int optlen) 450c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 451c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock *sk = sock->sk; 452c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 453c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct can_filter *filter = NULL; /* dyn. alloc'ed filters */ 454c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct can_filter sfilter; /* single filter */ 455c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct net_device *dev = NULL; 456c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp can_err_mask_t err_mask = 0; 457c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int count = 0; 458c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int err = 0; 459c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 460c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (level != SOL_CAN_RAW) 461c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EINVAL; 462c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 463c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp switch (optname) { 464c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 465c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp case CAN_RAW_FILTER: 466c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (optlen % sizeof(struct can_filter) != 0) 467c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EINVAL; 468c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 469c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp count = optlen / sizeof(struct can_filter); 470c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 471c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (count > 1) { 472c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* filter does not fit into dfilter => alloc space */ 47316dff91804777efbb0ce18b0a7e54c55e86b7bebJulia Lawall filter = memdup_user(optval, optlen); 47416dff91804777efbb0ce18b0a7e54c55e86b7bebJulia Lawall if (IS_ERR(filter)) 47516dff91804777efbb0ce18b0a7e54c55e86b7bebJulia Lawall return PTR_ERR(filter); 476c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } else if (count == 1) { 4774ffa87012efd7b664762b579213d4663560ef4a3Eric Dumazet if (copy_from_user(&sfilter, optval, sizeof(sfilter))) 4783f91bd420a955803421f2db17b2e04aacfbb2bb8Sam Ravnborg return -EFAULT; 479c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 480c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 481c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp lock_sock(sk); 482c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 483c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->bound && ro->ifindex) 484c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev = dev_get_by_index(&init_net, ro->ifindex); 485c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 486c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->bound) { 487c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* (try to) register the new filters */ 488c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (count == 1) 489c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = raw_enable_filters(dev, sk, &sfilter, 1); 490c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp else 491c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = raw_enable_filters(dev, sk, filter, 492c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp count); 493c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (err) { 494c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (count > 1) 495c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp kfree(filter); 496c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp goto out_fil; 497c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 498c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 499c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* remove old filter registrations */ 500c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_disable_filters(dev, sk, ro->filter, ro->count); 501c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 502c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 503c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* remove old filter space */ 504c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->count > 1) 505c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp kfree(ro->filter); 506c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 507c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* link new filters to the socket */ 508c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (count == 1) { 509c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* copy filter data for single filter */ 510c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->dfilter = sfilter; 511c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp filter = &ro->dfilter; 512c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 513c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->filter = filter; 514c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->count = count; 515c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 516c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp out_fil: 517c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (dev) 518c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev_put(dev); 519c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 520c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp release_sock(sk); 521c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 522c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp break; 523c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 524c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp case CAN_RAW_ERR_FILTER: 525c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (optlen != sizeof(err_mask)) 526c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EINVAL; 527c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 5283f91bd420a955803421f2db17b2e04aacfbb2bb8Sam Ravnborg if (copy_from_user(&err_mask, optval, optlen)) 5293f91bd420a955803421f2db17b2e04aacfbb2bb8Sam Ravnborg return -EFAULT; 530c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 531c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err_mask &= CAN_ERR_MASK; 532c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 533c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp lock_sock(sk); 534c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 535c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->bound && ro->ifindex) 536c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev = dev_get_by_index(&init_net, ro->ifindex); 537c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 538c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* remove current error mask */ 539c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->bound) { 540c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* (try to) register the new err_mask */ 541c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = raw_enable_errfilter(dev, sk, err_mask); 542c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 543c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (err) 544c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp goto out_err; 545c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 546c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* remove old err_mask registration */ 547c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp raw_disable_errfilter(dev, sk, ro->err_mask); 548c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 549c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 550c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp /* link new err_mask to the socket */ 551c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ro->err_mask = err_mask; 552c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 553c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp out_err: 554c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (dev) 555c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev_put(dev); 556c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 557c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp release_sock(sk); 558c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 559c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp break; 560c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 561c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp case CAN_RAW_LOOPBACK: 562c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (optlen != sizeof(ro->loopback)) 563c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EINVAL; 564c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 5653f91bd420a955803421f2db17b2e04aacfbb2bb8Sam Ravnborg if (copy_from_user(&ro->loopback, optval, optlen)) 5663f91bd420a955803421f2db17b2e04aacfbb2bb8Sam Ravnborg return -EFAULT; 567c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 568c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp break; 569c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 570c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp case CAN_RAW_RECV_OWN_MSGS: 571c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (optlen != sizeof(ro->recv_own_msgs)) 572c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EINVAL; 573c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 5743f91bd420a955803421f2db17b2e04aacfbb2bb8Sam Ravnborg if (copy_from_user(&ro->recv_own_msgs, optval, optlen)) 5753f91bd420a955803421f2db17b2e04aacfbb2bb8Sam Ravnborg return -EFAULT; 576c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 577c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp break; 578c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 579e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp case CAN_RAW_FD_FRAMES: 580e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp if (optlen != sizeof(ro->fd_frames)) 581e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp return -EINVAL; 582e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp 583e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp if (copy_from_user(&ro->fd_frames, optval, optlen)) 584e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp return -EFAULT; 585e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp 586e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp break; 587e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp 588c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp default: 589c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -ENOPROTOOPT; 590c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 591c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return err; 592c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 593c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 594c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_getsockopt(struct socket *sock, int level, int optname, 595c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp char __user *optval, int __user *optlen) 596c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 597c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock *sk = sock->sk; 598c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 599c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int len; 600c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp void *val; 601c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int err = 0; 602c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 603c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (level != SOL_CAN_RAW) 604c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EINVAL; 605c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (get_user(len, optlen)) 606c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EFAULT; 607c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (len < 0) 608c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EINVAL; 609c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 610c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp switch (optname) { 611c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 612c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp case CAN_RAW_FILTER: 613c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp lock_sock(sk); 614c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (ro->count > 0) { 615c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int fsize = ro->count * sizeof(struct can_filter); 616c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (len > fsize) 617c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp len = fsize; 618653252c2302cdf2dfbca66a7e177f7db783f9efaPavel Emelyanov if (copy_to_user(optval, ro->filter, len)) 619653252c2302cdf2dfbca66a7e177f7db783f9efaPavel Emelyanov err = -EFAULT; 620c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } else 621c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp len = 0; 622c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp release_sock(sk); 623c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 624c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (!err) 625c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = put_user(len, optlen); 626c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return err; 627c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 628c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp case CAN_RAW_ERR_FILTER: 629c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (len > sizeof(can_err_mask_t)) 630c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp len = sizeof(can_err_mask_t); 631c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp val = &ro->err_mask; 632c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp break; 633c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 634c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp case CAN_RAW_LOOPBACK: 635c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (len > sizeof(int)) 636c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp len = sizeof(int); 637c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp val = &ro->loopback; 638c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp break; 639c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 640c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp case CAN_RAW_RECV_OWN_MSGS: 641c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (len > sizeof(int)) 642c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp len = sizeof(int); 643c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp val = &ro->recv_own_msgs; 644c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp break; 645c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 646e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp case CAN_RAW_FD_FRAMES: 647e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp if (len > sizeof(int)) 648e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp len = sizeof(int); 649e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp val = &ro->fd_frames; 650e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp break; 651e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp 652c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp default: 653c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -ENOPROTOOPT; 654c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 655c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 656c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (put_user(len, optlen)) 657c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EFAULT; 658c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (copy_to_user(optval, val, len)) 659c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EFAULT; 660c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return 0; 661c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 662c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 663c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_sendmsg(struct kiocb *iocb, struct socket *sock, 664c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct msghdr *msg, size_t size) 665c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 666c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock *sk = sock->sk; 667c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 668c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sk_buff *skb; 669c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct net_device *dev; 670c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int ifindex; 671c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int err; 672c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 673c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (msg->msg_name) { 674342dfc306fb32155314dad277f3c3686b83fb9f1Steffen Hurrle DECLARE_SOCKADDR(struct sockaddr_can *, addr, msg->msg_name); 675c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 6765e5073280379d38e86ade471daa7443b553fc839Kurt Van Dijck if (msg->msg_namelen < sizeof(*addr)) 6775e5073280379d38e86ade471daa7443b553fc839Kurt Van Dijck return -EINVAL; 6785e5073280379d38e86ade471daa7443b553fc839Kurt Van Dijck 679c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (addr->can_family != AF_CAN) 680c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -EINVAL; 681c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 682c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ifindex = addr->can_ifindex; 683c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } else 684c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp ifindex = ro->ifindex; 685c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 686e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp if (ro->fd_frames) { 687e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp if (unlikely(size != CANFD_MTU && size != CAN_MTU)) 688e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp return -EINVAL; 689e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp } else { 690e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp if (unlikely(size != CAN_MTU)) 691e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp return -EINVAL; 692e2d265d3b587f5f6f8febc0222aace93302ff0beOliver Hartkopp } 6937f2d38eb7a42bea1c1df51bbdaa2ca0f0bdda07fOliver Hartkopp 694c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev = dev_get_by_index(&init_net, ifindex); 695c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (!dev) 696c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return -ENXIO; 697c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 698156c2bb9f88065c8da78814f98fde665a5cbb527Oliver Hartkopp skb = sock_alloc_send_skb(sk, size + sizeof(struct can_skb_priv), 699156c2bb9f88065c8da78814f98fde665a5cbb527Oliver Hartkopp msg->msg_flags & MSG_DONTWAIT, &err); 700ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinen if (!skb) 701ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinen goto put_dev; 702c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 7032bf3440d7b8755f2627232e6a4c37efbbe053685Oliver Hartkopp can_skb_reserve(skb); 7042bf3440d7b8755f2627232e6a4c37efbbe053685Oliver Hartkopp can_skb_prv(skb)->ifindex = dev->ifindex; 705156c2bb9f88065c8da78814f98fde665a5cbb527Oliver Hartkopp 706c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = memcpy_fromiovec(skb_put(skb, size), msg->msg_iov, size); 707ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinen if (err < 0) 708ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinen goto free_skb; 709bf84a01063eaab2f1a37d72d1b903445b3a25a4eDaniel Borkmann 710bf84a01063eaab2f1a37d72d1b903445b3a25a4eDaniel Borkmann sock_tx_timestamp(sk, &skb_shinfo(skb)->tx_flags); 711cff0d6e6edac7672b3f915bb4fb59f279243b7f9Oliver Hartkopp 712c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp skb->dev = dev; 713c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp skb->sk = sk; 714bb5ecb0c63ac88b6f39029f75c47f4be4e352e8dRostislav Lisovy skb->priority = sk->sk_priority; 715c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 716c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = can_send(skb, ro->loopback); 717c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 718c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp dev_put(dev); 719c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 720c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (err) 721ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinen goto send_failed; 722c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 723c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return size; 724ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinen 725ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinenfree_skb: 726ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinen kfree_skb(skb); 727ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinenput_dev: 728ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinen dev_put(dev); 729ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinensend_failed: 730ebad5c0984e06f4036d2eb2741b9afce736b8a06Ilpo Järvinen return err; 731c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 732c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 733c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic int raw_recvmsg(struct kiocb *iocb, struct socket *sock, 734c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct msghdr *msg, size_t size, int flags) 735c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 736c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sock *sk = sock->sk; 737c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp struct sk_buff *skb; 738a219994bf5cca1208fb741b20ea9eb78e1711f81Urs Thuermann int err = 0; 739c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int noblock; 740c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 741c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp noblock = flags & MSG_DONTWAIT; 742c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp flags &= ~MSG_DONTWAIT; 743c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 744a219994bf5cca1208fb741b20ea9eb78e1711f81Urs Thuermann skb = skb_recv_datagram(sk, flags, noblock, &err); 745c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (!skb) 746a219994bf5cca1208fb741b20ea9eb78e1711f81Urs Thuermann return err; 747c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 748821047c4055cca833c4674f172a9d73003563eb6Oliver Hartkopp if (size < skb->len) 749c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp msg->msg_flags |= MSG_TRUNC; 750c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp else 751821047c4055cca833c4674f172a9d73003563eb6Oliver Hartkopp size = skb->len; 752c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 753a219994bf5cca1208fb741b20ea9eb78e1711f81Urs Thuermann err = memcpy_toiovec(msg->msg_iov, skb->data, size); 754a219994bf5cca1208fb741b20ea9eb78e1711f81Urs Thuermann if (err < 0) { 755c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp skb_free_datagram(sk, skb); 756a219994bf5cca1208fb741b20ea9eb78e1711f81Urs Thuermann return err; 757c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 758c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 7593b885787ea4112eaa80945999ea0901bf742707fNeil Horman sock_recv_ts_and_drops(msg, sk, skb); 760c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 761c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (msg->msg_name) { 762342dfc306fb32155314dad277f3c3686b83fb9f1Steffen Hurrle __sockaddr_check_size(sizeof(struct sockaddr_can)); 763c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp msg->msg_namelen = sizeof(struct sockaddr_can); 764c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp memcpy(msg->msg_name, skb->cb, msg->msg_namelen); 765c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp } 766c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 7671e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp /* assign the flags that have been recorded in raw_rcv() */ 7681e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp msg->msg_flags |= *(raw_flags(skb)); 7691e55659ce6ddb5247cee0b1f720d77a799902b85Oliver Hartkopp 770c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp skb_free_datagram(sk, skb); 771c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 772c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return size; 773c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 774c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 77553914b67993c724cec585863755c9ebc8446e83bOliver Hartkoppstatic const struct proto_ops raw_ops = { 776c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .family = PF_CAN, 777c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .release = raw_release, 778c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .bind = raw_bind, 779c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .connect = sock_no_connect, 780c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .socketpair = sock_no_socketpair, 781c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .accept = sock_no_accept, 782c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .getname = raw_getname, 783c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .poll = datagram_poll, 78453914b67993c724cec585863755c9ebc8446e83bOliver Hartkopp .ioctl = can_ioctl, /* use can_ioctl() from af_can.c */ 785c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .listen = sock_no_listen, 786c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .shutdown = sock_no_shutdown, 787c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .setsockopt = raw_setsockopt, 788c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .getsockopt = raw_getsockopt, 789c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .sendmsg = raw_sendmsg, 790c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .recvmsg = raw_recvmsg, 791c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .mmap = sock_no_mmap, 792c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .sendpage = sock_no_sendpage, 793c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp}; 794c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 795c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic struct proto raw_proto __read_mostly = { 796c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .name = "CAN_RAW", 797c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .owner = THIS_MODULE, 798c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .obj_size = sizeof(struct raw_sock), 799c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .init = raw_init, 800c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp}; 801c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 8021650629d1800bf05ad775f974e931ca2fa03b0ffKurt Van Dijckstatic const struct can_proto raw_can_proto = { 803c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .type = SOCK_RAW, 804c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .protocol = CAN_RAW, 805c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .ops = &raw_ops, 806c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp .prot = &raw_proto, 807c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp}; 808c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 809c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic __init int raw_module_init(void) 810c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 811c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp int err; 812c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 813c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp printk(banner); 814c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 815c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp err = can_proto_register(&raw_can_proto); 816c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp if (err < 0) 817c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp printk(KERN_ERR "can: registration of raw protocol failed\n"); 818c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 819c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp return err; 820c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 821c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 822c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppstatic __exit void raw_module_exit(void) 823c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp{ 824c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp can_proto_unregister(&raw_can_proto); 825c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp} 826c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkopp 827c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppmodule_init(raw_module_init); 828c18ce101f2e47d97ace125033e2896895a6db3ddOliver Hartkoppmodule_exit(raw_module_exit); 829