kernel/2.6/net/can/raw.c

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