1d77cd7feSMasahiro Yamada // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause) 2d6ada83bSMarc Kleine-Budde /* raw.c - Raw sockets for protocol family CAN 3c18ce101SOliver Hartkopp * 4c18ce101SOliver Hartkopp * Copyright (c) 2002-2007 Volkswagen Group Electronic Research 5c18ce101SOliver Hartkopp * All rights reserved. 6c18ce101SOliver Hartkopp * 7c18ce101SOliver Hartkopp * Redistribution and use in source and binary forms, with or without 8c18ce101SOliver Hartkopp * modification, are permitted provided that the following conditions 9c18ce101SOliver Hartkopp * are met: 10c18ce101SOliver Hartkopp * 1. Redistributions of source code must retain the above copyright 11c18ce101SOliver Hartkopp * notice, this list of conditions and the following disclaimer. 12c18ce101SOliver Hartkopp * 2. Redistributions in binary form must reproduce the above copyright 13c18ce101SOliver Hartkopp * notice, this list of conditions and the following disclaimer in the 14c18ce101SOliver Hartkopp * documentation and/or other materials provided with the distribution. 15c18ce101SOliver Hartkopp * 3. Neither the name of Volkswagen nor the names of its contributors 16c18ce101SOliver Hartkopp * may be used to endorse or promote products derived from this software 17c18ce101SOliver Hartkopp * without specific prior written permission. 18c18ce101SOliver Hartkopp * 19c18ce101SOliver Hartkopp * Alternatively, provided that this notice is retained in full, this 20c18ce101SOliver Hartkopp * software may be distributed under the terms of the GNU General 21c18ce101SOliver Hartkopp * Public License ("GPL") version 2, in which case the provisions of the 22c18ce101SOliver Hartkopp * GPL apply INSTEAD OF those given above. 23c18ce101SOliver Hartkopp * 24c18ce101SOliver Hartkopp * The provided data structures and external interfaces from this code 25c18ce101SOliver Hartkopp * are not restricted to be used by modules with a GPL compatible license. 26c18ce101SOliver Hartkopp * 27c18ce101SOliver Hartkopp * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 28c18ce101SOliver Hartkopp * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 29c18ce101SOliver Hartkopp * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 30c18ce101SOliver Hartkopp * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 31c18ce101SOliver Hartkopp * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 32c18ce101SOliver Hartkopp * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 33c18ce101SOliver Hartkopp * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 34c18ce101SOliver Hartkopp * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 35c18ce101SOliver Hartkopp * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 36c18ce101SOliver Hartkopp * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 37c18ce101SOliver Hartkopp * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH 38c18ce101SOliver Hartkopp * DAMAGE. 39c18ce101SOliver Hartkopp * 40c18ce101SOliver Hartkopp */ 41c18ce101SOliver Hartkopp 42c18ce101SOliver Hartkopp #include <linux/module.h> 43c18ce101SOliver Hartkopp #include <linux/init.h> 44c18ce101SOliver Hartkopp #include <linux/uio.h> 45c18ce101SOliver Hartkopp #include <linux/net.h> 465a0e3ad6STejun Heo #include <linux/slab.h> 47c18ce101SOliver Hartkopp #include <linux/netdevice.h> 48c18ce101SOliver Hartkopp #include <linux/socket.h> 49c18ce101SOliver Hartkopp #include <linux/if_arp.h> 50c18ce101SOliver Hartkopp #include <linux/skbuff.h> 51c18ce101SOliver Hartkopp #include <linux/can.h> 52c18ce101SOliver Hartkopp #include <linux/can/core.h> 53156c2bb9SOliver Hartkopp #include <linux/can/skb.h> 54c18ce101SOliver Hartkopp #include <linux/can/raw.h> 55c18ce101SOliver Hartkopp #include <net/sock.h> 56c18ce101SOliver Hartkopp #include <net/net_namespace.h> 57c18ce101SOliver Hartkopp 58c18ce101SOliver Hartkopp MODULE_DESCRIPTION("PF_CAN raw protocol"); 59c18ce101SOliver Hartkopp MODULE_LICENSE("Dual BSD/GPL"); 60c18ce101SOliver Hartkopp MODULE_AUTHOR("Urs Thuermann <urs.thuermann@volkswagen.de>"); 61b13bb2e9SLothar Waßmann MODULE_ALIAS("can-proto-1"); 62c18ce101SOliver Hartkopp 63c18ce101SOliver Hartkopp #define MASK_ALL 0 64c18ce101SOliver Hartkopp 65d6ada83bSMarc Kleine-Budde /* A raw socket has a list of can_filters attached to it, each receiving 66c18ce101SOliver Hartkopp * the CAN frames matching that filter. If the filter list is empty, 67c18ce101SOliver Hartkopp * no CAN frames will be received by the socket. The default after 68c18ce101SOliver Hartkopp * opening the socket, is to have one filter which receives all frames. 69c18ce101SOliver Hartkopp * The filter list is allocated dynamically with the exception of the 70c18ce101SOliver Hartkopp * list containing only one item. This common case is optimized by 71c18ce101SOliver Hartkopp * storing the single filter in dfilter, to avoid using dynamic memory. 72c18ce101SOliver Hartkopp */ 73c18ce101SOliver Hartkopp 74514ac99cSOliver Hartkopp struct uniqframe { 75d3b58c47SOliver Hartkopp int skbcnt; 76514ac99cSOliver Hartkopp const struct sk_buff *skb; 77a5581ef4SOliver Hartkopp unsigned int join_rx_count; 78514ac99cSOliver Hartkopp }; 79514ac99cSOliver Hartkopp 80c18ce101SOliver Hartkopp struct raw_sock { 81c18ce101SOliver Hartkopp struct sock sk; 82c18ce101SOliver Hartkopp int bound; 83c18ce101SOliver Hartkopp int ifindex; 84c18ce101SOliver Hartkopp struct notifier_block notifier; 85c18ce101SOliver Hartkopp int loopback; 86c18ce101SOliver Hartkopp int recv_own_msgs; 87e2d265d3SOliver Hartkopp int fd_frames; 88a5581ef4SOliver Hartkopp int join_filters; 89c18ce101SOliver Hartkopp int count; /* number of active filters */ 90c18ce101SOliver Hartkopp struct can_filter dfilter; /* default/single filter */ 91c18ce101SOliver Hartkopp struct can_filter *filter; /* pointer to filter(s) */ 92c18ce101SOliver Hartkopp can_err_mask_t err_mask; 93514ac99cSOliver Hartkopp struct uniqframe __percpu *uniq; 94c18ce101SOliver Hartkopp }; 95c18ce101SOliver Hartkopp 96d6ada83bSMarc Kleine-Budde /* Return pointer to store the extra msg flags for raw_recvmsg(). 971e55659cSOliver Hartkopp * We use the space of one unsigned int beyond the 'struct sockaddr_can' 981e55659cSOliver Hartkopp * in skb->cb. 991e55659cSOliver Hartkopp */ 1001e55659cSOliver Hartkopp static inline unsigned int *raw_flags(struct sk_buff *skb) 1011e55659cSOliver Hartkopp { 102b4772ef8SEyal Birger sock_skb_cb_check_size(sizeof(struct sockaddr_can) + 103b4772ef8SEyal Birger sizeof(unsigned int)); 1041e55659cSOliver Hartkopp 1051e55659cSOliver Hartkopp /* return pointer after struct sockaddr_can */ 1061e55659cSOliver Hartkopp return (unsigned int *)(&((struct sockaddr_can *)skb->cb)[1]); 1071e55659cSOliver Hartkopp } 1081e55659cSOliver Hartkopp 109c18ce101SOliver Hartkopp static inline struct raw_sock *raw_sk(const struct sock *sk) 110c18ce101SOliver Hartkopp { 111c18ce101SOliver Hartkopp return (struct raw_sock *)sk; 112c18ce101SOliver Hartkopp } 113c18ce101SOliver Hartkopp 1141e55659cSOliver Hartkopp static void raw_rcv(struct sk_buff *oskb, void *data) 115c18ce101SOliver Hartkopp { 116c18ce101SOliver Hartkopp struct sock *sk = (struct sock *)data; 117c18ce101SOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 118c18ce101SOliver Hartkopp struct sockaddr_can *addr; 1191e55659cSOliver Hartkopp struct sk_buff *skb; 1201e55659cSOliver Hartkopp unsigned int *pflags; 121c18ce101SOliver Hartkopp 122c18ce101SOliver Hartkopp /* check the received tx sock reference */ 1231e55659cSOliver Hartkopp if (!ro->recv_own_msgs && oskb->sk == sk) 124c18ce101SOliver Hartkopp return; 1251fa17d4bSOliver Hartkopp 126821047c4SOliver Hartkopp /* do not pass non-CAN2.0 frames to a legacy socket */ 127821047c4SOliver Hartkopp if (!ro->fd_frames && oskb->len != CAN_MTU) 128e2d265d3SOliver Hartkopp return; 129e2d265d3SOliver Hartkopp 130514ac99cSOliver Hartkopp /* eliminate multiple filter matches for the same skb */ 131514ac99cSOliver Hartkopp if (this_cpu_ptr(ro->uniq)->skb == oskb && 132d3b58c47SOliver Hartkopp this_cpu_ptr(ro->uniq)->skbcnt == can_skb_prv(oskb)->skbcnt) { 133a5581ef4SOliver Hartkopp if (ro->join_filters) { 134a5581ef4SOliver Hartkopp this_cpu_inc(ro->uniq->join_rx_count); 135a5581ef4SOliver Hartkopp /* drop frame until all enabled filters matched */ 136a5581ef4SOliver Hartkopp if (this_cpu_ptr(ro->uniq)->join_rx_count < ro->count) 137514ac99cSOliver Hartkopp return; 138514ac99cSOliver Hartkopp } else { 139a5581ef4SOliver Hartkopp return; 140a5581ef4SOliver Hartkopp } 141a5581ef4SOliver Hartkopp } else { 142514ac99cSOliver Hartkopp this_cpu_ptr(ro->uniq)->skb = oskb; 143d3b58c47SOliver Hartkopp this_cpu_ptr(ro->uniq)->skbcnt = can_skb_prv(oskb)->skbcnt; 144a5581ef4SOliver Hartkopp this_cpu_ptr(ro->uniq)->join_rx_count = 1; 145a5581ef4SOliver Hartkopp /* drop first frame to check all enabled filters? */ 146a5581ef4SOliver Hartkopp if (ro->join_filters && ro->count > 1) 147a5581ef4SOliver Hartkopp return; 148514ac99cSOliver Hartkopp } 149514ac99cSOliver Hartkopp 1501fa17d4bSOliver Hartkopp /* clone the given skb to be able to enqueue it into the rcv queue */ 1511e55659cSOliver Hartkopp skb = skb_clone(oskb, GFP_ATOMIC); 1521fa17d4bSOliver Hartkopp if (!skb) 1531fa17d4bSOliver Hartkopp return; 154c18ce101SOliver Hartkopp 1556a54dde8SMarc Kleine-Budde /* Put the datagram to the queue so that raw_recvmsg() can get 1566a54dde8SMarc Kleine-Budde * it from there. We need to pass the interface index to 1576a54dde8SMarc Kleine-Budde * raw_recvmsg(). We pass a whole struct sockaddr_can in 1586a54dde8SMarc Kleine-Budde * skb->cb containing the interface index. 159c18ce101SOliver Hartkopp */ 160c18ce101SOliver Hartkopp 161b4772ef8SEyal Birger sock_skb_cb_check_size(sizeof(struct sockaddr_can)); 162c18ce101SOliver Hartkopp addr = (struct sockaddr_can *)skb->cb; 163c18ce101SOliver Hartkopp memset(addr, 0, sizeof(*addr)); 164c18ce101SOliver Hartkopp addr->can_family = AF_CAN; 165c18ce101SOliver Hartkopp addr->can_ifindex = skb->dev->ifindex; 166c18ce101SOliver Hartkopp 1671e55659cSOliver Hartkopp /* add CAN specific message flags for raw_recvmsg() */ 1681e55659cSOliver Hartkopp pflags = raw_flags(skb); 1691e55659cSOliver Hartkopp *pflags = 0; 1701e55659cSOliver Hartkopp if (oskb->sk) 1711e55659cSOliver Hartkopp *pflags |= MSG_DONTROUTE; 1721e55659cSOliver Hartkopp if (oskb->sk == sk) 1731e55659cSOliver Hartkopp *pflags |= MSG_CONFIRM; 1741e55659cSOliver Hartkopp 175a219994bSUrs Thuermann if (sock_queue_rcv_skb(sk, skb) < 0) 176c18ce101SOliver Hartkopp kfree_skb(skb); 177c18ce101SOliver Hartkopp } 178c18ce101SOliver Hartkopp 1798e8cda6dSMario Kicherer static int raw_enable_filters(struct net *net, struct net_device *dev, 1808e8cda6dSMario Kicherer struct sock *sk, struct can_filter *filter, 1818e8cda6dSMario Kicherer int count) 182c18ce101SOliver Hartkopp { 183c18ce101SOliver Hartkopp int err = 0; 184c18ce101SOliver Hartkopp int i; 185c18ce101SOliver Hartkopp 186c18ce101SOliver Hartkopp for (i = 0; i < count; i++) { 1878e8cda6dSMario Kicherer err = can_rx_register(net, dev, filter[i].can_id, 188c18ce101SOliver Hartkopp filter[i].can_mask, 189f1712c73SEric Dumazet raw_rcv, sk, "raw", sk); 190c18ce101SOliver Hartkopp if (err) { 191c18ce101SOliver Hartkopp /* clean up successfully registered filters */ 192c18ce101SOliver Hartkopp while (--i >= 0) 1938e8cda6dSMario Kicherer can_rx_unregister(net, dev, filter[i].can_id, 194c18ce101SOliver Hartkopp filter[i].can_mask, 195c18ce101SOliver Hartkopp raw_rcv, sk); 196c18ce101SOliver Hartkopp break; 197c18ce101SOliver Hartkopp } 198c18ce101SOliver Hartkopp } 199c18ce101SOliver Hartkopp 200c18ce101SOliver Hartkopp return err; 201c18ce101SOliver Hartkopp } 202c18ce101SOliver Hartkopp 2038e8cda6dSMario Kicherer static int raw_enable_errfilter(struct net *net, struct net_device *dev, 2048e8cda6dSMario Kicherer struct sock *sk, can_err_mask_t err_mask) 205c18ce101SOliver Hartkopp { 206c18ce101SOliver Hartkopp int err = 0; 207c18ce101SOliver Hartkopp 208c18ce101SOliver Hartkopp if (err_mask) 2098e8cda6dSMario Kicherer err = can_rx_register(net, dev, 0, err_mask | CAN_ERR_FLAG, 210f1712c73SEric Dumazet raw_rcv, sk, "raw", sk); 211c18ce101SOliver Hartkopp 212c18ce101SOliver Hartkopp return err; 213c18ce101SOliver Hartkopp } 214c18ce101SOliver Hartkopp 2158e8cda6dSMario Kicherer static void raw_disable_filters(struct net *net, struct net_device *dev, 2168e8cda6dSMario Kicherer struct sock *sk, struct can_filter *filter, 2178e8cda6dSMario Kicherer int count) 218c18ce101SOliver Hartkopp { 219c18ce101SOliver Hartkopp int i; 220c18ce101SOliver Hartkopp 221c18ce101SOliver Hartkopp for (i = 0; i < count; i++) 2228e8cda6dSMario Kicherer can_rx_unregister(net, dev, filter[i].can_id, 2238e8cda6dSMario Kicherer filter[i].can_mask, raw_rcv, sk); 224c18ce101SOliver Hartkopp } 225c18ce101SOliver Hartkopp 2268e8cda6dSMario Kicherer static inline void raw_disable_errfilter(struct net *net, 2278e8cda6dSMario Kicherer struct net_device *dev, 228c18ce101SOliver Hartkopp struct sock *sk, 229c18ce101SOliver Hartkopp can_err_mask_t err_mask) 230c18ce101SOliver Hartkopp 231c18ce101SOliver Hartkopp { 232c18ce101SOliver Hartkopp if (err_mask) 2338e8cda6dSMario Kicherer can_rx_unregister(net, dev, 0, err_mask | CAN_ERR_FLAG, 234c18ce101SOliver Hartkopp raw_rcv, sk); 235c18ce101SOliver Hartkopp } 236c18ce101SOliver Hartkopp 2378e8cda6dSMario Kicherer static inline void raw_disable_allfilters(struct net *net, 2388e8cda6dSMario Kicherer struct net_device *dev, 239c18ce101SOliver Hartkopp struct sock *sk) 240c18ce101SOliver Hartkopp { 241c18ce101SOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 242c18ce101SOliver Hartkopp 2438e8cda6dSMario Kicherer raw_disable_filters(net, dev, sk, ro->filter, ro->count); 2448e8cda6dSMario Kicherer raw_disable_errfilter(net, dev, sk, ro->err_mask); 245c18ce101SOliver Hartkopp } 246c18ce101SOliver Hartkopp 2478e8cda6dSMario Kicherer static int raw_enable_allfilters(struct net *net, struct net_device *dev, 2488e8cda6dSMario Kicherer struct sock *sk) 249c18ce101SOliver Hartkopp { 250c18ce101SOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 251c18ce101SOliver Hartkopp int err; 252c18ce101SOliver Hartkopp 2538e8cda6dSMario Kicherer err = raw_enable_filters(net, dev, sk, ro->filter, ro->count); 254c18ce101SOliver Hartkopp if (!err) { 2558e8cda6dSMario Kicherer err = raw_enable_errfilter(net, dev, sk, ro->err_mask); 256c18ce101SOliver Hartkopp if (err) 2578e8cda6dSMario Kicherer raw_disable_filters(net, dev, sk, ro->filter, 2588e8cda6dSMario Kicherer ro->count); 259c18ce101SOliver Hartkopp } 260c18ce101SOliver Hartkopp 261c18ce101SOliver Hartkopp return err; 262c18ce101SOliver Hartkopp } 263c18ce101SOliver Hartkopp 264c18ce101SOliver Hartkopp static int raw_notifier(struct notifier_block *nb, 265351638e7SJiri Pirko unsigned long msg, void *ptr) 266c18ce101SOliver Hartkopp { 267351638e7SJiri Pirko struct net_device *dev = netdev_notifier_info_to_dev(ptr); 268c18ce101SOliver Hartkopp struct raw_sock *ro = container_of(nb, struct raw_sock, notifier); 269c18ce101SOliver Hartkopp struct sock *sk = &ro->sk; 270c18ce101SOliver Hartkopp 2718e8cda6dSMario Kicherer if (!net_eq(dev_net(dev), sock_net(sk))) 272c18ce101SOliver Hartkopp return NOTIFY_DONE; 273c18ce101SOliver Hartkopp 274c18ce101SOliver Hartkopp if (dev->type != ARPHRD_CAN) 275c18ce101SOliver Hartkopp return NOTIFY_DONE; 276c18ce101SOliver Hartkopp 277c18ce101SOliver Hartkopp if (ro->ifindex != dev->ifindex) 278c18ce101SOliver Hartkopp return NOTIFY_DONE; 279c18ce101SOliver Hartkopp 280c18ce101SOliver Hartkopp switch (msg) { 281c18ce101SOliver Hartkopp case NETDEV_UNREGISTER: 282c18ce101SOliver Hartkopp lock_sock(sk); 283c18ce101SOliver Hartkopp /* remove current filters & unregister */ 284c18ce101SOliver Hartkopp if (ro->bound) 2858e8cda6dSMario Kicherer raw_disable_allfilters(dev_net(dev), dev, sk); 286c18ce101SOliver Hartkopp 287c18ce101SOliver Hartkopp if (ro->count > 1) 288c18ce101SOliver Hartkopp kfree(ro->filter); 289c18ce101SOliver Hartkopp 290c18ce101SOliver Hartkopp ro->ifindex = 0; 291c18ce101SOliver Hartkopp ro->bound = 0; 292c18ce101SOliver Hartkopp ro->count = 0; 293c18ce101SOliver Hartkopp release_sock(sk); 294c18ce101SOliver Hartkopp 295c18ce101SOliver Hartkopp sk->sk_err = ENODEV; 296c18ce101SOliver Hartkopp if (!sock_flag(sk, SOCK_DEAD)) 297c18ce101SOliver Hartkopp sk->sk_error_report(sk); 298c18ce101SOliver Hartkopp break; 299c18ce101SOliver Hartkopp 300c18ce101SOliver Hartkopp case NETDEV_DOWN: 301c18ce101SOliver Hartkopp sk->sk_err = ENETDOWN; 302c18ce101SOliver Hartkopp if (!sock_flag(sk, SOCK_DEAD)) 303c18ce101SOliver Hartkopp sk->sk_error_report(sk); 304c18ce101SOliver Hartkopp break; 305c18ce101SOliver Hartkopp } 306c18ce101SOliver Hartkopp 307c18ce101SOliver Hartkopp return NOTIFY_DONE; 308c18ce101SOliver Hartkopp } 309c18ce101SOliver Hartkopp 310c18ce101SOliver Hartkopp static int raw_init(struct sock *sk) 311c18ce101SOliver Hartkopp { 312c18ce101SOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 313c18ce101SOliver Hartkopp 314c18ce101SOliver Hartkopp ro->bound = 0; 315c18ce101SOliver Hartkopp ro->ifindex = 0; 316c18ce101SOliver Hartkopp 317c18ce101SOliver Hartkopp /* set default filter to single entry dfilter */ 318c18ce101SOliver Hartkopp ro->dfilter.can_id = 0; 319c18ce101SOliver Hartkopp ro->dfilter.can_mask = MASK_ALL; 320c18ce101SOliver Hartkopp ro->filter = &ro->dfilter; 321c18ce101SOliver Hartkopp ro->count = 1; 322c18ce101SOliver Hartkopp 323c18ce101SOliver Hartkopp /* set default loopback behaviour */ 324c18ce101SOliver Hartkopp ro->loopback = 1; 325c18ce101SOliver Hartkopp ro->recv_own_msgs = 0; 326e2d265d3SOliver Hartkopp ro->fd_frames = 0; 327a5581ef4SOliver Hartkopp ro->join_filters = 0; 328c18ce101SOliver Hartkopp 329514ac99cSOliver Hartkopp /* alloc_percpu provides zero'ed memory */ 330514ac99cSOliver Hartkopp ro->uniq = alloc_percpu(struct uniqframe); 331514ac99cSOliver Hartkopp if (unlikely(!ro->uniq)) 332514ac99cSOliver Hartkopp return -ENOMEM; 333514ac99cSOliver Hartkopp 334c18ce101SOliver Hartkopp /* set notifier */ 335c18ce101SOliver Hartkopp ro->notifier.notifier_call = raw_notifier; 336c18ce101SOliver Hartkopp 337c18ce101SOliver Hartkopp register_netdevice_notifier(&ro->notifier); 338c18ce101SOliver Hartkopp 339c18ce101SOliver Hartkopp return 0; 340c18ce101SOliver Hartkopp } 341c18ce101SOliver Hartkopp 342c18ce101SOliver Hartkopp static int raw_release(struct socket *sock) 343c18ce101SOliver Hartkopp { 344c18ce101SOliver Hartkopp struct sock *sk = sock->sk; 34510022a6cSOliver Hartkopp struct raw_sock *ro; 34610022a6cSOliver Hartkopp 34710022a6cSOliver Hartkopp if (!sk) 34810022a6cSOliver Hartkopp return 0; 34910022a6cSOliver Hartkopp 35010022a6cSOliver Hartkopp ro = raw_sk(sk); 351c18ce101SOliver Hartkopp 352c18ce101SOliver Hartkopp unregister_netdevice_notifier(&ro->notifier); 353c18ce101SOliver Hartkopp 354c18ce101SOliver Hartkopp lock_sock(sk); 355c18ce101SOliver Hartkopp 356c18ce101SOliver Hartkopp /* remove current filters & unregister */ 357c18ce101SOliver Hartkopp if (ro->bound) { 358c18ce101SOliver Hartkopp if (ro->ifindex) { 359c18ce101SOliver Hartkopp struct net_device *dev; 360c18ce101SOliver Hartkopp 3618e8cda6dSMario Kicherer dev = dev_get_by_index(sock_net(sk), ro->ifindex); 362c18ce101SOliver Hartkopp if (dev) { 3638e8cda6dSMario Kicherer raw_disable_allfilters(dev_net(dev), dev, sk); 364c18ce101SOliver Hartkopp dev_put(dev); 365c18ce101SOliver Hartkopp } 366bff10040SMarc Kleine-Budde } else { 3678e8cda6dSMario Kicherer raw_disable_allfilters(sock_net(sk), NULL, sk); 368c18ce101SOliver Hartkopp } 369bff10040SMarc Kleine-Budde } 370c18ce101SOliver Hartkopp 371c18ce101SOliver Hartkopp if (ro->count > 1) 372c18ce101SOliver Hartkopp kfree(ro->filter); 373c18ce101SOliver Hartkopp 374c18ce101SOliver Hartkopp ro->ifindex = 0; 375c18ce101SOliver Hartkopp ro->bound = 0; 376c18ce101SOliver Hartkopp ro->count = 0; 377514ac99cSOliver Hartkopp free_percpu(ro->uniq); 378c18ce101SOliver Hartkopp 379f7e5cc0cSLothar Waßmann sock_orphan(sk); 380f7e5cc0cSLothar Waßmann sock->sk = NULL; 381f7e5cc0cSLothar Waßmann 382c18ce101SOliver Hartkopp release_sock(sk); 383c18ce101SOliver Hartkopp sock_put(sk); 384c18ce101SOliver Hartkopp 385c18ce101SOliver Hartkopp return 0; 386c18ce101SOliver Hartkopp } 387c18ce101SOliver Hartkopp 388c18ce101SOliver Hartkopp static int raw_bind(struct socket *sock, struct sockaddr *uaddr, int len) 389c18ce101SOliver Hartkopp { 390c18ce101SOliver Hartkopp struct sockaddr_can *addr = (struct sockaddr_can *)uaddr; 391c18ce101SOliver Hartkopp struct sock *sk = sock->sk; 392c18ce101SOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 393c18ce101SOliver Hartkopp int ifindex; 394c18ce101SOliver Hartkopp int err = 0; 395c18ce101SOliver Hartkopp int notify_enetdown = 0; 396c18ce101SOliver Hartkopp 3979868b5d4SKurt Van Dijck if (len < CAN_REQUIRED_SIZE(*addr, can_ifindex)) 398c18ce101SOliver Hartkopp return -EINVAL; 399adb552c3SMarc Kleine-Budde if (addr->can_family != AF_CAN) 400adb552c3SMarc Kleine-Budde return -EINVAL; 401c18ce101SOliver Hartkopp 402c18ce101SOliver Hartkopp lock_sock(sk); 403c18ce101SOliver Hartkopp 404c18ce101SOliver Hartkopp if (ro->bound && addr->can_ifindex == ro->ifindex) 405c18ce101SOliver Hartkopp goto out; 406c18ce101SOliver Hartkopp 407c18ce101SOliver Hartkopp if (addr->can_ifindex) { 408c18ce101SOliver Hartkopp struct net_device *dev; 409c18ce101SOliver Hartkopp 4108e8cda6dSMario Kicherer dev = dev_get_by_index(sock_net(sk), addr->can_ifindex); 411c18ce101SOliver Hartkopp if (!dev) { 412c18ce101SOliver Hartkopp err = -ENODEV; 413c18ce101SOliver Hartkopp goto out; 414c18ce101SOliver Hartkopp } 415c18ce101SOliver Hartkopp if (dev->type != ARPHRD_CAN) { 416c18ce101SOliver Hartkopp dev_put(dev); 417c18ce101SOliver Hartkopp err = -ENODEV; 418c18ce101SOliver Hartkopp goto out; 419c18ce101SOliver Hartkopp } 420c18ce101SOliver Hartkopp if (!(dev->flags & IFF_UP)) 421c18ce101SOliver Hartkopp notify_enetdown = 1; 422c18ce101SOliver Hartkopp 423c18ce101SOliver Hartkopp ifindex = dev->ifindex; 424c18ce101SOliver Hartkopp 425c18ce101SOliver Hartkopp /* filters set by default/setsockopt */ 4268e8cda6dSMario Kicherer err = raw_enable_allfilters(sock_net(sk), dev, sk); 427c18ce101SOliver Hartkopp dev_put(dev); 428c18ce101SOliver Hartkopp } else { 429c18ce101SOliver Hartkopp ifindex = 0; 430c18ce101SOliver Hartkopp 431c18ce101SOliver Hartkopp /* filters set by default/setsockopt */ 4328e8cda6dSMario Kicherer err = raw_enable_allfilters(sock_net(sk), NULL, sk); 433c18ce101SOliver Hartkopp } 434c18ce101SOliver Hartkopp 435c18ce101SOliver Hartkopp if (!err) { 436c18ce101SOliver Hartkopp if (ro->bound) { 437c18ce101SOliver Hartkopp /* unregister old filters */ 438c18ce101SOliver Hartkopp if (ro->ifindex) { 439c18ce101SOliver Hartkopp struct net_device *dev; 440c18ce101SOliver Hartkopp 4418e8cda6dSMario Kicherer dev = dev_get_by_index(sock_net(sk), 4428e8cda6dSMario Kicherer ro->ifindex); 443c18ce101SOliver Hartkopp if (dev) { 4448e8cda6dSMario Kicherer raw_disable_allfilters(dev_net(dev), 4458e8cda6dSMario Kicherer dev, sk); 446c18ce101SOliver Hartkopp dev_put(dev); 447c18ce101SOliver Hartkopp } 448bff10040SMarc Kleine-Budde } else { 4498e8cda6dSMario Kicherer raw_disable_allfilters(sock_net(sk), NULL, sk); 450c18ce101SOliver Hartkopp } 451bff10040SMarc Kleine-Budde } 452c18ce101SOliver Hartkopp ro->ifindex = ifindex; 453c18ce101SOliver Hartkopp ro->bound = 1; 454c18ce101SOliver Hartkopp } 455c18ce101SOliver Hartkopp 456c18ce101SOliver Hartkopp out: 457c18ce101SOliver Hartkopp release_sock(sk); 458c18ce101SOliver Hartkopp 459c18ce101SOliver Hartkopp if (notify_enetdown) { 460c18ce101SOliver Hartkopp sk->sk_err = ENETDOWN; 461c18ce101SOliver Hartkopp if (!sock_flag(sk, SOCK_DEAD)) 462c18ce101SOliver Hartkopp sk->sk_error_report(sk); 463c18ce101SOliver Hartkopp } 464c18ce101SOliver Hartkopp 465c18ce101SOliver Hartkopp return err; 466c18ce101SOliver Hartkopp } 467c18ce101SOliver Hartkopp 468c18ce101SOliver Hartkopp static int raw_getname(struct socket *sock, struct sockaddr *uaddr, 4699b2c45d4SDenys Vlasenko int peer) 470c18ce101SOliver Hartkopp { 471c18ce101SOliver Hartkopp struct sockaddr_can *addr = (struct sockaddr_can *)uaddr; 472c18ce101SOliver Hartkopp struct sock *sk = sock->sk; 473c18ce101SOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 474c18ce101SOliver Hartkopp 475c18ce101SOliver Hartkopp if (peer) 476c18ce101SOliver Hartkopp return -EOPNOTSUPP; 477c18ce101SOliver Hartkopp 478e84b90aeSEric Dumazet memset(addr, 0, sizeof(*addr)); 479c18ce101SOliver Hartkopp addr->can_family = AF_CAN; 480c18ce101SOliver Hartkopp addr->can_ifindex = ro->ifindex; 481c18ce101SOliver Hartkopp 4829b2c45d4SDenys Vlasenko return sizeof(*addr); 483c18ce101SOliver Hartkopp } 484c18ce101SOliver Hartkopp 485c18ce101SOliver Hartkopp static int raw_setsockopt(struct socket *sock, int level, int optname, 486a7b75c5aSChristoph Hellwig sockptr_t optval, unsigned int optlen) 487c18ce101SOliver Hartkopp { 488c18ce101SOliver Hartkopp struct sock *sk = sock->sk; 489c18ce101SOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 490c18ce101SOliver Hartkopp struct can_filter *filter = NULL; /* dyn. alloc'ed filters */ 491c18ce101SOliver Hartkopp struct can_filter sfilter; /* single filter */ 492c18ce101SOliver Hartkopp struct net_device *dev = NULL; 493c18ce101SOliver Hartkopp can_err_mask_t err_mask = 0; 494c18ce101SOliver Hartkopp int count = 0; 495c18ce101SOliver Hartkopp int err = 0; 496c18ce101SOliver Hartkopp 497c18ce101SOliver Hartkopp if (level != SOL_CAN_RAW) 498c18ce101SOliver Hartkopp return -EINVAL; 499c18ce101SOliver Hartkopp 500c18ce101SOliver Hartkopp switch (optname) { 501c18ce101SOliver Hartkopp case CAN_RAW_FILTER: 502c18ce101SOliver Hartkopp if (optlen % sizeof(struct can_filter) != 0) 503c18ce101SOliver Hartkopp return -EINVAL; 504c18ce101SOliver Hartkopp 505332b05caSMarc Kleine-Budde if (optlen > CAN_RAW_FILTER_MAX * sizeof(struct can_filter)) 506332b05caSMarc Kleine-Budde return -EINVAL; 507332b05caSMarc Kleine-Budde 508c18ce101SOliver Hartkopp count = optlen / sizeof(struct can_filter); 509c18ce101SOliver Hartkopp 510c18ce101SOliver Hartkopp if (count > 1) { 511c18ce101SOliver Hartkopp /* filter does not fit into dfilter => alloc space */ 512a7b75c5aSChristoph Hellwig filter = memdup_sockptr(optval, optlen); 51316dff918SJulia Lawall if (IS_ERR(filter)) 51416dff918SJulia Lawall return PTR_ERR(filter); 515c18ce101SOliver Hartkopp } else if (count == 1) { 516a7b75c5aSChristoph Hellwig if (copy_from_sockptr(&sfilter, optval, sizeof(sfilter))) 5173f91bd42SSam Ravnborg return -EFAULT; 518c18ce101SOliver Hartkopp } 519c18ce101SOliver Hartkopp 520c18ce101SOliver Hartkopp lock_sock(sk); 521c18ce101SOliver Hartkopp 522c18ce101SOliver Hartkopp if (ro->bound && ro->ifindex) 5238e8cda6dSMario Kicherer dev = dev_get_by_index(sock_net(sk), ro->ifindex); 524c18ce101SOliver Hartkopp 525c18ce101SOliver Hartkopp if (ro->bound) { 526c18ce101SOliver Hartkopp /* (try to) register the new filters */ 527c18ce101SOliver Hartkopp if (count == 1) 5288e8cda6dSMario Kicherer err = raw_enable_filters(sock_net(sk), dev, sk, 5298e8cda6dSMario Kicherer &sfilter, 1); 530c18ce101SOliver Hartkopp else 5318e8cda6dSMario Kicherer err = raw_enable_filters(sock_net(sk), dev, sk, 5328e8cda6dSMario Kicherer filter, count); 533c18ce101SOliver Hartkopp if (err) { 534c18ce101SOliver Hartkopp if (count > 1) 535c18ce101SOliver Hartkopp kfree(filter); 536c18ce101SOliver Hartkopp goto out_fil; 537c18ce101SOliver Hartkopp } 538c18ce101SOliver Hartkopp 539c18ce101SOliver Hartkopp /* remove old filter registrations */ 5408e8cda6dSMario Kicherer raw_disable_filters(sock_net(sk), dev, sk, ro->filter, 5418e8cda6dSMario Kicherer ro->count); 542c18ce101SOliver Hartkopp } 543c18ce101SOliver Hartkopp 544c18ce101SOliver Hartkopp /* remove old filter space */ 545c18ce101SOliver Hartkopp if (ro->count > 1) 546c18ce101SOliver Hartkopp kfree(ro->filter); 547c18ce101SOliver Hartkopp 548c18ce101SOliver Hartkopp /* link new filters to the socket */ 549c18ce101SOliver Hartkopp if (count == 1) { 550c18ce101SOliver Hartkopp /* copy filter data for single filter */ 551c18ce101SOliver Hartkopp ro->dfilter = sfilter; 552c18ce101SOliver Hartkopp filter = &ro->dfilter; 553c18ce101SOliver Hartkopp } 554c18ce101SOliver Hartkopp ro->filter = filter; 555c18ce101SOliver Hartkopp ro->count = count; 556c18ce101SOliver Hartkopp 557c18ce101SOliver Hartkopp out_fil: 558c18ce101SOliver Hartkopp if (dev) 559c18ce101SOliver Hartkopp dev_put(dev); 560c18ce101SOliver Hartkopp 561c18ce101SOliver Hartkopp release_sock(sk); 562c18ce101SOliver Hartkopp 563c18ce101SOliver Hartkopp break; 564c18ce101SOliver Hartkopp 565c18ce101SOliver Hartkopp case CAN_RAW_ERR_FILTER: 566c18ce101SOliver Hartkopp if (optlen != sizeof(err_mask)) 567c18ce101SOliver Hartkopp return -EINVAL; 568c18ce101SOliver Hartkopp 569a7b75c5aSChristoph Hellwig if (copy_from_sockptr(&err_mask, optval, optlen)) 5703f91bd42SSam Ravnborg return -EFAULT; 571c18ce101SOliver Hartkopp 572c18ce101SOliver Hartkopp err_mask &= CAN_ERR_MASK; 573c18ce101SOliver Hartkopp 574c18ce101SOliver Hartkopp lock_sock(sk); 575c18ce101SOliver Hartkopp 576c18ce101SOliver Hartkopp if (ro->bound && ro->ifindex) 5778e8cda6dSMario Kicherer dev = dev_get_by_index(sock_net(sk), ro->ifindex); 578c18ce101SOliver Hartkopp 579c18ce101SOliver Hartkopp /* remove current error mask */ 580c18ce101SOliver Hartkopp if (ro->bound) { 581c18ce101SOliver Hartkopp /* (try to) register the new err_mask */ 5828e8cda6dSMario Kicherer err = raw_enable_errfilter(sock_net(sk), dev, sk, 5838e8cda6dSMario Kicherer err_mask); 584c18ce101SOliver Hartkopp 585c18ce101SOliver Hartkopp if (err) 586c18ce101SOliver Hartkopp goto out_err; 587c18ce101SOliver Hartkopp 588c18ce101SOliver Hartkopp /* remove old err_mask registration */ 5898e8cda6dSMario Kicherer raw_disable_errfilter(sock_net(sk), dev, sk, 5908e8cda6dSMario Kicherer ro->err_mask); 591c18ce101SOliver Hartkopp } 592c18ce101SOliver Hartkopp 593c18ce101SOliver Hartkopp /* link new err_mask to the socket */ 594c18ce101SOliver Hartkopp ro->err_mask = err_mask; 595c18ce101SOliver Hartkopp 596c18ce101SOliver Hartkopp out_err: 597c18ce101SOliver Hartkopp if (dev) 598c18ce101SOliver Hartkopp dev_put(dev); 599c18ce101SOliver Hartkopp 600c18ce101SOliver Hartkopp release_sock(sk); 601c18ce101SOliver Hartkopp 602c18ce101SOliver Hartkopp break; 603c18ce101SOliver Hartkopp 604c18ce101SOliver Hartkopp case CAN_RAW_LOOPBACK: 605c18ce101SOliver Hartkopp if (optlen != sizeof(ro->loopback)) 606c18ce101SOliver Hartkopp return -EINVAL; 607c18ce101SOliver Hartkopp 608a7b75c5aSChristoph Hellwig if (copy_from_sockptr(&ro->loopback, optval, optlen)) 6093f91bd42SSam Ravnborg return -EFAULT; 610c18ce101SOliver Hartkopp 611c18ce101SOliver Hartkopp break; 612c18ce101SOliver Hartkopp 613c18ce101SOliver Hartkopp case CAN_RAW_RECV_OWN_MSGS: 614c18ce101SOliver Hartkopp if (optlen != sizeof(ro->recv_own_msgs)) 615c18ce101SOliver Hartkopp return -EINVAL; 616c18ce101SOliver Hartkopp 617a7b75c5aSChristoph Hellwig if (copy_from_sockptr(&ro->recv_own_msgs, optval, optlen)) 6183f91bd42SSam Ravnborg return -EFAULT; 619c18ce101SOliver Hartkopp 620c18ce101SOliver Hartkopp break; 621c18ce101SOliver Hartkopp 622e2d265d3SOliver Hartkopp case CAN_RAW_FD_FRAMES: 623e2d265d3SOliver Hartkopp if (optlen != sizeof(ro->fd_frames)) 624e2d265d3SOliver Hartkopp return -EINVAL; 625e2d265d3SOliver Hartkopp 626a7b75c5aSChristoph Hellwig if (copy_from_sockptr(&ro->fd_frames, optval, optlen)) 627e2d265d3SOliver Hartkopp return -EFAULT; 628e2d265d3SOliver Hartkopp 629e2d265d3SOliver Hartkopp break; 630e2d265d3SOliver Hartkopp 631a5581ef4SOliver Hartkopp case CAN_RAW_JOIN_FILTERS: 632a5581ef4SOliver Hartkopp if (optlen != sizeof(ro->join_filters)) 633a5581ef4SOliver Hartkopp return -EINVAL; 634a5581ef4SOliver Hartkopp 635a7b75c5aSChristoph Hellwig if (copy_from_sockptr(&ro->join_filters, optval, optlen)) 636a5581ef4SOliver Hartkopp return -EFAULT; 637a5581ef4SOliver Hartkopp 638a5581ef4SOliver Hartkopp break; 639a5581ef4SOliver Hartkopp 640c18ce101SOliver Hartkopp default: 641c18ce101SOliver Hartkopp return -ENOPROTOOPT; 642c18ce101SOliver Hartkopp } 643c18ce101SOliver Hartkopp return err; 644c18ce101SOliver Hartkopp } 645c18ce101SOliver Hartkopp 646c18ce101SOliver Hartkopp static int raw_getsockopt(struct socket *sock, int level, int optname, 647c18ce101SOliver Hartkopp char __user *optval, int __user *optlen) 648c18ce101SOliver Hartkopp { 649c18ce101SOliver Hartkopp struct sock *sk = sock->sk; 650c18ce101SOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 651c18ce101SOliver Hartkopp int len; 652c18ce101SOliver Hartkopp void *val; 653c18ce101SOliver Hartkopp int err = 0; 654c18ce101SOliver Hartkopp 655c18ce101SOliver Hartkopp if (level != SOL_CAN_RAW) 656c18ce101SOliver Hartkopp return -EINVAL; 657c18ce101SOliver Hartkopp if (get_user(len, optlen)) 658c18ce101SOliver Hartkopp return -EFAULT; 659c18ce101SOliver Hartkopp if (len < 0) 660c18ce101SOliver Hartkopp return -EINVAL; 661c18ce101SOliver Hartkopp 662c18ce101SOliver Hartkopp switch (optname) { 663c18ce101SOliver Hartkopp case CAN_RAW_FILTER: 664c18ce101SOliver Hartkopp lock_sock(sk); 665c18ce101SOliver Hartkopp if (ro->count > 0) { 666c18ce101SOliver Hartkopp int fsize = ro->count * sizeof(struct can_filter); 667d5e4ecacSMarc Kleine-Budde 668c18ce101SOliver Hartkopp if (len > fsize) 669c18ce101SOliver Hartkopp len = fsize; 670653252c2SPavel Emelyanov if (copy_to_user(optval, ro->filter, len)) 671653252c2SPavel Emelyanov err = -EFAULT; 672bff10040SMarc Kleine-Budde } else { 673c18ce101SOliver Hartkopp len = 0; 674bff10040SMarc Kleine-Budde } 675c18ce101SOliver Hartkopp release_sock(sk); 676c18ce101SOliver Hartkopp 677c18ce101SOliver Hartkopp if (!err) 678c18ce101SOliver Hartkopp err = put_user(len, optlen); 679c18ce101SOliver Hartkopp return err; 680c18ce101SOliver Hartkopp 681c18ce101SOliver Hartkopp case CAN_RAW_ERR_FILTER: 682c18ce101SOliver Hartkopp if (len > sizeof(can_err_mask_t)) 683c18ce101SOliver Hartkopp len = sizeof(can_err_mask_t); 684c18ce101SOliver Hartkopp val = &ro->err_mask; 685c18ce101SOliver Hartkopp break; 686c18ce101SOliver Hartkopp 687c18ce101SOliver Hartkopp case CAN_RAW_LOOPBACK: 688c18ce101SOliver Hartkopp if (len > sizeof(int)) 689c18ce101SOliver Hartkopp len = sizeof(int); 690c18ce101SOliver Hartkopp val = &ro->loopback; 691c18ce101SOliver Hartkopp break; 692c18ce101SOliver Hartkopp 693c18ce101SOliver Hartkopp case CAN_RAW_RECV_OWN_MSGS: 694c18ce101SOliver Hartkopp if (len > sizeof(int)) 695c18ce101SOliver Hartkopp len = sizeof(int); 696c18ce101SOliver Hartkopp val = &ro->recv_own_msgs; 697c18ce101SOliver Hartkopp break; 698c18ce101SOliver Hartkopp 699e2d265d3SOliver Hartkopp case CAN_RAW_FD_FRAMES: 700e2d265d3SOliver Hartkopp if (len > sizeof(int)) 701e2d265d3SOliver Hartkopp len = sizeof(int); 702e2d265d3SOliver Hartkopp val = &ro->fd_frames; 703e2d265d3SOliver Hartkopp break; 704e2d265d3SOliver Hartkopp 705a5581ef4SOliver Hartkopp case CAN_RAW_JOIN_FILTERS: 706a5581ef4SOliver Hartkopp if (len > sizeof(int)) 707a5581ef4SOliver Hartkopp len = sizeof(int); 708a5581ef4SOliver Hartkopp val = &ro->join_filters; 709a5581ef4SOliver Hartkopp break; 710a5581ef4SOliver Hartkopp 711c18ce101SOliver Hartkopp default: 712c18ce101SOliver Hartkopp return -ENOPROTOOPT; 713c18ce101SOliver Hartkopp } 714c18ce101SOliver Hartkopp 715c18ce101SOliver Hartkopp if (put_user(len, optlen)) 716c18ce101SOliver Hartkopp return -EFAULT; 717c18ce101SOliver Hartkopp if (copy_to_user(optval, val, len)) 718c18ce101SOliver Hartkopp return -EFAULT; 719c18ce101SOliver Hartkopp return 0; 720c18ce101SOliver Hartkopp } 721c18ce101SOliver Hartkopp 7221b784140SYing Xue static int raw_sendmsg(struct socket *sock, struct msghdr *msg, size_t size) 723c18ce101SOliver Hartkopp { 724c18ce101SOliver Hartkopp struct sock *sk = sock->sk; 725c18ce101SOliver Hartkopp struct raw_sock *ro = raw_sk(sk); 726c18ce101SOliver Hartkopp struct sk_buff *skb; 727c18ce101SOliver Hartkopp struct net_device *dev; 728c18ce101SOliver Hartkopp int ifindex; 729c18ce101SOliver Hartkopp int err; 730c18ce101SOliver Hartkopp 731c18ce101SOliver Hartkopp if (msg->msg_name) { 732342dfc30SSteffen Hurrle DECLARE_SOCKADDR(struct sockaddr_can *, addr, msg->msg_name); 733c18ce101SOliver Hartkopp 7349868b5d4SKurt Van Dijck if (msg->msg_namelen < CAN_REQUIRED_SIZE(*addr, can_ifindex)) 7355e507328SKurt Van Dijck return -EINVAL; 7365e507328SKurt Van Dijck 737c18ce101SOliver Hartkopp if (addr->can_family != AF_CAN) 738c18ce101SOliver Hartkopp return -EINVAL; 739c18ce101SOliver Hartkopp 740c18ce101SOliver Hartkopp ifindex = addr->can_ifindex; 741bff10040SMarc Kleine-Budde } else { 742c18ce101SOliver Hartkopp ifindex = ro->ifindex; 743bff10040SMarc Kleine-Budde } 744c18ce101SOliver Hartkopp 7458e8cda6dSMario Kicherer dev = dev_get_by_index(sock_net(sk), ifindex); 746c18ce101SOliver Hartkopp if (!dev) 747c18ce101SOliver Hartkopp return -ENXIO; 748c18ce101SOliver Hartkopp 749a43608faSOliver Hartkopp err = -EINVAL; 750a43608faSOliver Hartkopp if (ro->fd_frames && dev->mtu == CANFD_MTU) { 751a43608faSOliver Hartkopp if (unlikely(size != CANFD_MTU && size != CAN_MTU)) 752a43608faSOliver Hartkopp goto put_dev; 753a43608faSOliver Hartkopp } else { 754a43608faSOliver Hartkopp if (unlikely(size != CAN_MTU)) 755a43608faSOliver Hartkopp goto put_dev; 756a43608faSOliver Hartkopp } 757a43608faSOliver Hartkopp 758156c2bb9SOliver Hartkopp skb = sock_alloc_send_skb(sk, size + sizeof(struct can_skb_priv), 759156c2bb9SOliver Hartkopp msg->msg_flags & MSG_DONTWAIT, &err); 760ebad5c09SIlpo Järvinen if (!skb) 761ebad5c09SIlpo Järvinen goto put_dev; 762c18ce101SOliver Hartkopp 7632bf3440dSOliver Hartkopp can_skb_reserve(skb); 7642bf3440dSOliver Hartkopp can_skb_prv(skb)->ifindex = dev->ifindex; 765d3b58c47SOliver Hartkopp can_skb_prv(skb)->skbcnt = 0; 766156c2bb9SOliver Hartkopp 7676ce8e9ceSAl Viro err = memcpy_from_msg(skb_put(skb, size), msg, size); 768ebad5c09SIlpo Järvinen if (err < 0) 769ebad5c09SIlpo Järvinen goto free_skb; 770bf84a010SDaniel Borkmann 7718f932f76SWillem de Bruijn skb_setup_tx_timestamp(skb, sk->sk_tsflags); 772cff0d6e6SOliver Hartkopp 773c18ce101SOliver Hartkopp skb->dev = dev; 774c18ce101SOliver Hartkopp skb->sk = sk; 775bb5ecb0cSRostislav Lisovy skb->priority = sk->sk_priority; 776c18ce101SOliver Hartkopp 777c18ce101SOliver Hartkopp err = can_send(skb, ro->loopback); 778c18ce101SOliver Hartkopp 779c18ce101SOliver Hartkopp dev_put(dev); 780c18ce101SOliver Hartkopp 781c18ce101SOliver Hartkopp if (err) 782ebad5c09SIlpo Järvinen goto send_failed; 783c18ce101SOliver Hartkopp 784c18ce101SOliver Hartkopp return size; 785ebad5c09SIlpo Järvinen 786ebad5c09SIlpo Järvinen free_skb: 787ebad5c09SIlpo Järvinen kfree_skb(skb); 788ebad5c09SIlpo Järvinen put_dev: 789ebad5c09SIlpo Järvinen dev_put(dev); 790ebad5c09SIlpo Järvinen send_failed: 791ebad5c09SIlpo Järvinen return err; 792c18ce101SOliver Hartkopp } 793c18ce101SOliver Hartkopp 7941b784140SYing Xue static int raw_recvmsg(struct socket *sock, struct msghdr *msg, size_t size, 7951b784140SYing Xue int flags) 796c18ce101SOliver Hartkopp { 797c18ce101SOliver Hartkopp struct sock *sk = sock->sk; 798c18ce101SOliver Hartkopp struct sk_buff *skb; 799a219994bSUrs Thuermann int err = 0; 800c18ce101SOliver Hartkopp int noblock; 801c18ce101SOliver Hartkopp 802c18ce101SOliver Hartkopp noblock = flags & MSG_DONTWAIT; 803c18ce101SOliver Hartkopp flags &= ~MSG_DONTWAIT; 804c18ce101SOliver Hartkopp 805eb88531bSVincent Mailhol if (flags & MSG_ERRQUEUE) 806eb88531bSVincent Mailhol return sock_recv_errqueue(sk, msg, size, 807eb88531bSVincent Mailhol SOL_CAN_RAW, SCM_CAN_RAW_ERRQUEUE); 808eb88531bSVincent Mailhol 809a219994bSUrs Thuermann skb = skb_recv_datagram(sk, flags, noblock, &err); 810c18ce101SOliver Hartkopp if (!skb) 811a219994bSUrs Thuermann return err; 812c18ce101SOliver Hartkopp 813821047c4SOliver Hartkopp if (size < skb->len) 814c18ce101SOliver Hartkopp msg->msg_flags |= MSG_TRUNC; 815c18ce101SOliver Hartkopp else 816821047c4SOliver Hartkopp size = skb->len; 817c18ce101SOliver Hartkopp 8187eab8d9eSAl Viro err = memcpy_to_msg(msg, skb->data, size); 819a219994bSUrs Thuermann if (err < 0) { 820c18ce101SOliver Hartkopp skb_free_datagram(sk, skb); 821a219994bSUrs Thuermann return err; 822c18ce101SOliver Hartkopp } 823c18ce101SOliver Hartkopp 8243b885787SNeil Horman sock_recv_ts_and_drops(msg, sk, skb); 825c18ce101SOliver Hartkopp 826c18ce101SOliver Hartkopp if (msg->msg_name) { 827342dfc30SSteffen Hurrle __sockaddr_check_size(sizeof(struct sockaddr_can)); 828c18ce101SOliver Hartkopp msg->msg_namelen = sizeof(struct sockaddr_can); 829c18ce101SOliver Hartkopp memcpy(msg->msg_name, skb->cb, msg->msg_namelen); 830c18ce101SOliver Hartkopp } 831c18ce101SOliver Hartkopp 8321e55659cSOliver Hartkopp /* assign the flags that have been recorded in raw_rcv() */ 8331e55659cSOliver Hartkopp msg->msg_flags |= *(raw_flags(skb)); 8341e55659cSOliver Hartkopp 835c18ce101SOliver Hartkopp skb_free_datagram(sk, skb); 836c18ce101SOliver Hartkopp 837c18ce101SOliver Hartkopp return size; 838c18ce101SOliver Hartkopp } 839c18ce101SOliver Hartkopp 840af0b1470SMarc Kleine-Budde static int raw_sock_no_ioctlcmd(struct socket *sock, unsigned int cmd, 841473d924dSOliver Hartkopp unsigned long arg) 842473d924dSOliver Hartkopp { 843473d924dSOliver Hartkopp /* no ioctls for socket layer -> hand it down to NIC layer */ 844473d924dSOliver Hartkopp return -ENOIOCTLCMD; 845473d924dSOliver Hartkopp } 846473d924dSOliver Hartkopp 84753914b67SOliver Hartkopp static const struct proto_ops raw_ops = { 848c18ce101SOliver Hartkopp .family = PF_CAN, 849c18ce101SOliver Hartkopp .release = raw_release, 850c18ce101SOliver Hartkopp .bind = raw_bind, 851c18ce101SOliver Hartkopp .connect = sock_no_connect, 852c18ce101SOliver Hartkopp .socketpair = sock_no_socketpair, 853c18ce101SOliver Hartkopp .accept = sock_no_accept, 854c18ce101SOliver Hartkopp .getname = raw_getname, 855a11e1d43SLinus Torvalds .poll = datagram_poll, 856473d924dSOliver Hartkopp .ioctl = raw_sock_no_ioctlcmd, 857c7cbdbf2SArnd Bergmann .gettstamp = sock_gettstamp, 858c18ce101SOliver Hartkopp .listen = sock_no_listen, 859c18ce101SOliver Hartkopp .shutdown = sock_no_shutdown, 860c18ce101SOliver Hartkopp .setsockopt = raw_setsockopt, 861c18ce101SOliver Hartkopp .getsockopt = raw_getsockopt, 862c18ce101SOliver Hartkopp .sendmsg = raw_sendmsg, 863c18ce101SOliver Hartkopp .recvmsg = raw_recvmsg, 864c18ce101SOliver Hartkopp .mmap = sock_no_mmap, 865c18ce101SOliver Hartkopp .sendpage = sock_no_sendpage, 866c18ce101SOliver Hartkopp }; 867c18ce101SOliver Hartkopp 868c18ce101SOliver Hartkopp static struct proto raw_proto __read_mostly = { 869c18ce101SOliver Hartkopp .name = "CAN_RAW", 870c18ce101SOliver Hartkopp .owner = THIS_MODULE, 871c18ce101SOliver Hartkopp .obj_size = sizeof(struct raw_sock), 872c18ce101SOliver Hartkopp .init = raw_init, 873c18ce101SOliver Hartkopp }; 874c18ce101SOliver Hartkopp 8751650629dSKurt Van Dijck static const struct can_proto raw_can_proto = { 876c18ce101SOliver Hartkopp .type = SOCK_RAW, 877c18ce101SOliver Hartkopp .protocol = CAN_RAW, 878c18ce101SOliver Hartkopp .ops = &raw_ops, 879c18ce101SOliver Hartkopp .prot = &raw_proto, 880c18ce101SOliver Hartkopp }; 881c18ce101SOliver Hartkopp 882c18ce101SOliver Hartkopp static __init int raw_module_init(void) 883c18ce101SOliver Hartkopp { 884c18ce101SOliver Hartkopp int err; 885c18ce101SOliver Hartkopp 886*f726f3d3SOliver Hartkopp pr_info("can: raw protocol\n"); 887c18ce101SOliver Hartkopp 888c18ce101SOliver Hartkopp err = can_proto_register(&raw_can_proto); 889c18ce101SOliver Hartkopp if (err < 0) 890d956b1a8SMarc Kleine-Budde pr_err("can: registration of raw protocol failed\n"); 891c18ce101SOliver Hartkopp 892c18ce101SOliver Hartkopp return err; 893c18ce101SOliver Hartkopp } 894c18ce101SOliver Hartkopp 895c18ce101SOliver Hartkopp static __exit void raw_module_exit(void) 896c18ce101SOliver Hartkopp { 897c18ce101SOliver Hartkopp can_proto_unregister(&raw_can_proto); 898c18ce101SOliver Hartkopp } 899c18ce101SOliver Hartkopp 900c18ce101SOliver Hartkopp module_init(raw_module_init); 901c18ce101SOliver Hartkopp module_exit(raw_module_exit); 902