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 = raw_sk(sk);
 337
 338         unregister_netdevice_notifier(&ro->notifier);
 339
 340         lock_sock(sk);
 341
 342         /* remove current filters & unregister */
 343         if (ro->bound) {
 344                 if (ro->ifindex) {
 345                         struct net_device *dev;
 346
 347                         dev = dev_get_by_index(&init_net, ro->ifindex);
 348                         if (dev) {
 349                                 raw_disable_allfilters(dev, sk);
 350                                 dev_put(dev);
 351                         }
 352                 } else
 353                         raw_disable_allfilters(NULL, sk);
 354         }
 355
 356         if (ro->count > 1)
 357                 kfree(ro->filter);
 358
 359         ro->ifindex = 0;
 360         ro->bound   = 0;
 361         ro->count   = 0;
 362
 363         sock_orphan(sk);
 364         sock->sk = NULL;
 365
 366         release_sock(sk);
 367         sock_put(sk);
 368
 369         return 0;
 370 }
 371
 372 static int raw_bind(struct socket *sock, struct sockaddr *uaddr, int len)
 373 {
 374         struct sockaddr_can *addr = (struct sockaddr_can *)uaddr;
 375         struct sock *sk = sock->sk;
 376         struct raw_sock *ro = raw_sk(sk);
 377         int ifindex;
 378         int err = 0;
 379         int notify_enetdown = 0;
 380
 381         if (len < sizeof(*addr))
 382                 return -EINVAL;
 383
 384         lock_sock(sk);
 385
 386         if (ro->bound && addr->can_ifindex == ro->ifindex)
 387                 goto out;
 388
 389         if (addr->can_ifindex) {
 390                 struct net_device *dev;
 391
 392                 dev = dev_get_by_index(&init_net, addr->can_ifindex);
 393                 if (!dev) {
 394                         err = -ENODEV;
 395                         goto out;
 396                 }
 397                 if (dev->type != ARPHRD_CAN) {
 398                         dev_put(dev);
 399                         err = -ENODEV;
 400                         goto out;
 401                 }
 402                 if (!(dev->flags & IFF_UP))
 403                         notify_enetdown = 1;
 404
 405                 ifindex = dev->ifindex;
 406
 407                 /* filters set by default/setsockopt */
 408                 err = raw_enable_allfilters(dev, sk);
 409                 dev_put(dev);
 410         } else {
 411                 ifindex = 0;
 412
 413                 /* filters set by default/setsockopt */
 414                 err = raw_enable_allfilters(NULL, sk);
 415         }
 416
 417         if (!err) {
 418                 if (ro->bound) {
 419                         /* unregister old filters */
 420                         if (ro->ifindex) {
 421                                 struct net_device *dev;
 422
 423                                 dev = dev_get_by_index(&init_net, ro->ifindex);
 424                                 if (dev) {
 425                                         raw_disable_allfilters(dev, sk);
 426                                         dev_put(dev);
 427                                 }
 428                         } else
 429                                 raw_disable_allfilters(NULL, sk);
 430                 }
 431                 ro->ifindex = ifindex;
 432                 ro->bound = 1;
 433         }
 434
 435  out:
 436         release_sock(sk);
 437
 438         if (notify_enetdown) {
 439                 sk->sk_err = ENETDOWN;
 440                 if (!sock_flag(sk, SOCK_DEAD))
 441                         sk->sk_error_report(sk);
 442         }
 443
 444         return err;
 445 }
 446
 447 static int raw_getname(struct socket *sock, struct sockaddr *uaddr,
 448                        int *len, int peer)
 449 {
 450         struct sockaddr_can *addr = (struct sockaddr_can *)uaddr;
 451         struct sock *sk = sock->sk;
 452         struct raw_sock *ro = raw_sk(sk);
 453
 454         if (peer)
 455                 return -EOPNOTSUPP;
 456
 457         addr->can_family  = AF_CAN;
 458         addr->can_ifindex = ro->ifindex;
 459
 460         *len = sizeof(*addr);
 461
 462         return 0;
 463 }
 464
 465 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,32)
 466 static int raw_setsockopt(struct socket *sock, int level, int optname,
 467                           char __user *optval, unsigned int optlen)
 468 #else
 469 static int raw_setsockopt(struct socket *sock, int level, int optname,
 470                           char __user *optval, int optlen)
 471 #endif
 472 {
 473         struct sock *sk = sock->sk;
 474         struct raw_sock *ro = raw_sk(sk);
 475         struct can_filter *filter = NULL;  /* dyn. alloc'ed filters */
 476         struct can_filter sfilter;         /* single filter */
 477         struct net_device *dev = NULL;
 478         can_err_mask_t err_mask = 0;
 479         int count = 0;
 480         int err = 0;
 481
 482         if (level != SOL_CAN_RAW)
 483                 return -EINVAL;
 484         if (optlen < 0)
 485                 return -EINVAL;
 486
 487         switch (optname) {
 488
 489         case CAN_RAW_FILTER:
 490                 if (optlen % sizeof(struct can_filter) != 0)
 491                         return -EINVAL;
 492
 493                 count = optlen / sizeof(struct can_filter);
 494
 495                 if (count > 1) {
 496                         /* filter does not fit into dfilter => alloc space */
 497                         filter = kmalloc(optlen, GFP_KERNEL);
 498                         if (!filter)
 499                                 return -ENOMEM;
 500
 501                         if (copy_from_user(filter, optval, optlen)) {
 502                                 kfree(filter);
 503                                 return -EFAULT;
 504                         }
 505                 } else if (count == 1) {
 506                         if (copy_from_user(&sfilter, optval, optlen))
 507                                 return -EFAULT;
 508                 }
 509
 510                 lock_sock(sk);
 511
 512                 if (ro->bound && ro->ifindex)
 513                         dev = dev_get_by_index(&init_net, ro->ifindex);
 514
 515                 if (ro->bound) {
 516                         /* (try to) register the new filters */
 517                         if (count == 1)
 518                                 err = raw_enable_filters(dev, sk, &sfilter, 1);
 519                         else
 520                                 err = raw_enable_filters(dev, sk, filter,
 521                                                          count);
 522                         if (err) {
 523                                 if (count > 1)
 524                                         kfree(filter);
 525                                 goto out_fil;
 526                         }
 527
 528                         /* remove old filter registrations */
 529                         raw_disable_filters(dev, sk, ro->filter, ro->count);
 530                 }
 531
 532                 /* remove old filter space */
 533                 if (ro->count > 1)
 534                         kfree(ro->filter);
 535
 536                 /* link new filters to the socket */
 537                 if (count == 1) {
 538                         /* copy filter data for single filter */
 539                         ro->dfilter = sfilter;
 540                         filter = &ro->dfilter;
 541                 }
 542                 ro->filter = filter;
 543                 ro->count  = count;
 544
 545  out_fil:
 546                 if (dev)
 547                         dev_put(dev);
 548
 549                 release_sock(sk);
 550
 551                 break;
 552
 553         case CAN_RAW_ERR_FILTER:
 554                 if (optlen != sizeof(err_mask))
 555                         return -EINVAL;
 556
 557                 if (copy_from_user(&err_mask, optval, optlen))
 558                         return -EFAULT;
 559
 560                 err_mask &= CAN_ERR_MASK;
 561
 562                 lock_sock(sk);
 563
 564                 if (ro->bound && ro->ifindex)
 565                         dev = dev_get_by_index(&init_net, ro->ifindex);
 566
 567                 /* remove current error mask */
 568                 if (ro->bound) {
 569                         /* (try to) register the new err_mask */
 570                         err = raw_enable_errfilter(dev, sk, err_mask);
 571
 572                         if (err)
 573                                 goto out_err;
 574
 575                         /* remove old err_mask registration */
 576                         raw_disable_errfilter(dev, sk, ro->err_mask);
 577                 }
 578
 579                 /* link new err_mask to the socket */
 580                 ro->err_mask = err_mask;
 581
 582  out_err:
 583                 if (dev)
 584                         dev_put(dev);
 585
 586                 release_sock(sk);
 587
 588                 break;
 589
 590         case CAN_RAW_LOOPBACK:
 591                 if (optlen != sizeof(ro->loopback))
 592                         return -EINVAL;
 593
 594                 if (copy_from_user(&ro->loopback, optval, optlen))
 595                         return -EFAULT;
 596
 597                 break;
 598
 599         case CAN_RAW_RECV_OWN_MSGS:
 600                 if (optlen != sizeof(ro->recv_own_msgs))
 601                         return -EINVAL;
 602
 603                 if (copy_from_user(&ro->recv_own_msgs, optval, optlen))
 604                         return -EFAULT;
 605
 606                 break;
 607
 608         default:
 609                 return -ENOPROTOOPT;
 610         }
 611         return err;
 612 }
 613
 614 static int raw_getsockopt(struct socket *sock, int level, int optname,
 615                           char __user *optval, int __user *optlen)
 616 {
 617         struct sock *sk = sock->sk;
 618         struct raw_sock *ro = raw_sk(sk);
 619         int len;
 620         void *val;
 621         int err = 0;
 622
 623         if (level != SOL_CAN_RAW)
 624                 return -EINVAL;
 625         if (get_user(len, optlen))
 626                 return -EFAULT;
 627         if (len < 0)
 628                 return -EINVAL;
 629
 630         switch (optname) {
 631
 632         case CAN_RAW_FILTER:
 633                 lock_sock(sk);
 634                 if (ro->count > 0) {
 635                         int fsize = ro->count * sizeof(struct can_filter);
 636                         if (len > fsize)
 637                                 len = fsize;
 638                         if (copy_to_user(optval, ro->filter, len))
 639                                 err = -EFAULT;
 640                 } else
 641                         len = 0;
 642                 release_sock(sk);
 643
 644                 if (!err)
 645                         err = put_user(len, optlen);
 646                 return err;
 647
 648         case CAN_RAW_ERR_FILTER:
 649                 if (len > sizeof(can_err_mask_t))
 650                         len = sizeof(can_err_mask_t);
 651                 val = &ro->err_mask;
 652                 break;
 653
 654         case CAN_RAW_LOOPBACK:
 655                 if (len > sizeof(int))
 656                         len = sizeof(int);
 657                 val = &ro->loopback;
 658                 break;
 659
 660         case CAN_RAW_RECV_OWN_MSGS:
 661                 if (len > sizeof(int))
 662                         len = sizeof(int);
 663                 val = &ro->recv_own_msgs;
 664                 break;
 665
 666         default:
 667                 return -ENOPROTOOPT;
 668         }
 669
 670         if (put_user(len, optlen))
 671                 return -EFAULT;
 672         if (copy_to_user(optval, val, len))
 673                 return -EFAULT;
 674         return 0;
 675 }
 676
 677 static int raw_sendmsg(struct kiocb *iocb, struct socket *sock,
 678                        struct msghdr *msg, size_t size)
 679 {
 680         struct sock *sk = sock->sk;
 681         struct raw_sock *ro = raw_sk(sk);
 682         struct sk_buff *skb;
 683         struct net_device *dev;
 684         int ifindex;
 685         int err;
 686
 687         if (msg->msg_name) {
 688                 struct sockaddr_can *addr =
 689                         (struct sockaddr_can *)msg->msg_name;
 690
 691                 if (msg->msg_namelen < sizeof(*addr))
 692                         return -EINVAL;
 693
 694                 if (addr->can_family != AF_CAN)
 695                         return -EINVAL;
 696
 697                 ifindex = addr->can_ifindex;
 698         } else
 699                 ifindex = ro->ifindex;
 700
 701         if (size != sizeof(struct can_frame))
 702                 return -EINVAL;
 703
 704         dev = dev_get_by_index(&init_net, ifindex);
 705         if (!dev)
 706                 return -ENXIO;
 707
 708         skb = sock_alloc_send_skb(sk, size, msg->msg_flags & MSG_DONTWAIT,
 709                                   &err);
 710         if (!skb)
 711                 goto put_dev;
 712
 713         err = memcpy_fromiovec(skb_put(skb, size), msg->msg_iov, size);
 714         if (err < 0)
 715                 goto free_skb;
 716         skb->dev = dev;
 717         skb->sk  = sk;
 718
 719         err = can_send(skb, ro->loopback);
 720
 721         dev_put(dev);
 722
 723         if (err)
 724                 goto send_failed;
 725
 726         return size;
 727
 728 free_skb:
 729         kfree_skb(skb);
 730 put_dev:
 731         dev_put(dev);
 732 send_failed:
 733         return err;
 734 }
 735
 736 static int raw_recvmsg(struct kiocb *iocb, struct socket *sock,
 737                        struct msghdr *msg, size_t size, int flags)
 738 {
 739         struct sock *sk = sock->sk;
 740         struct sk_buff *skb;
 741         int err = 0;
 742         int noblock;
 743
 744         noblock =  flags & MSG_DONTWAIT;
 745         flags   &= ~MSG_DONTWAIT;
 746
 747         skb = skb_recv_datagram(sk, flags, noblock, &err);
 748         if (!skb)
 749                 return err;
 750
 751         if (size < skb->len)
 752                 msg->msg_flags |= MSG_TRUNC;
 753         else
 754                 size = skb->len;
 755
 756         err = memcpy_toiovec(msg->msg_iov, skb->data, size);
 757         if (err < 0) {
 758                 skb_free_datagram(sk, skb);
 759                 return err;
 760         }
 761
 762         sock_recv_timestamp(msg, sk, skb);
 763
 764         if (msg->msg_name) {
 765                 msg->msg_namelen = sizeof(struct sockaddr_can);
 766                 memcpy(msg->msg_name, skb->cb, msg->msg_namelen);
 767         }
 768
 769         /* assign the flags that have been recorded in raw_rcv() */
 770         msg->msg_flags |= *(raw_flags(skb));
 771
 772         skb_free_datagram(sk, skb);
 773
 774         return size;
 775 }
 776
 777 static const struct proto_ops raw_ops = {
 778         .family        = PF_CAN,
 779         .release       = raw_release,
 780         .bind          = raw_bind,
 781         .connect       = sock_no_connect,
 782         .socketpair    = sock_no_socketpair,
 783         .accept        = sock_no_accept,
 784         .getname       = raw_getname,
 785         .poll          = datagram_poll,
 786         .ioctl         = can_ioctl,     /* use can_ioctl() from af_can.c */
 787         .listen        = sock_no_listen,
 788         .shutdown      = sock_no_shutdown,
 789         .setsockopt    = raw_setsockopt,
 790         .getsockopt    = raw_getsockopt,
 791         .sendmsg       = raw_sendmsg,
 792         .recvmsg       = raw_recvmsg,
 793         .mmap          = sock_no_mmap,
 794         .sendpage      = sock_no_sendpage,
 795 };
 796
 797
 798 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,33)
 799 static struct proto raw_proto __read_mostly = {
 800         .name       = "CAN_RAW",
 801         .owner      = THIS_MODULE,
 802         .obj_size   = sizeof(struct raw_sock),
 803         .init       = raw_init,
 804 };
 805
 806 static struct can_proto raw_can_proto __read_mostly = {
 807         .type       = SOCK_RAW,
 808         .protocol   = CAN_RAW,
 809         .ops        = &raw_ops,
 810         .prot       = &raw_proto,
 811 };
 812 #elif LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,12)
 813 static struct proto raw_proto __read_mostly = {
 814         .name       = "CAN_RAW",
 815         .owner      = THIS_MODULE,
 816         .obj_size   = sizeof(struct raw_sock),
 817         .init       = raw_init,
 818 };
 819
 820 static struct can_proto raw_can_proto __read_mostly = {
 821         .type       = SOCK_RAW,
 822         .protocol   = CAN_RAW,
 823         .capability = -1,
 824         .ops        = &raw_ops,
 825         .prot       = &raw_proto,
 826 };
 827 #else
 828 static struct can_proto raw_can_proto __read_mostly = {
 829         .type       = SOCK_RAW,
 830         .protocol   = CAN_RAW,
 831         .capability = -1,
 832         .ops        = &raw_ops,
 833         .owner      = THIS_MODULE,
 834         .obj_size   = sizeof(struct raw_sock),
 835         .init       = raw_init,
 836 };
 837 #endif
 838
 839 static __init int raw_module_init(void)
 840 {
 841         int err;
 842
 843         printk(banner);
 844
 845         err = can_proto_register(&raw_can_proto);
 846         if (err < 0)
 847                 printk(KERN_ERR "can: registration of raw protocol failed\n");
 848
 849         return err;
 850 }
 851
 852 static __exit void raw_module_exit(void)
 853 {
 854         can_proto_unregister(&raw_can_proto);
 855 }
 856
 857 module_init(raw_module_init);
 858 module_exit(raw_module_exit);