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 <linux/can.h>
  54 #include <linux/can/core.h>
  55 #include <linux/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 <linux/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
  75 #define MASK_ALL 0
  76
  77 /*
  78  * A raw socket has a list of can_filters attached to it, each receiving
  79  * the CAN frames matching that filter.  If the filter list is empty,
  80  * no CAN frames will be received by the socket.  The default after
  81  * opening the socket, is to have one filter which receives all frames.
  82  * The filter list is allocated dynamically with the exception of the
  83  * list containing only one item.  This common case is optimized by
  84  * storing the single filter in dfilter, to avoid using dynamic memory.
  85  */
  86
  87 struct raw_sock {
  88 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,12)
  89         struct sock sk;
  90 #else
  91         struct sock *sk;
  92 #endif
  93         int bound;
  94         int ifindex;
  95         struct notifier_block notifier;
  96         int loopback;
  97         int recv_own_msgs;
  98         int count;                 /* number of active filters */
  99         struct can_filter dfilter; /* default/single filter */
 100         struct can_filter *filter; /* pointer to filter(s) */
 101         can_err_mask_t err_mask;
 102 };
 103
 104 static inline struct raw_sock *raw_sk(const struct sock *sk)
 105 {
 106 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,12)
 107         return (struct raw_sock *)sk;
 108 #else
 109         return (struct raw_sock *)sk->sk_protinfo;
 110 #endif
 111 }
 112
 113 static void raw_rcv(struct sk_buff *skb, void *data)
 114 {
 115         struct sock *sk = (struct sock *)data;
 116         struct raw_sock *ro = raw_sk(sk);
 117         struct sockaddr_can *addr;
 118
 119         /* check the received tx sock reference */
 120         if ((!ro->recv_own_msgs) && (skb->sk == sk))
 121                 return;
 122
 123         /* clone the given skb to be able to enqueue it into the rcv queue */
 124         skb = skb_clone(skb, GFP_ATOMIC);
 125         if (!skb)
 126                 return;
 127
 128         /*
 129          *  Put the datagram to the queue so that raw_recvmsg() can
 130          *  get it from there.  We need to pass the interface index to
 131          *  raw_recvmsg().  We pass a whole struct sockaddr_can in skb->cb
 132          *  containing the interface index.
 133          */
 134
 135         BUILD_BUG_ON(sizeof(skb->cb) < sizeof(struct sockaddr_can));
 136         addr = (struct sockaddr_can *)skb->cb;
 137         memset(addr, 0, sizeof(*addr));
 138         addr->can_family  = AF_CAN;
 139         addr->can_ifindex = skb->dev->ifindex;
 140
 141         if (sock_queue_rcv_skb(sk, skb) < 0)
 142                 kfree_skb(skb);
 143 }
 144
 145 static int raw_enable_filters(struct net_device *dev, struct sock *sk,
 146                               struct can_filter *filter, int count)
 147 {
 148         int err = 0;
 149         int i;
 150
 151         for (i = 0; i < count; i++) {
 152                 err = can_rx_register(dev, filter[i].can_id,
 153                                       filter[i].can_mask,
 154                                       raw_rcv, sk, "raw");
 155                 if (err) {
 156                         /* clean up successfully registered filters */
 157                         while (--i >= 0)
 158                                 can_rx_unregister(dev, filter[i].can_id,
 159                                                   filter[i].can_mask,
 160                                                   raw_rcv, sk);
 161                         break;
 162                 }
 163         }
 164
 165         return err;
 166 }
 167
 168 static int raw_enable_errfilter(struct net_device *dev, struct sock *sk,
 169                                 can_err_mask_t err_mask)
 170 {
 171         int err = 0;
 172
 173         if (err_mask)
 174                 err = can_rx_register(dev, 0, err_mask | CAN_ERR_FLAG,
 175                                       raw_rcv, sk, "raw");
 176
 177         return err;
 178 }
 179
 180 static void raw_disable_filters(struct net_device *dev, struct sock *sk,
 181                               struct can_filter *filter, int count)
 182 {
 183         int i;
 184
 185         for (i = 0; i < count; i++)
 186                 can_rx_unregister(dev, filter[i].can_id, filter[i].can_mask,
 187                                   raw_rcv, sk);
 188 }
 189
 190 static inline void raw_disable_errfilter(struct net_device *dev,
 191                                          struct sock *sk,
 192                                          can_err_mask_t err_mask)
 193
 194 {
 195         if (err_mask)
 196                 can_rx_unregister(dev, 0, err_mask | CAN_ERR_FLAG,
 197                                   raw_rcv, sk);
 198 }
 199
 200 static inline void raw_disable_allfilters(struct net_device *dev,
 201                                           struct sock *sk)
 202 {
 203         struct raw_sock *ro = raw_sk(sk);
 204
 205         raw_disable_filters(dev, sk, ro->filter, ro->count);
 206         raw_disable_errfilter(dev, sk, ro->err_mask);
 207 }
 208
 209 static int raw_enable_allfilters(struct net_device *dev, struct sock *sk)
 210 {
 211         struct raw_sock *ro = raw_sk(sk);
 212         int err;
 213
 214         err = raw_enable_filters(dev, sk, ro->filter, ro->count);
 215         if (!err) {
 216                 err = raw_enable_errfilter(dev, sk, ro->err_mask);
 217                 if (err)
 218                         raw_disable_filters(dev, sk, ro->filter, ro->count);
 219         }
 220
 221         return err;
 222 }
 223
 224 static int raw_notifier(struct notifier_block *nb,
 225                         unsigned long msg, void *data)
 226 {
 227         struct net_device *dev = (struct net_device *)data;
 228         struct raw_sock *ro = container_of(nb, struct raw_sock, notifier);
 229 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,12)
 230         struct sock *sk = &ro->sk;
 231 #else
 232         struct sock *sk = ro->sk;
 233 #endif
 234
 235 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,26)
 236         if (!net_eq(dev_net(dev), &init_net))
 237                 return NOTIFY_DONE;
 238 #elif LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,24)
 239         if (dev->nd_net != &init_net)
 240                 return NOTIFY_DONE;
 241 #endif
 242
 243         if (dev->type != ARPHRD_CAN)
 244                 return NOTIFY_DONE;
 245
 246         if (ro->ifindex != dev->ifindex)
 247                 return NOTIFY_DONE;
 248
 249         switch (msg) {
 250
 251         case NETDEV_UNREGISTER:
 252                 lock_sock(sk);
 253                 /* remove current filters & unregister */
 254                 if (ro->bound)
 255                         raw_disable_allfilters(dev, sk);
 256
 257                 if (ro->count > 1)
 258                         kfree(ro->filter);
 259
 260                 ro->ifindex = 0;
 261                 ro->bound   = 0;
 262                 ro->count   = 0;
 263                 release_sock(sk);
 264
 265                 sk->sk_err = ENODEV;
 266                 if (!sock_flag(sk, SOCK_DEAD))
 267                         sk->sk_error_report(sk);
 268                 break;
 269
 270         case NETDEV_DOWN:
 271                 sk->sk_err = ENETDOWN;
 272                 if (!sock_flag(sk, SOCK_DEAD))
 273                         sk->sk_error_report(sk);
 274                 break;
 275         }
 276
 277         return NOTIFY_DONE;
 278 }
 279
 280 static int raw_init(struct sock *sk)
 281 {
 282         struct raw_sock *ro = raw_sk(sk);
 283
 284 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,12)
 285         ro->sk               = sk;
 286 #endif
 287         ro->bound            = 0;
 288         ro->ifindex          = 0;
 289
 290         /* set default filter to single entry dfilter */
 291         ro->dfilter.can_id   = 0;
 292         ro->dfilter.can_mask = MASK_ALL;
 293         ro->filter           = &ro->dfilter;
 294         ro->count            = 1;
 295
 296         /* set default loopback behaviour */
 297         ro->loopback         = 1;
 298         ro->recv_own_msgs    = 0;
 299
 300         /* set notifier */
 301         ro->notifier.notifier_call = raw_notifier;
 302
 303         register_netdevice_notifier(&ro->notifier);
 304
 305         return 0;
 306 }
 307
 308 static int raw_release(struct socket *sock)
 309 {
 310         struct sock *sk = sock->sk;
 311         struct raw_sock *ro = raw_sk(sk);
 312
 313         unregister_netdevice_notifier(&ro->notifier);
 314
 315         lock_sock(sk);
 316
 317         /* remove current filters & unregister */
 318         if (ro->bound) {
 319                 if (ro->ifindex) {
 320                         struct net_device *dev;
 321
 322                         dev = dev_get_by_index(&init_net, ro->ifindex);
 323                         if (dev) {
 324                                 raw_disable_allfilters(dev, sk);
 325                                 dev_put(dev);
 326                         }
 327                 } else
 328                         raw_disable_allfilters(NULL, sk);
 329         }
 330
 331         if (ro->count > 1)
 332                 kfree(ro->filter);
 333
 334         ro->ifindex = 0;
 335         ro->bound   = 0;
 336         ro->count   = 0;
 337
 338         release_sock(sk);
 339         sock_put(sk);
 340
 341         return 0;
 342 }
 343
 344 static int raw_bind(struct socket *sock, struct sockaddr *uaddr, int len)
 345 {
 346         struct sockaddr_can *addr = (struct sockaddr_can *)uaddr;
 347         struct sock *sk = sock->sk;
 348         struct raw_sock *ro = raw_sk(sk);
 349         int ifindex;
 350         int err = 0;
 351         int notify_enetdown = 0;
 352
 353         if (len < sizeof(*addr))
 354                 return -EINVAL;
 355
 356         lock_sock(sk);
 357
 358         if (ro->bound && addr->can_ifindex == ro->ifindex)
 359                 goto out;
 360
 361         if (addr->can_ifindex) {
 362                 struct net_device *dev;
 363
 364                 dev = dev_get_by_index(&init_net, addr->can_ifindex);
 365                 if (!dev) {
 366                         err = -ENODEV;
 367                         goto out;
 368                 }
 369                 if (dev->type != ARPHRD_CAN) {
 370                         dev_put(dev);
 371                         err = -ENODEV;
 372                         goto out;
 373                 }
 374                 if (!(dev->flags & IFF_UP))
 375                         notify_enetdown = 1;
 376
 377                 ifindex = dev->ifindex;
 378
 379                 /* filters set by default/setsockopt */
 380                 err = raw_enable_allfilters(dev, sk);
 381                 dev_put(dev);
 382         } else {
 383                 ifindex = 0;
 384
 385                 /* filters set by default/setsockopt */
 386                 err = raw_enable_allfilters(NULL, sk);
 387         }
 388
 389         if (!err) {
 390                 if (ro->bound) {
 391                         /* unregister old filters */
 392                         if (ro->ifindex) {
 393                                 struct net_device *dev;
 394
 395                                 dev = dev_get_by_index(&init_net, ro->ifindex);
 396                                 if (dev) {
 397                                         raw_disable_allfilters(dev, sk);
 398                                         dev_put(dev);
 399                                 }
 400                         } else
 401                                 raw_disable_allfilters(NULL, sk);
 402                 }
 403                 ro->ifindex = ifindex;
 404                 ro->bound = 1;
 405         }
 406
 407  out:
 408         release_sock(sk);
 409
 410         if (notify_enetdown) {
 411                 sk->sk_err = ENETDOWN;
 412                 if (!sock_flag(sk, SOCK_DEAD))
 413                         sk->sk_error_report(sk);
 414         }
 415
 416         return err;
 417 }
 418
 419 static int raw_getname(struct socket *sock, struct sockaddr *uaddr,
 420                        int *len, int peer)
 421 {
 422         struct sockaddr_can *addr = (struct sockaddr_can *)uaddr;
 423         struct sock *sk = sock->sk;
 424         struct raw_sock *ro = raw_sk(sk);
 425
 426         if (peer)
 427                 return -EOPNOTSUPP;
 428
 429         addr->can_family  = AF_CAN;
 430         addr->can_ifindex = ro->ifindex;
 431
 432         *len = sizeof(*addr);
 433
 434         return 0;
 435 }
 436
 437 static int raw_setsockopt(struct socket *sock, int level, int optname,
 438                           char __user *optval, int optlen)
 439 {
 440         struct sock *sk = sock->sk;
 441         struct raw_sock *ro = raw_sk(sk);
 442         struct can_filter *filter = NULL;  /* dyn. alloc'ed filters */
 443         struct can_filter sfilter;         /* single filter */
 444         struct net_device *dev = NULL;
 445         can_err_mask_t err_mask = 0;
 446         int count = 0;
 447         int err = 0;
 448
 449         if (level != SOL_CAN_RAW)
 450                 return -EINVAL;
 451         if (optlen < 0)
 452                 return -EINVAL;
 453
 454         switch (optname) {
 455
 456         case CAN_RAW_FILTER:
 457                 if (optlen % sizeof(struct can_filter) != 0)
 458                         return -EINVAL;
 459
 460                 count = optlen / sizeof(struct can_filter);
 461
 462                 if (count > 1) {
 463                         /* filter does not fit into dfilter => alloc space */
 464                         filter = kmalloc(optlen, GFP_KERNEL);
 465                         if (!filter)
 466                                 return -ENOMEM;
 467
 468                         if (copy_from_user(filter, optval, optlen)) {
 469                                 kfree(filter);
 470                                 return -EFAULT;
 471                         }
 472                 } else if (count == 1) {
 473                         if (copy_from_user(&sfilter, optval, optlen))
 474                                 return -EFAULT;
 475                 }
 476
 477                 lock_sock(sk);
 478
 479                 if (ro->bound && ro->ifindex)
 480                         dev = dev_get_by_index(&init_net, ro->ifindex);
 481
 482                 if (ro->bound) {
 483                         /* (try to) register the new filters */
 484                         if (count == 1)
 485                                 err = raw_enable_filters(dev, sk, &sfilter, 1);
 486                         else
 487                                 err = raw_enable_filters(dev, sk, filter,
 488                                                          count);
 489                         if (err) {
 490                                 if (count > 1)
 491                                         kfree(filter);
 492                                 goto out_fil;
 493                         }
 494
 495                         /* remove old filter registrations */
 496                         raw_disable_filters(dev, sk, ro->filter, ro->count);
 497                 }
 498
 499                 /* remove old filter space */
 500                 if (ro->count > 1)
 501                         kfree(ro->filter);
 502
 503                 /* link new filters to the socket */
 504                 if (count == 1) {
 505                         /* copy filter data for single filter */
 506                         ro->dfilter = sfilter;
 507                         filter = &ro->dfilter;
 508                 }
 509                 ro->filter = filter;
 510                 ro->count  = count;
 511
 512  out_fil:
 513                 if (dev)
 514                         dev_put(dev);
 515
 516                 release_sock(sk);
 517
 518                 break;
 519
 520         case CAN_RAW_ERR_FILTER:
 521                 if (optlen != sizeof(err_mask))
 522                         return -EINVAL;
 523
 524                 if (copy_from_user(&err_mask, optval, optlen))
 525                         return -EFAULT;
 526
 527                 err_mask &= CAN_ERR_MASK;
 528
 529                 lock_sock(sk);
 530
 531                 if (ro->bound && ro->ifindex)
 532                         dev = dev_get_by_index(&init_net, ro->ifindex);
 533
 534                 /* remove current error mask */
 535                 if (ro->bound) {
 536                         /* (try to) register the new err_mask */
 537                         err = raw_enable_errfilter(dev, sk, err_mask);
 538
 539                         if (err)
 540                                 goto out_err;
 541
 542                         /* remove old err_mask registration */
 543                         raw_disable_errfilter(dev, sk, ro->err_mask);
 544                 }
 545
 546                 /* link new err_mask to the socket */
 547                 ro->err_mask = err_mask;
 548
 549  out_err:
 550                 if (dev)
 551                         dev_put(dev);
 552
 553                 release_sock(sk);
 554
 555                 break;
 556
 557         case CAN_RAW_LOOPBACK:
 558                 if (optlen != sizeof(ro->loopback))
 559                         return -EINVAL;
 560
 561                 if (copy_from_user(&ro->loopback, optval, optlen))
 562                         return -EFAULT;
 563
 564                 break;
 565
 566         case CAN_RAW_RECV_OWN_MSGS:
 567                 if (optlen != sizeof(ro->recv_own_msgs))
 568                         return -EINVAL;
 569
 570                 if (copy_from_user(&ro->recv_own_msgs, optval, optlen))
 571                         return -EFAULT;
 572
 573                 break;
 574
 575         default:
 576                 return -ENOPROTOOPT;
 577         }
 578         return err;
 579 }
 580
 581 static int raw_getsockopt(struct socket *sock, int level, int optname,
 582                           char __user *optval, int __user *optlen)
 583 {
 584         struct sock *sk = sock->sk;
 585         struct raw_sock *ro = raw_sk(sk);
 586         int len;
 587         void *val;
 588         int err = 0;
 589
 590         if (level != SOL_CAN_RAW)
 591                 return -EINVAL;
 592         if (get_user(len, optlen))
 593                 return -EFAULT;
 594         if (len < 0)
 595                 return -EINVAL;
 596
 597         switch (optname) {
 598
 599         case CAN_RAW_FILTER:
 600                 lock_sock(sk);
 601                 if (ro->count > 0) {
 602                         int fsize = ro->count * sizeof(struct can_filter);
 603                         if (len > fsize)
 604                                 len = fsize;
 605                         if (copy_to_user(optval, ro->filter, len))
 606                                 err = -EFAULT;
 607                 } else
 608                         len = 0;
 609                 release_sock(sk);
 610
 611                 if (!err)
 612                         err = put_user(len, optlen);
 613                 return err;
 614
 615         case CAN_RAW_ERR_FILTER:
 616                 if (len > sizeof(can_err_mask_t))
 617                         len = sizeof(can_err_mask_t);
 618                 val = &ro->err_mask;
 619                 break;
 620
 621         case CAN_RAW_LOOPBACK:
 622                 if (len > sizeof(int))
 623                         len = sizeof(int);
 624                 val = &ro->loopback;
 625                 break;
 626
 627         case CAN_RAW_RECV_OWN_MSGS:
 628                 if (len > sizeof(int))
 629                         len = sizeof(int);
 630                 val = &ro->recv_own_msgs;
 631                 break;
 632
 633         default:
 634                 return -ENOPROTOOPT;
 635         }
 636
 637         if (put_user(len, optlen))
 638                 return -EFAULT;
 639         if (copy_to_user(optval, val, len))
 640                 return -EFAULT;
 641         return 0;
 642 }
 643
 644 static int raw_sendmsg(struct kiocb *iocb, struct socket *sock,
 645                        struct msghdr *msg, size_t size)
 646 {
 647         struct sock *sk = sock->sk;
 648         struct raw_sock *ro = raw_sk(sk);
 649         struct sk_buff *skb;
 650         struct net_device *dev;
 651         int ifindex;
 652         int err;
 653
 654         if (msg->msg_name) {
 655                 struct sockaddr_can *addr =
 656                         (struct sockaddr_can *)msg->msg_name;
 657
 658                 if (addr->can_family != AF_CAN)
 659                         return -EINVAL;
 660
 661                 ifindex = addr->can_ifindex;
 662         } else
 663                 ifindex = ro->ifindex;
 664
 665         if (size != sizeof(struct can_frame))
 666                 return -EINVAL;
 667
 668         dev = dev_get_by_index(&init_net, ifindex);
 669         if (!dev)
 670                 return -ENXIO;
 671
 672         skb = sock_alloc_send_skb(sk, size, msg->msg_flags & MSG_DONTWAIT,
 673                                   &err);
 674         if (!skb)
 675                 goto put_dev;
 676
 677         err = memcpy_fromiovec(skb_put(skb, size), msg->msg_iov, size);
 678         if (err < 0)
 679                 goto free_skb;
 680         skb->dev = dev;
 681         skb->sk  = sk;
 682
 683         err = can_send(skb, ro->loopback);
 684
 685         dev_put(dev);
 686
 687         if (err)
 688                 goto send_failed;
 689
 690         return size;
 691
 692 free_skb:
 693         kfree_skb(skb);
 694 put_dev:
 695         dev_put(dev);
 696 send_failed:
 697         return err;
 698 }
 699
 700 static int raw_recvmsg(struct kiocb *iocb, struct socket *sock,
 701                        struct msghdr *msg, size_t size, int flags)
 702 {
 703         struct sock *sk = sock->sk;
 704         struct sk_buff *skb;
 705         int err = 0;
 706         int noblock;
 707
 708         noblock =  flags & MSG_DONTWAIT;
 709         flags   &= ~MSG_DONTWAIT;
 710
 711         skb = skb_recv_datagram(sk, flags, noblock, &err);
 712         if (!skb)
 713                 return err;
 714
 715         if (size < skb->len)
 716                 msg->msg_flags |= MSG_TRUNC;
 717         else
 718                 size = skb->len;
 719
 720         err = memcpy_toiovec(msg->msg_iov, skb->data, size);
 721         if (err < 0) {
 722                 skb_free_datagram(sk, skb);
 723                 return err;
 724         }
 725
 726         sock_recv_timestamp(msg, sk, skb);
 727
 728         if (msg->msg_name) {
 729                 msg->msg_namelen = sizeof(struct sockaddr_can);
 730                 memcpy(msg->msg_name, skb->cb, msg->msg_namelen);
 731         }
 732
 733         skb_free_datagram(sk, skb);
 734
 735         return size;
 736 }
 737
 738 static struct proto_ops raw_ops __read_mostly = {
 739         .family        = PF_CAN,
 740         .release       = raw_release,
 741         .bind          = raw_bind,
 742         .connect       = sock_no_connect,
 743         .socketpair    = sock_no_socketpair,
 744         .accept        = sock_no_accept,
 745         .getname       = raw_getname,
 746         .poll          = datagram_poll,
 747         .ioctl         = NULL,          /* use can_ioctl() from af_can.c */
 748         .listen        = sock_no_listen,
 749         .shutdown      = sock_no_shutdown,
 750         .setsockopt    = raw_setsockopt,
 751         .getsockopt    = raw_getsockopt,
 752         .sendmsg       = raw_sendmsg,
 753         .recvmsg       = raw_recvmsg,
 754         .mmap          = sock_no_mmap,
 755         .sendpage      = sock_no_sendpage,
 756 };
 757
 758 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,12)
 759 static struct proto raw_proto __read_mostly = {
 760         .name       = "CAN_RAW",
 761         .owner      = THIS_MODULE,
 762         .obj_size   = sizeof(struct raw_sock),
 763         .init       = raw_init,
 764 };
 765
 766 static struct can_proto raw_can_proto __read_mostly = {
 767         .type       = SOCK_RAW,
 768         .protocol   = CAN_RAW,
 769         .capability = -1,
 770         .ops        = &raw_ops,
 771         .prot       = &raw_proto,
 772 };
 773 #else
 774 static struct can_proto raw_can_proto __read_mostly = {
 775         .type       = SOCK_RAW,
 776         .protocol   = CAN_RAW,
 777         .capability = -1,
 778         .ops        = &raw_ops,
 779         .owner      = THIS_MODULE,
 780         .obj_size   = sizeof(struct raw_sock),
 781         .init       = raw_init,
 782 };
 783 #endif
 784
 785 static __init int raw_module_init(void)
 786 {
 787         int err;
 788
 789         printk(banner);
 790
 791         err = can_proto_register(&raw_can_proto);
 792         if (err < 0)
 793                 printk(KERN_ERR "can: registration of raw protocol failed\n");
 794
 795         return err;
 796 }
 797
 798 static __exit void raw_module_exit(void)
 799 {
 800         can_proto_unregister(&raw_can_proto);
 801 }
 802
 803 module_init(raw_module_init);
 804 module_exit(raw_module_exit);