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