Linux Audio

Check our new training course

Loading...
v3.5.6
  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 */
 41
 42#include <linux/module.h>
 43#include <linux/init.h>
 44#include <linux/uio.h>
 45#include <linux/net.h>
 46#include <linux/slab.h>
 47#include <linux/netdevice.h>
 48#include <linux/socket.h>
 49#include <linux/if_arp.h>
 50#include <linux/skbuff.h>
 51#include <linux/can.h>
 52#include <linux/can/core.h>
 
 
 53#include <linux/can/raw.h>
 54#include <net/sock.h>
 55#include <net/net_namespace.h>
 56
 57#define CAN_RAW_VERSION CAN_VERSION
 58static __initdata const char banner[] =
 59	KERN_INFO "can: raw protocol (rev " CAN_RAW_VERSION ")\n";
 60
 61MODULE_DESCRIPTION("PF_CAN raw protocol");
 62MODULE_LICENSE("Dual BSD/GPL");
 63MODULE_AUTHOR("Urs Thuermann <urs.thuermann@volkswagen.de>");
 64MODULE_ALIAS("can-proto-1");
 65
 
 
 66#define MASK_ALL 0
 67
 68/*
 69 * A raw socket has a list of can_filters attached to it, each receiving
 70 * the CAN frames matching that filter.  If the filter list is empty,
 71 * no CAN frames will be received by the socket.  The default after
 72 * opening the socket, is to have one filter which receives all frames.
 73 * The filter list is allocated dynamically with the exception of the
 74 * list containing only one item.  This common case is optimized by
 75 * storing the single filter in dfilter, to avoid using dynamic memory.
 76 */
 77
 
 
 
 
 
 
 78struct raw_sock {
 79	struct sock sk;
 80	int bound;
 81	int ifindex;
 82	struct notifier_block notifier;
 83	int loopback;
 84	int recv_own_msgs;
 
 
 
 85	int count;                 /* number of active filters */
 86	struct can_filter dfilter; /* default/single filter */
 87	struct can_filter *filter; /* pointer to filter(s) */
 88	can_err_mask_t err_mask;
 
 89};
 90
 91/*
 92 * Return pointer to store the extra msg flags for raw_recvmsg().
 
 
 
 93 * We use the space of one unsigned int beyond the 'struct sockaddr_can'
 94 * in skb->cb.
 95 */
 96static inline unsigned int *raw_flags(struct sk_buff *skb)
 97{
 98	BUILD_BUG_ON(sizeof(skb->cb) <= (sizeof(struct sockaddr_can) +
 99					 sizeof(unsigned int)));
100
101	/* return pointer after struct sockaddr_can */
102	return (unsigned int *)(&((struct sockaddr_can *)skb->cb)[1]);
103}
104
105static inline struct raw_sock *raw_sk(const struct sock *sk)
106{
107	return (struct raw_sock *)sk;
108}
109
110static void raw_rcv(struct sk_buff *oskb, void *data)
111{
112	struct sock *sk = (struct sock *)data;
113	struct raw_sock *ro = raw_sk(sk);
114	struct sockaddr_can *addr;
115	struct sk_buff *skb;
116	unsigned int *pflags;
117
118	/* check the received tx sock reference */
119	if (!ro->recv_own_msgs && oskb->sk == sk)
120		return;
121
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
122	/* clone the given skb to be able to enqueue it into the rcv queue */
123	skb = skb_clone(oskb, GFP_ATOMIC);
124	if (!skb)
125		return;
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	/* add CAN specific message flags for raw_recvmsg() */
141	pflags = raw_flags(skb);
142	*pflags = 0;
143	if (oskb->sk)
144		*pflags |= MSG_DONTROUTE;
145	if (oskb->sk == sk)
146		*pflags |= MSG_CONFIRM;
147
148	if (sock_queue_rcv_skb(sk, skb) < 0)
149		kfree_skb(skb);
150}
151
152static int raw_enable_filters(struct net_device *dev, struct sock *sk,
153			      struct can_filter *filter, int count)
 
154{
155	int err = 0;
156	int i;
157
158	for (i = 0; i < count; i++) {
159		err = can_rx_register(dev, filter[i].can_id,
160				      filter[i].can_mask,
161				      raw_rcv, sk, "raw");
162		if (err) {
163			/* clean up successfully registered filters */
164			while (--i >= 0)
165				can_rx_unregister(dev, filter[i].can_id,
166						  filter[i].can_mask,
167						  raw_rcv, sk);
168			break;
169		}
170	}
171
172	return err;
173}
174
175static int raw_enable_errfilter(struct net_device *dev, struct sock *sk,
176				can_err_mask_t err_mask)
177{
178	int err = 0;
179
180	if (err_mask)
181		err = can_rx_register(dev, 0, err_mask | CAN_ERR_FLAG,
182				      raw_rcv, sk, "raw");
183
184	return err;
185}
186
187static void raw_disable_filters(struct net_device *dev, struct sock *sk,
188			      struct can_filter *filter, int count)
 
189{
190	int i;
191
192	for (i = 0; i < count; i++)
193		can_rx_unregister(dev, filter[i].can_id, filter[i].can_mask,
194				  raw_rcv, sk);
195}
196
197static inline void raw_disable_errfilter(struct net_device *dev,
 
198					 struct sock *sk,
199					 can_err_mask_t err_mask)
200
201{
202	if (err_mask)
203		can_rx_unregister(dev, 0, err_mask | CAN_ERR_FLAG,
204				  raw_rcv, sk);
205}
206
207static inline void raw_disable_allfilters(struct net_device *dev,
 
208					  struct sock *sk)
209{
210	struct raw_sock *ro = raw_sk(sk);
211
212	raw_disable_filters(dev, sk, ro->filter, ro->count);
213	raw_disable_errfilter(dev, sk, ro->err_mask);
214}
215
216static int raw_enable_allfilters(struct net_device *dev, struct sock *sk)
 
217{
218	struct raw_sock *ro = raw_sk(sk);
219	int err;
220
221	err = raw_enable_filters(dev, sk, ro->filter, ro->count);
222	if (!err) {
223		err = raw_enable_errfilter(dev, sk, ro->err_mask);
224		if (err)
225			raw_disable_filters(dev, sk, ro->filter, ro->count);
 
226	}
227
228	return err;
229}
230
231static int raw_notifier(struct notifier_block *nb,
232			unsigned long msg, void *data)
233{
234	struct net_device *dev = (struct net_device *)data;
235	struct raw_sock *ro = container_of(nb, struct raw_sock, notifier);
236	struct sock *sk = &ro->sk;
237
238	if (!net_eq(dev_net(dev), &init_net))
239		return NOTIFY_DONE;
240
241	if (dev->type != ARPHRD_CAN)
242		return NOTIFY_DONE;
243
244	if (ro->ifindex != dev->ifindex)
245		return NOTIFY_DONE;
246
247	switch (msg) {
248
249	case NETDEV_UNREGISTER:
250		lock_sock(sk);
251		/* remove current filters & unregister */
252		if (ro->bound)
253			raw_disable_allfilters(dev, sk);
254
255		if (ro->count > 1)
256			kfree(ro->filter);
257
258		ro->ifindex = 0;
259		ro->bound   = 0;
260		ro->count   = 0;
261		release_sock(sk);
262
263		sk->sk_err = ENODEV;
264		if (!sock_flag(sk, SOCK_DEAD))
265			sk->sk_error_report(sk);
266		break;
267
268	case NETDEV_DOWN:
269		sk->sk_err = ENETDOWN;
270		if (!sock_flag(sk, SOCK_DEAD))
271			sk->sk_error_report(sk);
272		break;
273	}
 
 
 
 
 
 
274
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
275	return NOTIFY_DONE;
276}
277
278static int raw_init(struct sock *sk)
279{
280	struct raw_sock *ro = raw_sk(sk);
281
282	ro->bound            = 0;
283	ro->ifindex          = 0;
284
285	/* set default filter to single entry dfilter */
286	ro->dfilter.can_id   = 0;
287	ro->dfilter.can_mask = MASK_ALL;
288	ro->filter           = &ro->dfilter;
289	ro->count            = 1;
290
291	/* set default loopback behaviour */
292	ro->loopback         = 1;
293	ro->recv_own_msgs    = 0;
 
 
 
 
 
 
 
 
294
295	/* set notifier */
296	ro->notifier.notifier_call = raw_notifier;
297
298	register_netdevice_notifier(&ro->notifier);
299
300	return 0;
301}
302
303static int raw_release(struct socket *sock)
304{
305	struct sock *sk = sock->sk;
306	struct raw_sock *ro;
307
308	if (!sk)
309		return 0;
310
311	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	sock_orphan(sk);
339	sock->sk = NULL;
340
341	release_sock(sk);
342	sock_put(sk);
343
344	return 0;
345}
346
347static int raw_bind(struct socket *sock, struct sockaddr *uaddr, int len)
348{
349	struct sockaddr_can *addr = (struct sockaddr_can *)uaddr;
350	struct sock *sk = sock->sk;
351	struct raw_sock *ro = raw_sk(sk);
352	int ifindex;
353	int err = 0;
354	int notify_enetdown = 0;
355
356	if (len < sizeof(*addr))
 
 
357		return -EINVAL;
358
359	lock_sock(sk);
360
361	if (ro->bound && addr->can_ifindex == ro->ifindex)
362		goto out;
363
364	if (addr->can_ifindex) {
365		struct net_device *dev;
366
367		dev = dev_get_by_index(&init_net, addr->can_ifindex);
368		if (!dev) {
369			err = -ENODEV;
370			goto out;
371		}
372		if (dev->type != ARPHRD_CAN) {
373			dev_put(dev);
374			err = -ENODEV;
375			goto out;
376		}
377		if (!(dev->flags & IFF_UP))
378			notify_enetdown = 1;
379
380		ifindex = dev->ifindex;
381
382		/* filters set by default/setsockopt */
383		err = raw_enable_allfilters(dev, sk);
384		dev_put(dev);
385	} else {
386		ifindex = 0;
387
388		/* filters set by default/setsockopt */
389		err = raw_enable_allfilters(NULL, sk);
390	}
391
392	if (!err) {
393		if (ro->bound) {
394			/* unregister old filters */
395			if (ro->ifindex) {
396				struct net_device *dev;
397
398				dev = dev_get_by_index(&init_net, ro->ifindex);
 
399				if (dev) {
400					raw_disable_allfilters(dev, sk);
 
401					dev_put(dev);
402				}
403			} else
404				raw_disable_allfilters(NULL, sk);
 
405		}
406		ro->ifindex = ifindex;
407		ro->bound = 1;
408	}
409
410 out:
411	release_sock(sk);
412
413	if (notify_enetdown) {
414		sk->sk_err = ENETDOWN;
415		if (!sock_flag(sk, SOCK_DEAD))
416			sk->sk_error_report(sk);
417	}
418
419	return err;
420}
421
422static int raw_getname(struct socket *sock, struct sockaddr *uaddr,
423		       int *len, int peer)
424{
425	struct sockaddr_can *addr = (struct sockaddr_can *)uaddr;
426	struct sock *sk = sock->sk;
427	struct raw_sock *ro = raw_sk(sk);
428
429	if (peer)
430		return -EOPNOTSUPP;
431
432	memset(addr, 0, sizeof(*addr));
433	addr->can_family  = AF_CAN;
434	addr->can_ifindex = ro->ifindex;
435
436	*len = sizeof(*addr);
437
438	return 0;
439}
440
441static int raw_setsockopt(struct socket *sock, int level, int optname,
442			  char __user *optval, unsigned int optlen)
443{
444	struct sock *sk = sock->sk;
445	struct raw_sock *ro = raw_sk(sk);
446	struct can_filter *filter = NULL;  /* dyn. alloc'ed filters */
447	struct can_filter sfilter;         /* single filter */
448	struct net_device *dev = NULL;
449	can_err_mask_t err_mask = 0;
450	int count = 0;
451	int err = 0;
452
453	if (level != SOL_CAN_RAW)
454		return -EINVAL;
455
456	switch (optname) {
457
458	case CAN_RAW_FILTER:
459		if (optlen % sizeof(struct can_filter) != 0)
460			return -EINVAL;
461
 
 
 
462		count = optlen / sizeof(struct can_filter);
463
464		if (count > 1) {
465			/* filter does not fit into dfilter => alloc space */
466			filter = memdup_user(optval, optlen);
467			if (IS_ERR(filter))
468				return PTR_ERR(filter);
469		} else if (count == 1) {
470			if (copy_from_user(&sfilter, optval, sizeof(sfilter)))
471				return -EFAULT;
472		}
473
 
474		lock_sock(sk);
475
476		if (ro->bound && ro->ifindex)
477			dev = dev_get_by_index(&init_net, ro->ifindex);
 
 
 
 
 
 
 
478
479		if (ro->bound) {
480			/* (try to) register the new filters */
481			if (count == 1)
482				err = raw_enable_filters(dev, sk, &sfilter, 1);
 
483			else
484				err = raw_enable_filters(dev, sk, filter,
485							 count);
486			if (err) {
487				if (count > 1)
488					kfree(filter);
489				goto out_fil;
490			}
491
492			/* remove old filter registrations */
493			raw_disable_filters(dev, sk, ro->filter, ro->count);
 
494		}
495
496		/* remove old filter space */
497		if (ro->count > 1)
498			kfree(ro->filter);
499
500		/* link new filters to the socket */
501		if (count == 1) {
502			/* copy filter data for single filter */
503			ro->dfilter = sfilter;
504			filter = &ro->dfilter;
505		}
506		ro->filter = filter;
507		ro->count  = count;
508
509 out_fil:
510		if (dev)
511			dev_put(dev);
512
513		release_sock(sk);
 
514
515		break;
516
517	case CAN_RAW_ERR_FILTER:
518		if (optlen != sizeof(err_mask))
519			return -EINVAL;
520
521		if (copy_from_user(&err_mask, optval, optlen))
522			return -EFAULT;
523
524		err_mask &= CAN_ERR_MASK;
525
 
526		lock_sock(sk);
527
528		if (ro->bound && ro->ifindex)
529			dev = dev_get_by_index(&init_net, ro->ifindex);
 
 
 
 
 
530
531		/* remove current error mask */
532		if (ro->bound) {
533			/* (try to) register the new err_mask */
534			err = raw_enable_errfilter(dev, sk, err_mask);
 
535
536			if (err)
537				goto out_err;
538
539			/* remove old err_mask registration */
540			raw_disable_errfilter(dev, sk, ro->err_mask);
 
541		}
542
543		/* link new err_mask to the socket */
544		ro->err_mask = err_mask;
545
546 out_err:
547		if (dev)
548			dev_put(dev);
549
550		release_sock(sk);
 
551
552		break;
553
554	case CAN_RAW_LOOPBACK:
555		if (optlen != sizeof(ro->loopback))
556			return -EINVAL;
557
558		if (copy_from_user(&ro->loopback, optval, optlen))
559			return -EFAULT;
560
561		break;
562
563	case CAN_RAW_RECV_OWN_MSGS:
564		if (optlen != sizeof(ro->recv_own_msgs))
565			return -EINVAL;
566
567		if (copy_from_user(&ro->recv_own_msgs, optval, optlen))
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
568			return -EFAULT;
569
570		break;
571
572	default:
573		return -ENOPROTOOPT;
574	}
575	return err;
576}
577
578static int raw_getsockopt(struct socket *sock, int level, int optname,
579			  char __user *optval, int __user *optlen)
580{
581	struct sock *sk = sock->sk;
582	struct raw_sock *ro = raw_sk(sk);
583	int len;
584	void *val;
585	int err = 0;
586
587	if (level != SOL_CAN_RAW)
588		return -EINVAL;
589	if (get_user(len, optlen))
590		return -EFAULT;
591	if (len < 0)
592		return -EINVAL;
593
594	switch (optname) {
595
596	case CAN_RAW_FILTER:
597		lock_sock(sk);
598		if (ro->count > 0) {
599			int fsize = ro->count * sizeof(struct can_filter);
600			if (len > fsize)
601				len = fsize;
602			if (copy_to_user(optval, ro->filter, len))
603				err = -EFAULT;
604		} else
 
 
 
 
 
 
 
 
 
605			len = 0;
 
606		release_sock(sk);
607
608		if (!err)
609			err = put_user(len, optlen);
610		return err;
611
612	case CAN_RAW_ERR_FILTER:
613		if (len > sizeof(can_err_mask_t))
614			len = sizeof(can_err_mask_t);
615		val = &ro->err_mask;
616		break;
617
618	case CAN_RAW_LOOPBACK:
619		if (len > sizeof(int))
620			len = sizeof(int);
621		val = &ro->loopback;
622		break;
623
624	case CAN_RAW_RECV_OWN_MSGS:
625		if (len > sizeof(int))
626			len = sizeof(int);
627		val = &ro->recv_own_msgs;
628		break;
629
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
630	default:
631		return -ENOPROTOOPT;
632	}
633
634	if (put_user(len, optlen))
635		return -EFAULT;
636	if (copy_to_user(optval, val, len))
637		return -EFAULT;
638	return 0;
639}
640
641static int raw_sendmsg(struct kiocb *iocb, struct socket *sock,
642		       struct msghdr *msg, size_t size)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
643{
644	struct sock *sk = sock->sk;
645	struct raw_sock *ro = raw_sk(sk);
 
646	struct sk_buff *skb;
647	struct net_device *dev;
648	int ifindex;
649	int err;
 
 
 
 
650
651	if (msg->msg_name) {
652		struct sockaddr_can *addr =
653			(struct sockaddr_can *)msg->msg_name;
654
655		if (msg->msg_namelen < sizeof(*addr))
656			return -EINVAL;
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	err = sock_tx_timestamp(sk, &skb_shinfo(skb)->tx_flags);
681	if (err < 0)
 
682		goto free_skb;
683
 
 
 
 
 
 
 
684	skb->dev = dev;
685	skb->sk  = sk;
 
 
 
 
686
687	err = can_send(skb, ro->loopback);
688
689	dev_put(dev);
690
691	if (err)
692		goto send_failed;
693
694	return size;
695
696free_skb:
697	kfree_skb(skb);
698put_dev:
699	dev_put(dev);
700send_failed:
701	return err;
702}
703
704static int raw_recvmsg(struct kiocb *iocb, struct socket *sock,
705		       struct msghdr *msg, size_t size, int flags)
706{
707	struct sock *sk = sock->sk;
708	struct sk_buff *skb;
709	int err = 0;
710	int noblock;
711
712	noblock =  flags & MSG_DONTWAIT;
713	flags   &= ~MSG_DONTWAIT;
 
714
715	skb = skb_recv_datagram(sk, flags, noblock, &err);
716	if (!skb)
717		return err;
718
719	if (size < skb->len)
720		msg->msg_flags |= MSG_TRUNC;
721	else
722		size = skb->len;
723
724	err = memcpy_toiovec(msg->msg_iov, skb->data, size);
725	if (err < 0) {
726		skb_free_datagram(sk, skb);
727		return err;
728	}
729
730	sock_recv_ts_and_drops(msg, sk, skb);
731
732	if (msg->msg_name) {
733		msg->msg_namelen = sizeof(struct sockaddr_can);
 
734		memcpy(msg->msg_name, skb->cb, msg->msg_namelen);
735	}
736
737	/* assign the flags that have been recorded in raw_rcv() */
738	msg->msg_flags |= *(raw_flags(skb));
739
740	skb_free_datagram(sk, skb);
741
742	return size;
743}
744
 
 
 
 
 
 
 
745static const struct proto_ops raw_ops = {
746	.family        = PF_CAN,
747	.release       = raw_release,
748	.bind          = raw_bind,
749	.connect       = sock_no_connect,
750	.socketpair    = sock_no_socketpair,
751	.accept        = sock_no_accept,
752	.getname       = raw_getname,
753	.poll          = datagram_poll,
754	.ioctl         = can_ioctl,	/* use can_ioctl() from af_can.c */
 
755	.listen        = sock_no_listen,
756	.shutdown      = sock_no_shutdown,
757	.setsockopt    = raw_setsockopt,
758	.getsockopt    = raw_getsockopt,
759	.sendmsg       = raw_sendmsg,
760	.recvmsg       = raw_recvmsg,
761	.mmap          = sock_no_mmap,
762	.sendpage      = sock_no_sendpage,
763};
764
765static struct proto raw_proto __read_mostly = {
766	.name       = "CAN_RAW",
767	.owner      = THIS_MODULE,
768	.obj_size   = sizeof(struct raw_sock),
769	.init       = raw_init,
770};
771
772static const struct can_proto raw_can_proto = {
773	.type       = SOCK_RAW,
774	.protocol   = CAN_RAW,
775	.ops        = &raw_ops,
776	.prot       = &raw_proto,
777};
778
 
 
 
 
779static __init int raw_module_init(void)
780{
781	int err;
782
783	printk(banner);
 
 
 
 
784
785	err = can_proto_register(&raw_can_proto);
786	if (err < 0)
787		printk(KERN_ERR "can: registration of raw protocol failed\n");
 
 
 
 
788
 
 
789	return err;
790}
791
792static __exit void raw_module_exit(void)
793{
794	can_proto_unregister(&raw_can_proto);
 
795}
796
797module_init(raw_module_init);
798module_exit(raw_module_exit);
v6.2
   1// SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)
   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 */
  41
  42#include <linux/module.h>
  43#include <linux/init.h>
  44#include <linux/uio.h>
  45#include <linux/net.h>
  46#include <linux/slab.h>
  47#include <linux/netdevice.h>
  48#include <linux/socket.h>
  49#include <linux/if_arp.h>
  50#include <linux/skbuff.h>
  51#include <linux/can.h>
  52#include <linux/can/core.h>
  53#include <linux/can/dev.h> /* for can_is_canxl_dev_mtu() */
  54#include <linux/can/skb.h>
  55#include <linux/can/raw.h>
  56#include <net/sock.h>
  57#include <net/net_namespace.h>
  58
 
 
 
 
  59MODULE_DESCRIPTION("PF_CAN raw protocol");
  60MODULE_LICENSE("Dual BSD/GPL");
  61MODULE_AUTHOR("Urs Thuermann <urs.thuermann@volkswagen.de>");
  62MODULE_ALIAS("can-proto-1");
  63
  64#define RAW_MIN_NAMELEN CAN_REQUIRED_SIZE(struct sockaddr_can, can_ifindex)
  65
  66#define MASK_ALL 0
  67
  68/* A raw socket has a list of can_filters attached to it, each receiving
 
  69 * the CAN frames matching that filter.  If the filter list is empty,
  70 * no CAN frames will be received by the socket.  The default after
  71 * opening the socket, is to have one filter which receives all frames.
  72 * The filter list is allocated dynamically with the exception of the
  73 * list containing only one item.  This common case is optimized by
  74 * storing the single filter in dfilter, to avoid using dynamic memory.
  75 */
  76
  77struct uniqframe {
  78	int skbcnt;
  79	const struct sk_buff *skb;
  80	unsigned int join_rx_count;
  81};
  82
  83struct raw_sock {
  84	struct sock sk;
  85	int bound;
  86	int ifindex;
  87	struct list_head notifier;
  88	int loopback;
  89	int recv_own_msgs;
  90	int fd_frames;
  91	int xl_frames;
  92	int join_filters;
  93	int count;                 /* number of active filters */
  94	struct can_filter dfilter; /* default/single filter */
  95	struct can_filter *filter; /* pointer to filter(s) */
  96	can_err_mask_t err_mask;
  97	struct uniqframe __percpu *uniq;
  98};
  99
 100static LIST_HEAD(raw_notifier_list);
 101static DEFINE_SPINLOCK(raw_notifier_lock);
 102static struct raw_sock *raw_busy_notifier;
 103
 104/* Return pointer to store the extra msg flags for raw_recvmsg().
 105 * We use the space of one unsigned int beyond the 'struct sockaddr_can'
 106 * in skb->cb.
 107 */
 108static inline unsigned int *raw_flags(struct sk_buff *skb)
 109{
 110	sock_skb_cb_check_size(sizeof(struct sockaddr_can) +
 111			       sizeof(unsigned int));
 112
 113	/* return pointer after struct sockaddr_can */
 114	return (unsigned int *)(&((struct sockaddr_can *)skb->cb)[1]);
 115}
 116
 117static inline struct raw_sock *raw_sk(const struct sock *sk)
 118{
 119	return (struct raw_sock *)sk;
 120}
 121
 122static void raw_rcv(struct sk_buff *oskb, void *data)
 123{
 124	struct sock *sk = (struct sock *)data;
 125	struct raw_sock *ro = raw_sk(sk);
 126	struct sockaddr_can *addr;
 127	struct sk_buff *skb;
 128	unsigned int *pflags;
 129
 130	/* check the received tx sock reference */
 131	if (!ro->recv_own_msgs && oskb->sk == sk)
 132		return;
 133
 134	/* make sure to not pass oversized frames to the socket */
 135	if ((!ro->fd_frames && can_is_canfd_skb(oskb)) ||
 136	    (!ro->xl_frames && can_is_canxl_skb(oskb)))
 137		return;
 138
 139	/* eliminate multiple filter matches for the same skb */
 140	if (this_cpu_ptr(ro->uniq)->skb == oskb &&
 141	    this_cpu_ptr(ro->uniq)->skbcnt == can_skb_prv(oskb)->skbcnt) {
 142		if (!ro->join_filters)
 143			return;
 144
 145		this_cpu_inc(ro->uniq->join_rx_count);
 146		/* drop frame until all enabled filters matched */
 147		if (this_cpu_ptr(ro->uniq)->join_rx_count < ro->count)
 148			return;
 149	} else {
 150		this_cpu_ptr(ro->uniq)->skb = oskb;
 151		this_cpu_ptr(ro->uniq)->skbcnt = can_skb_prv(oskb)->skbcnt;
 152		this_cpu_ptr(ro->uniq)->join_rx_count = 1;
 153		/* drop first frame to check all enabled filters? */
 154		if (ro->join_filters && ro->count > 1)
 155			return;
 156	}
 157
 158	/* clone the given skb to be able to enqueue it into the rcv queue */
 159	skb = skb_clone(oskb, GFP_ATOMIC);
 160	if (!skb)
 161		return;
 162
 163	/* Put the datagram to the queue so that raw_recvmsg() can get
 164	 * it from there. We need to pass the interface index to
 165	 * raw_recvmsg(). We pass a whole struct sockaddr_can in
 166	 * skb->cb containing the interface index.
 
 167	 */
 168
 169	sock_skb_cb_check_size(sizeof(struct sockaddr_can));
 170	addr = (struct sockaddr_can *)skb->cb;
 171	memset(addr, 0, sizeof(*addr));
 172	addr->can_family = AF_CAN;
 173	addr->can_ifindex = skb->dev->ifindex;
 174
 175	/* add CAN specific message flags for raw_recvmsg() */
 176	pflags = raw_flags(skb);
 177	*pflags = 0;
 178	if (oskb->sk)
 179		*pflags |= MSG_DONTROUTE;
 180	if (oskb->sk == sk)
 181		*pflags |= MSG_CONFIRM;
 182
 183	if (sock_queue_rcv_skb(sk, skb) < 0)
 184		kfree_skb(skb);
 185}
 186
 187static int raw_enable_filters(struct net *net, struct net_device *dev,
 188			      struct sock *sk, struct can_filter *filter,
 189			      int count)
 190{
 191	int err = 0;
 192	int i;
 193
 194	for (i = 0; i < count; i++) {
 195		err = can_rx_register(net, dev, filter[i].can_id,
 196				      filter[i].can_mask,
 197				      raw_rcv, sk, "raw", sk);
 198		if (err) {
 199			/* clean up successfully registered filters */
 200			while (--i >= 0)
 201				can_rx_unregister(net, dev, filter[i].can_id,
 202						  filter[i].can_mask,
 203						  raw_rcv, sk);
 204			break;
 205		}
 206	}
 207
 208	return err;
 209}
 210
 211static int raw_enable_errfilter(struct net *net, struct net_device *dev,
 212				struct sock *sk, can_err_mask_t err_mask)
 213{
 214	int err = 0;
 215
 216	if (err_mask)
 217		err = can_rx_register(net, dev, 0, err_mask | CAN_ERR_FLAG,
 218				      raw_rcv, sk, "raw", sk);
 219
 220	return err;
 221}
 222
 223static void raw_disable_filters(struct net *net, struct net_device *dev,
 224				struct sock *sk, struct can_filter *filter,
 225				int count)
 226{
 227	int i;
 228
 229	for (i = 0; i < count; i++)
 230		can_rx_unregister(net, dev, filter[i].can_id,
 231				  filter[i].can_mask, raw_rcv, sk);
 232}
 233
 234static inline void raw_disable_errfilter(struct net *net,
 235					 struct net_device *dev,
 236					 struct sock *sk,
 237					 can_err_mask_t err_mask)
 238
 239{
 240	if (err_mask)
 241		can_rx_unregister(net, dev, 0, err_mask | CAN_ERR_FLAG,
 242				  raw_rcv, sk);
 243}
 244
 245static inline void raw_disable_allfilters(struct net *net,
 246					  struct net_device *dev,
 247					  struct sock *sk)
 248{
 249	struct raw_sock *ro = raw_sk(sk);
 250
 251	raw_disable_filters(net, dev, sk, ro->filter, ro->count);
 252	raw_disable_errfilter(net, dev, sk, ro->err_mask);
 253}
 254
 255static int raw_enable_allfilters(struct net *net, struct net_device *dev,
 256				 struct sock *sk)
 257{
 258	struct raw_sock *ro = raw_sk(sk);
 259	int err;
 260
 261	err = raw_enable_filters(net, dev, sk, ro->filter, ro->count);
 262	if (!err) {
 263		err = raw_enable_errfilter(net, dev, sk, ro->err_mask);
 264		if (err)
 265			raw_disable_filters(net, dev, sk, ro->filter,
 266					    ro->count);
 267	}
 268
 269	return err;
 270}
 271
 272static void raw_notify(struct raw_sock *ro, unsigned long msg,
 273		       struct net_device *dev)
 274{
 
 
 275	struct sock *sk = &ro->sk;
 276
 277	if (!net_eq(dev_net(dev), sock_net(sk)))
 278		return;
 
 
 
 279
 280	if (ro->ifindex != dev->ifindex)
 281		return;
 282
 283	switch (msg) {
 
 284	case NETDEV_UNREGISTER:
 285		lock_sock(sk);
 286		/* remove current filters & unregister */
 287		if (ro->bound)
 288			raw_disable_allfilters(dev_net(dev), dev, sk);
 289
 290		if (ro->count > 1)
 291			kfree(ro->filter);
 292
 293		ro->ifindex = 0;
 294		ro->bound = 0;
 295		ro->count = 0;
 296		release_sock(sk);
 297
 298		sk->sk_err = ENODEV;
 299		if (!sock_flag(sk, SOCK_DEAD))
 300			sk_error_report(sk);
 301		break;
 302
 303	case NETDEV_DOWN:
 304		sk->sk_err = ENETDOWN;
 305		if (!sock_flag(sk, SOCK_DEAD))
 306			sk_error_report(sk);
 307		break;
 308	}
 309}
 310
 311static int raw_notifier(struct notifier_block *nb, unsigned long msg,
 312			void *ptr)
 313{
 314	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
 315
 316	if (dev->type != ARPHRD_CAN)
 317		return NOTIFY_DONE;
 318	if (msg != NETDEV_UNREGISTER && msg != NETDEV_DOWN)
 319		return NOTIFY_DONE;
 320	if (unlikely(raw_busy_notifier)) /* Check for reentrant bug. */
 321		return NOTIFY_DONE;
 322
 323	spin_lock(&raw_notifier_lock);
 324	list_for_each_entry(raw_busy_notifier, &raw_notifier_list, notifier) {
 325		spin_unlock(&raw_notifier_lock);
 326		raw_notify(raw_busy_notifier, msg, dev);
 327		spin_lock(&raw_notifier_lock);
 328	}
 329	raw_busy_notifier = NULL;
 330	spin_unlock(&raw_notifier_lock);
 331	return NOTIFY_DONE;
 332}
 333
 334static int raw_init(struct sock *sk)
 335{
 336	struct raw_sock *ro = raw_sk(sk);
 337
 338	ro->bound            = 0;
 339	ro->ifindex          = 0;
 340
 341	/* set default filter to single entry dfilter */
 342	ro->dfilter.can_id   = 0;
 343	ro->dfilter.can_mask = MASK_ALL;
 344	ro->filter           = &ro->dfilter;
 345	ro->count            = 1;
 346
 347	/* set default loopback behaviour */
 348	ro->loopback         = 1;
 349	ro->recv_own_msgs    = 0;
 350	ro->fd_frames        = 0;
 351	ro->xl_frames        = 0;
 352	ro->join_filters     = 0;
 353
 354	/* alloc_percpu provides zero'ed memory */
 355	ro->uniq = alloc_percpu(struct uniqframe);
 356	if (unlikely(!ro->uniq))
 357		return -ENOMEM;
 358
 359	/* set notifier */
 360	spin_lock(&raw_notifier_lock);
 361	list_add_tail(&ro->notifier, &raw_notifier_list);
 362	spin_unlock(&raw_notifier_lock);
 363
 364	return 0;
 365}
 366
 367static int raw_release(struct socket *sock)
 368{
 369	struct sock *sk = sock->sk;
 370	struct raw_sock *ro;
 371
 372	if (!sk)
 373		return 0;
 374
 375	ro = raw_sk(sk);
 376
 377	spin_lock(&raw_notifier_lock);
 378	while (raw_busy_notifier == ro) {
 379		spin_unlock(&raw_notifier_lock);
 380		schedule_timeout_uninterruptible(1);
 381		spin_lock(&raw_notifier_lock);
 382	}
 383	list_del(&ro->notifier);
 384	spin_unlock(&raw_notifier_lock);
 385
 386	lock_sock(sk);
 387
 388	/* remove current filters & unregister */
 389	if (ro->bound) {
 390		if (ro->ifindex) {
 391			struct net_device *dev;
 392
 393			dev = dev_get_by_index(sock_net(sk), ro->ifindex);
 394			if (dev) {
 395				raw_disable_allfilters(dev_net(dev), dev, sk);
 396				dev_put(dev);
 397			}
 398		} else {
 399			raw_disable_allfilters(sock_net(sk), NULL, sk);
 400		}
 401	}
 402
 403	if (ro->count > 1)
 404		kfree(ro->filter);
 405
 406	ro->ifindex = 0;
 407	ro->bound = 0;
 408	ro->count = 0;
 409	free_percpu(ro->uniq);
 410
 411	sock_orphan(sk);
 412	sock->sk = NULL;
 413
 414	release_sock(sk);
 415	sock_put(sk);
 416
 417	return 0;
 418}
 419
 420static int raw_bind(struct socket *sock, struct sockaddr *uaddr, int len)
 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	int ifindex;
 426	int err = 0;
 427	int notify_enetdown = 0;
 428
 429	if (len < RAW_MIN_NAMELEN)
 430		return -EINVAL;
 431	if (addr->can_family != AF_CAN)
 432		return -EINVAL;
 433
 434	lock_sock(sk);
 435
 436	if (ro->bound && addr->can_ifindex == ro->ifindex)
 437		goto out;
 438
 439	if (addr->can_ifindex) {
 440		struct net_device *dev;
 441
 442		dev = dev_get_by_index(sock_net(sk), addr->can_ifindex);
 443		if (!dev) {
 444			err = -ENODEV;
 445			goto out;
 446		}
 447		if (dev->type != ARPHRD_CAN) {
 448			dev_put(dev);
 449			err = -ENODEV;
 450			goto out;
 451		}
 452		if (!(dev->flags & IFF_UP))
 453			notify_enetdown = 1;
 454
 455		ifindex = dev->ifindex;
 456
 457		/* filters set by default/setsockopt */
 458		err = raw_enable_allfilters(sock_net(sk), dev, sk);
 459		dev_put(dev);
 460	} else {
 461		ifindex = 0;
 462
 463		/* filters set by default/setsockopt */
 464		err = raw_enable_allfilters(sock_net(sk), NULL, sk);
 465	}
 466
 467	if (!err) {
 468		if (ro->bound) {
 469			/* unregister old filters */
 470			if (ro->ifindex) {
 471				struct net_device *dev;
 472
 473				dev = dev_get_by_index(sock_net(sk),
 474						       ro->ifindex);
 475				if (dev) {
 476					raw_disable_allfilters(dev_net(dev),
 477							       dev, sk);
 478					dev_put(dev);
 479				}
 480			} else {
 481				raw_disable_allfilters(sock_net(sk), NULL, sk);
 482			}
 483		}
 484		ro->ifindex = ifindex;
 485		ro->bound = 1;
 486	}
 487
 488 out:
 489	release_sock(sk);
 490
 491	if (notify_enetdown) {
 492		sk->sk_err = ENETDOWN;
 493		if (!sock_flag(sk, SOCK_DEAD))
 494			sk_error_report(sk);
 495	}
 496
 497	return err;
 498}
 499
 500static int raw_getname(struct socket *sock, struct sockaddr *uaddr,
 501		       int peer)
 502{
 503	struct sockaddr_can *addr = (struct sockaddr_can *)uaddr;
 504	struct sock *sk = sock->sk;
 505	struct raw_sock *ro = raw_sk(sk);
 506
 507	if (peer)
 508		return -EOPNOTSUPP;
 509
 510	memset(addr, 0, RAW_MIN_NAMELEN);
 511	addr->can_family  = AF_CAN;
 512	addr->can_ifindex = ro->ifindex;
 513
 514	return RAW_MIN_NAMELEN;
 
 
 515}
 516
 517static int raw_setsockopt(struct socket *sock, int level, int optname,
 518			  sockptr_t optval, unsigned int optlen)
 519{
 520	struct sock *sk = sock->sk;
 521	struct raw_sock *ro = raw_sk(sk);
 522	struct can_filter *filter = NULL;  /* dyn. alloc'ed filters */
 523	struct can_filter sfilter;         /* single filter */
 524	struct net_device *dev = NULL;
 525	can_err_mask_t err_mask = 0;
 526	int count = 0;
 527	int err = 0;
 528
 529	if (level != SOL_CAN_RAW)
 530		return -EINVAL;
 531
 532	switch (optname) {
 
 533	case CAN_RAW_FILTER:
 534		if (optlen % sizeof(struct can_filter) != 0)
 535			return -EINVAL;
 536
 537		if (optlen > CAN_RAW_FILTER_MAX * sizeof(struct can_filter))
 538			return -EINVAL;
 539
 540		count = optlen / sizeof(struct can_filter);
 541
 542		if (count > 1) {
 543			/* filter does not fit into dfilter => alloc space */
 544			filter = memdup_sockptr(optval, optlen);
 545			if (IS_ERR(filter))
 546				return PTR_ERR(filter);
 547		} else if (count == 1) {
 548			if (copy_from_sockptr(&sfilter, optval, sizeof(sfilter)))
 549				return -EFAULT;
 550		}
 551
 552		rtnl_lock();
 553		lock_sock(sk);
 554
 555		if (ro->bound && ro->ifindex) {
 556			dev = dev_get_by_index(sock_net(sk), ro->ifindex);
 557			if (!dev) {
 558				if (count > 1)
 559					kfree(filter);
 560				err = -ENODEV;
 561				goto out_fil;
 562			}
 563		}
 564
 565		if (ro->bound) {
 566			/* (try to) register the new filters */
 567			if (count == 1)
 568				err = raw_enable_filters(sock_net(sk), dev, sk,
 569							 &sfilter, 1);
 570			else
 571				err = raw_enable_filters(sock_net(sk), dev, sk,
 572							 filter, count);
 573			if (err) {
 574				if (count > 1)
 575					kfree(filter);
 576				goto out_fil;
 577			}
 578
 579			/* remove old filter registrations */
 580			raw_disable_filters(sock_net(sk), dev, sk, ro->filter,
 581					    ro->count);
 582		}
 583
 584		/* remove old filter space */
 585		if (ro->count > 1)
 586			kfree(ro->filter);
 587
 588		/* link new filters to the socket */
 589		if (count == 1) {
 590			/* copy filter data for single filter */
 591			ro->dfilter = sfilter;
 592			filter = &ro->dfilter;
 593		}
 594		ro->filter = filter;
 595		ro->count  = count;
 596
 597 out_fil:
 598		dev_put(dev);
 
 
 599		release_sock(sk);
 600		rtnl_unlock();
 601
 602		break;
 603
 604	case CAN_RAW_ERR_FILTER:
 605		if (optlen != sizeof(err_mask))
 606			return -EINVAL;
 607
 608		if (copy_from_sockptr(&err_mask, optval, optlen))
 609			return -EFAULT;
 610
 611		err_mask &= CAN_ERR_MASK;
 612
 613		rtnl_lock();
 614		lock_sock(sk);
 615
 616		if (ro->bound && ro->ifindex) {
 617			dev = dev_get_by_index(sock_net(sk), ro->ifindex);
 618			if (!dev) {
 619				err = -ENODEV;
 620				goto out_err;
 621			}
 622		}
 623
 624		/* remove current error mask */
 625		if (ro->bound) {
 626			/* (try to) register the new err_mask */
 627			err = raw_enable_errfilter(sock_net(sk), dev, sk,
 628						   err_mask);
 629
 630			if (err)
 631				goto out_err;
 632
 633			/* remove old err_mask registration */
 634			raw_disable_errfilter(sock_net(sk), dev, sk,
 635					      ro->err_mask);
 636		}
 637
 638		/* link new err_mask to the socket */
 639		ro->err_mask = err_mask;
 640
 641 out_err:
 642		dev_put(dev);
 
 
 643		release_sock(sk);
 644		rtnl_unlock();
 645
 646		break;
 647
 648	case CAN_RAW_LOOPBACK:
 649		if (optlen != sizeof(ro->loopback))
 650			return -EINVAL;
 651
 652		if (copy_from_sockptr(&ro->loopback, optval, optlen))
 653			return -EFAULT;
 654
 655		break;
 656
 657	case CAN_RAW_RECV_OWN_MSGS:
 658		if (optlen != sizeof(ro->recv_own_msgs))
 659			return -EINVAL;
 660
 661		if (copy_from_sockptr(&ro->recv_own_msgs, optval, optlen))
 662			return -EFAULT;
 663
 664		break;
 665
 666	case CAN_RAW_FD_FRAMES:
 667		if (optlen != sizeof(ro->fd_frames))
 668			return -EINVAL;
 669
 670		if (copy_from_sockptr(&ro->fd_frames, optval, optlen))
 671			return -EFAULT;
 672
 673		/* Enabling CAN XL includes CAN FD */
 674		if (ro->xl_frames && !ro->fd_frames) {
 675			ro->fd_frames = ro->xl_frames;
 676			return -EINVAL;
 677		}
 678		break;
 679
 680	case CAN_RAW_XL_FRAMES:
 681		if (optlen != sizeof(ro->xl_frames))
 682			return -EINVAL;
 683
 684		if (copy_from_sockptr(&ro->xl_frames, optval, optlen))
 685			return -EFAULT;
 686
 687		/* Enabling CAN XL includes CAN FD */
 688		if (ro->xl_frames)
 689			ro->fd_frames = ro->xl_frames;
 690		break;
 691
 692	case CAN_RAW_JOIN_FILTERS:
 693		if (optlen != sizeof(ro->join_filters))
 694			return -EINVAL;
 695
 696		if (copy_from_sockptr(&ro->join_filters, optval, optlen))
 697			return -EFAULT;
 698
 699		break;
 700
 701	default:
 702		return -ENOPROTOOPT;
 703	}
 704	return err;
 705}
 706
 707static int raw_getsockopt(struct socket *sock, int level, int optname,
 708			  char __user *optval, int __user *optlen)
 709{
 710	struct sock *sk = sock->sk;
 711	struct raw_sock *ro = raw_sk(sk);
 712	int len;
 713	void *val;
 714	int err = 0;
 715
 716	if (level != SOL_CAN_RAW)
 717		return -EINVAL;
 718	if (get_user(len, optlen))
 719		return -EFAULT;
 720	if (len < 0)
 721		return -EINVAL;
 722
 723	switch (optname) {
 
 724	case CAN_RAW_FILTER:
 725		lock_sock(sk);
 726		if (ro->count > 0) {
 727			int fsize = ro->count * sizeof(struct can_filter);
 728
 729			/* user space buffer to small for filter list? */
 730			if (len < fsize) {
 731				/* return -ERANGE and needed space in optlen */
 732				err = -ERANGE;
 733				if (put_user(fsize, optlen))
 734					err = -EFAULT;
 735			} else {
 736				if (len > fsize)
 737					len = fsize;
 738				if (copy_to_user(optval, ro->filter, len))
 739					err = -EFAULT;
 740			}
 741		} else {
 742			len = 0;
 743		}
 744		release_sock(sk);
 745
 746		if (!err)
 747			err = put_user(len, optlen);
 748		return err;
 749
 750	case CAN_RAW_ERR_FILTER:
 751		if (len > sizeof(can_err_mask_t))
 752			len = sizeof(can_err_mask_t);
 753		val = &ro->err_mask;
 754		break;
 755
 756	case CAN_RAW_LOOPBACK:
 757		if (len > sizeof(int))
 758			len = sizeof(int);
 759		val = &ro->loopback;
 760		break;
 761
 762	case CAN_RAW_RECV_OWN_MSGS:
 763		if (len > sizeof(int))
 764			len = sizeof(int);
 765		val = &ro->recv_own_msgs;
 766		break;
 767
 768	case CAN_RAW_FD_FRAMES:
 769		if (len > sizeof(int))
 770			len = sizeof(int);
 771		val = &ro->fd_frames;
 772		break;
 773
 774	case CAN_RAW_XL_FRAMES:
 775		if (len > sizeof(int))
 776			len = sizeof(int);
 777		val = &ro->xl_frames;
 778		break;
 779
 780	case CAN_RAW_JOIN_FILTERS:
 781		if (len > sizeof(int))
 782			len = sizeof(int);
 783		val = &ro->join_filters;
 784		break;
 785
 786	default:
 787		return -ENOPROTOOPT;
 788	}
 789
 790	if (put_user(len, optlen))
 791		return -EFAULT;
 792	if (copy_to_user(optval, val, len))
 793		return -EFAULT;
 794	return 0;
 795}
 796
 797static bool raw_bad_txframe(struct raw_sock *ro, struct sk_buff *skb, int mtu)
 798{
 799	/* Classical CAN -> no checks for flags and device capabilities */
 800	if (can_is_can_skb(skb))
 801		return false;
 802
 803	/* CAN FD -> needs to be enabled and a CAN FD or CAN XL device */
 804	if (ro->fd_frames && can_is_canfd_skb(skb) &&
 805	    (mtu == CANFD_MTU || can_is_canxl_dev_mtu(mtu)))
 806		return false;
 807
 808	/* CAN XL -> needs to be enabled and a CAN XL device */
 809	if (ro->xl_frames && can_is_canxl_skb(skb) &&
 810	    can_is_canxl_dev_mtu(mtu))
 811		return false;
 812
 813	return true;
 814}
 815
 816static int raw_sendmsg(struct socket *sock, struct msghdr *msg, size_t size)
 817{
 818	struct sock *sk = sock->sk;
 819	struct raw_sock *ro = raw_sk(sk);
 820	struct sockcm_cookie sockc;
 821	struct sk_buff *skb;
 822	struct net_device *dev;
 823	int ifindex;
 824	int err = -EINVAL;
 825
 826	/* check for valid CAN frame sizes */
 827	if (size < CANXL_HDR_SIZE + CANXL_MIN_DLEN || size > CANXL_MTU)
 828		return -EINVAL;
 829
 830	if (msg->msg_name) {
 831		DECLARE_SOCKADDR(struct sockaddr_can *, addr, msg->msg_name);
 
 832
 833		if (msg->msg_namelen < RAW_MIN_NAMELEN)
 834			return -EINVAL;
 835
 836		if (addr->can_family != AF_CAN)
 837			return -EINVAL;
 838
 839		ifindex = addr->can_ifindex;
 840	} else {
 841		ifindex = ro->ifindex;
 842	}
 843
 844	dev = dev_get_by_index(sock_net(sk), ifindex);
 
 
 
 845	if (!dev)
 846		return -ENXIO;
 847
 848	skb = sock_alloc_send_skb(sk, size + sizeof(struct can_skb_priv),
 849				  msg->msg_flags & MSG_DONTWAIT, &err);
 850	if (!skb)
 851		goto put_dev;
 852
 853	can_skb_reserve(skb);
 854	can_skb_prv(skb)->ifindex = dev->ifindex;
 855	can_skb_prv(skb)->skbcnt = 0;
 856
 857	/* fill the skb before testing for valid CAN frames */
 858	err = memcpy_from_msg(skb_put(skb, size), msg, size);
 859	if (err < 0)
 860		goto free_skb;
 861
 862	err = -EINVAL;
 863	if (raw_bad_txframe(ro, skb, dev->mtu))
 864		goto free_skb;
 865
 866	sockcm_init(&sockc, sk);
 867	if (msg->msg_controllen) {
 868		err = sock_cmsg_send(sk, msg, &sockc);
 869		if (unlikely(err))
 870			goto free_skb;
 871	}
 872
 873	skb->dev = dev;
 874	skb->priority = sk->sk_priority;
 875	skb->mark = sk->sk_mark;
 876	skb->tstamp = sockc.transmit_time;
 877
 878	skb_setup_tx_timestamp(skb, sockc.tsflags);
 879
 880	err = can_send(skb, ro->loopback);
 881
 882	dev_put(dev);
 883
 884	if (err)
 885		goto send_failed;
 886
 887	return size;
 888
 889free_skb:
 890	kfree_skb(skb);
 891put_dev:
 892	dev_put(dev);
 893send_failed:
 894	return err;
 895}
 896
 897static int raw_recvmsg(struct socket *sock, struct msghdr *msg, size_t size,
 898		       int flags)
 899{
 900	struct sock *sk = sock->sk;
 901	struct sk_buff *skb;
 902	int err = 0;
 
 903
 904	if (flags & MSG_ERRQUEUE)
 905		return sock_recv_errqueue(sk, msg, size,
 906					  SOL_CAN_RAW, SCM_CAN_RAW_ERRQUEUE);
 907
 908	skb = skb_recv_datagram(sk, flags, &err);
 909	if (!skb)
 910		return err;
 911
 912	if (size < skb->len)
 913		msg->msg_flags |= MSG_TRUNC;
 914	else
 915		size = skb->len;
 916
 917	err = memcpy_to_msg(msg, skb->data, size);
 918	if (err < 0) {
 919		skb_free_datagram(sk, skb);
 920		return err;
 921	}
 922
 923	sock_recv_cmsgs(msg, sk, skb);
 924
 925	if (msg->msg_name) {
 926		__sockaddr_check_size(RAW_MIN_NAMELEN);
 927		msg->msg_namelen = RAW_MIN_NAMELEN;
 928		memcpy(msg->msg_name, skb->cb, msg->msg_namelen);
 929	}
 930
 931	/* assign the flags that have been recorded in raw_rcv() */
 932	msg->msg_flags |= *(raw_flags(skb));
 933
 934	skb_free_datagram(sk, skb);
 935
 936	return size;
 937}
 938
 939static int raw_sock_no_ioctlcmd(struct socket *sock, unsigned int cmd,
 940				unsigned long arg)
 941{
 942	/* no ioctls for socket layer -> hand it down to NIC layer */
 943	return -ENOIOCTLCMD;
 944}
 945
 946static const struct proto_ops raw_ops = {
 947	.family        = PF_CAN,
 948	.release       = raw_release,
 949	.bind          = raw_bind,
 950	.connect       = sock_no_connect,
 951	.socketpair    = sock_no_socketpair,
 952	.accept        = sock_no_accept,
 953	.getname       = raw_getname,
 954	.poll          = datagram_poll,
 955	.ioctl         = raw_sock_no_ioctlcmd,
 956	.gettstamp     = sock_gettstamp,
 957	.listen        = sock_no_listen,
 958	.shutdown      = sock_no_shutdown,
 959	.setsockopt    = raw_setsockopt,
 960	.getsockopt    = raw_getsockopt,
 961	.sendmsg       = raw_sendmsg,
 962	.recvmsg       = raw_recvmsg,
 963	.mmap          = sock_no_mmap,
 964	.sendpage      = sock_no_sendpage,
 965};
 966
 967static struct proto raw_proto __read_mostly = {
 968	.name       = "CAN_RAW",
 969	.owner      = THIS_MODULE,
 970	.obj_size   = sizeof(struct raw_sock),
 971	.init       = raw_init,
 972};
 973
 974static const struct can_proto raw_can_proto = {
 975	.type       = SOCK_RAW,
 976	.protocol   = CAN_RAW,
 977	.ops        = &raw_ops,
 978	.prot       = &raw_proto,
 979};
 980
 981static struct notifier_block canraw_notifier = {
 982	.notifier_call = raw_notifier
 983};
 984
 985static __init int raw_module_init(void)
 986{
 987	int err;
 988
 989	pr_info("can: raw protocol\n");
 990
 991	err = register_netdevice_notifier(&canraw_notifier);
 992	if (err)
 993		return err;
 994
 995	err = can_proto_register(&raw_can_proto);
 996	if (err < 0) {
 997		pr_err("can: registration of raw protocol failed\n");
 998		goto register_proto_failed;
 999	}
1000
1001	return 0;
1002
1003register_proto_failed:
1004	unregister_netdevice_notifier(&canraw_notifier);
1005	return err;
1006}
1007
1008static __exit void raw_module_exit(void)
1009{
1010	can_proto_unregister(&raw_can_proto);
1011	unregister_netdevice_notifier(&canraw_notifier);
1012}
1013
1014module_init(raw_module_init);
1015module_exit(raw_module_exit);