kmemtrace: SLOB hooks.
[linux-2.6/kmemtrace.git] / drivers / net / pppoe.c
blobfc6f4b8c64b35cc169ab228c9c130b6ed0a4c821
1 /** -*- linux-c -*- ***********************************************************
2 * Linux PPP over Ethernet (PPPoX/PPPoE) Sockets
4 * PPPoX --- Generic PPP encapsulation socket family
5 * PPPoE --- PPP over Ethernet (RFC 2516)
8 * Version: 0.7.0
10 * 070228 : Fix to allow multiple sessions with same remote MAC and same
11 * session id by including the local device ifindex in the
12 * tuple identifying a session. This also ensures packets can't
13 * be injected into a session from interfaces other than the one
14 * specified by userspace. Florian Zumbiehl <florz@florz.de>
15 * (Oh, BTW, this one is YYMMDD, in case you were wondering ...)
16 * 220102 : Fix module use count on failure in pppoe_create, pppox_sk -acme
17 * 030700 : Fixed connect logic to allow for disconnect.
18 * 270700 : Fixed potential SMP problems; we must protect against
19 * simultaneous invocation of ppp_input
20 * and ppp_unregister_channel.
21 * 040800 : Respect reference count mechanisms on net-devices.
22 * 200800 : fix kfree(skb) in pppoe_rcv (acme)
23 * Module reference count is decremented in the right spot now,
24 * guards against sock_put not actually freeing the sk
25 * in pppoe_release.
26 * 051000 : Initialization cleanup.
27 * 111100 : Fix recvmsg.
28 * 050101 : Fix PADT procesing.
29 * 140501 : Use pppoe_rcv_core to handle all backlog. (Alexey)
30 * 170701 : Do not lock_sock with rwlock held. (DaveM)
31 * Ignore discovery frames if user has socket
32 * locked. (DaveM)
33 * Ignore return value of dev_queue_xmit in __pppoe_xmit
34 * or else we may kfree an SKB twice. (DaveM)
35 * 190701 : When doing copies of skb's in __pppoe_xmit, always delete
36 * the original skb that was passed in on success, never on
37 * failure. Delete the copy of the skb on failure to avoid
38 * a memory leak.
39 * 081001 : Misc. cleanup (licence string, non-blocking, prevent
40 * reference of device on close).
41 * 121301 : New ppp channels interface; cannot unregister a channel
42 * from interrupts. Thus, we mark the socket as a ZOMBIE
43 * and do the unregistration later.
44 * 081002 : seq_file support for proc stuff -acme
45 * 111602 : Merge all 2.4 fixes into 2.5/2.6 tree. Label 2.5/2.6
46 * as version 0.7. Spacing cleanup.
47 * Author: Michal Ostrowski <mostrows@speakeasy.net>
48 * Contributors:
49 * Arnaldo Carvalho de Melo <acme@conectiva.com.br>
50 * David S. Miller (davem@redhat.com)
52 * License:
53 * This program is free software; you can redistribute it and/or
54 * modify it under the terms of the GNU General Public License
55 * as published by the Free Software Foundation; either version
56 * 2 of the License, or (at your option) any later version.
60 #include <linux/string.h>
61 #include <linux/module.h>
62 #include <linux/kernel.h>
63 #include <linux/slab.h>
64 #include <linux/errno.h>
65 #include <linux/netdevice.h>
66 #include <linux/net.h>
67 #include <linux/inetdevice.h>
68 #include <linux/etherdevice.h>
69 #include <linux/skbuff.h>
70 #include <linux/init.h>
71 #include <linux/if_ether.h>
72 #include <linux/if_pppox.h>
73 #include <linux/ppp_channel.h>
74 #include <linux/ppp_defs.h>
75 #include <linux/if_ppp.h>
76 #include <linux/notifier.h>
77 #include <linux/file.h>
78 #include <linux/proc_fs.h>
79 #include <linux/seq_file.h>
81 #include <net/net_namespace.h>
82 #include <net/sock.h>
84 #include <asm/uaccess.h>
86 #define PPPOE_HASH_BITS 4
87 #define PPPOE_HASH_SIZE (1<<PPPOE_HASH_BITS)
89 static struct ppp_channel_ops pppoe_chan_ops;
91 static int pppoe_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg);
92 static int pppoe_xmit(struct ppp_channel *chan, struct sk_buff *skb);
93 static int __pppoe_xmit(struct sock *sk, struct sk_buff *skb);
95 static const struct proto_ops pppoe_ops;
96 static DEFINE_RWLOCK(pppoe_hash_lock);
98 static struct ppp_channel_ops pppoe_chan_ops;
100 static inline int cmp_2_addr(struct pppoe_addr *a, struct pppoe_addr *b)
102 return (a->sid == b->sid &&
103 (memcmp(a->remote, b->remote, ETH_ALEN) == 0));
106 static inline int cmp_addr(struct pppoe_addr *a, __be16 sid, char *addr)
108 return (a->sid == sid &&
109 (memcmp(a->remote,addr,ETH_ALEN) == 0));
112 #if 8%PPPOE_HASH_BITS
113 #error 8 must be a multiple of PPPOE_HASH_BITS
114 #endif
116 static int hash_item(__be16 sid, unsigned char *addr)
118 unsigned char hash = 0;
119 unsigned int i;
121 for (i = 0 ; i < ETH_ALEN ; i++) {
122 hash ^= addr[i];
124 for (i = 0 ; i < sizeof(sid_t)*8 ; i += 8 ){
125 hash ^= (__force __u32)sid>>i;
127 for (i = 8 ; (i>>=1) >= PPPOE_HASH_BITS ; ) {
128 hash ^= hash>>i;
131 return hash & ( PPPOE_HASH_SIZE - 1 );
134 /* zeroed because its in .bss */
135 static struct pppox_sock *item_hash_table[PPPOE_HASH_SIZE];
137 /**********************************************************************
139 * Set/get/delete/rehash items (internal versions)
141 **********************************************************************/
142 static struct pppox_sock *__get_item(__be16 sid, unsigned char *addr, int ifindex)
144 int hash = hash_item(sid, addr);
145 struct pppox_sock *ret;
147 ret = item_hash_table[hash];
149 while (ret && !(cmp_addr(&ret->pppoe_pa, sid, addr) && ret->pppoe_ifindex == ifindex))
150 ret = ret->next;
152 return ret;
155 static int __set_item(struct pppox_sock *po)
157 int hash = hash_item(po->pppoe_pa.sid, po->pppoe_pa.remote);
158 struct pppox_sock *ret;
160 ret = item_hash_table[hash];
161 while (ret) {
162 if (cmp_2_addr(&ret->pppoe_pa, &po->pppoe_pa) && ret->pppoe_ifindex == po->pppoe_ifindex)
163 return -EALREADY;
165 ret = ret->next;
168 po->next = item_hash_table[hash];
169 item_hash_table[hash] = po;
171 return 0;
174 static struct pppox_sock *__delete_item(__be16 sid, char *addr, int ifindex)
176 int hash = hash_item(sid, addr);
177 struct pppox_sock *ret, **src;
179 ret = item_hash_table[hash];
180 src = &item_hash_table[hash];
182 while (ret) {
183 if (cmp_addr(&ret->pppoe_pa, sid, addr) && ret->pppoe_ifindex == ifindex) {
184 *src = ret->next;
185 break;
188 src = &ret->next;
189 ret = ret->next;
192 return ret;
195 /**********************************************************************
197 * Set/get/delete/rehash items
199 **********************************************************************/
200 static inline struct pppox_sock *get_item(__be16 sid,
201 unsigned char *addr, int ifindex)
203 struct pppox_sock *po;
205 read_lock_bh(&pppoe_hash_lock);
206 po = __get_item(sid, addr, ifindex);
207 if (po)
208 sock_hold(sk_pppox(po));
209 read_unlock_bh(&pppoe_hash_lock);
211 return po;
214 static inline struct pppox_sock *get_item_by_addr(struct sockaddr_pppox *sp)
216 struct net_device *dev;
217 int ifindex;
219 dev = dev_get_by_name(&init_net, sp->sa_addr.pppoe.dev);
220 if(!dev)
221 return NULL;
222 ifindex = dev->ifindex;
223 dev_put(dev);
224 return get_item(sp->sa_addr.pppoe.sid, sp->sa_addr.pppoe.remote, ifindex);
227 static inline struct pppox_sock *delete_item(__be16 sid, char *addr, int ifindex)
229 struct pppox_sock *ret;
231 write_lock_bh(&pppoe_hash_lock);
232 ret = __delete_item(sid, addr, ifindex);
233 write_unlock_bh(&pppoe_hash_lock);
235 return ret;
240 /***************************************************************************
242 * Handler for device events.
243 * Certain device events require that sockets be unconnected.
245 **************************************************************************/
247 static void pppoe_flush_dev(struct net_device *dev)
249 int hash;
250 BUG_ON(dev == NULL);
252 write_lock_bh(&pppoe_hash_lock);
253 for (hash = 0; hash < PPPOE_HASH_SIZE; hash++) {
254 struct pppox_sock *po = item_hash_table[hash];
256 while (po != NULL) {
257 struct sock *sk = sk_pppox(po);
258 if (po->pppoe_dev != dev) {
259 po = po->next;
260 continue;
262 po->pppoe_dev = NULL;
263 dev_put(dev);
266 /* We always grab the socket lock, followed by the
267 * pppoe_hash_lock, in that order. Since we should
268 * hold the sock lock while doing any unbinding,
269 * we need to release the lock we're holding.
270 * Hold a reference to the sock so it doesn't disappear
271 * as we're jumping between locks.
274 sock_hold(sk);
276 write_unlock_bh(&pppoe_hash_lock);
277 lock_sock(sk);
279 if (sk->sk_state & (PPPOX_CONNECTED | PPPOX_BOUND)) {
280 pppox_unbind_sock(sk);
281 sk->sk_state = PPPOX_ZOMBIE;
282 sk->sk_state_change(sk);
285 release_sock(sk);
286 sock_put(sk);
288 /* Restart scan at the beginning of this hash chain.
289 * While the lock was dropped the chain contents may
290 * have changed.
292 write_lock_bh(&pppoe_hash_lock);
293 po = item_hash_table[hash];
296 write_unlock_bh(&pppoe_hash_lock);
299 static int pppoe_device_event(struct notifier_block *this,
300 unsigned long event, void *ptr)
302 struct net_device *dev = (struct net_device *) ptr;
304 if (dev_net(dev) != &init_net)
305 return NOTIFY_DONE;
307 /* Only look at sockets that are using this specific device. */
308 switch (event) {
309 case NETDEV_CHANGEMTU:
310 /* A change in mtu is a bad thing, requiring
311 * LCP re-negotiation.
314 case NETDEV_GOING_DOWN:
315 case NETDEV_DOWN:
316 /* Find every socket on this device and kill it. */
317 pppoe_flush_dev(dev);
318 break;
320 default:
321 break;
324 return NOTIFY_DONE;
328 static struct notifier_block pppoe_notifier = {
329 .notifier_call = pppoe_device_event,
333 /************************************************************************
335 * Do the real work of receiving a PPPoE Session frame.
337 ***********************************************************************/
338 static int pppoe_rcv_core(struct sock *sk, struct sk_buff *skb)
340 struct pppox_sock *po = pppox_sk(sk);
341 struct pppox_sock *relay_po;
343 if (sk->sk_state & PPPOX_BOUND) {
344 ppp_input(&po->chan, skb);
345 } else if (sk->sk_state & PPPOX_RELAY) {
346 relay_po = get_item_by_addr(&po->pppoe_relay);
348 if (relay_po == NULL)
349 goto abort_kfree;
351 if ((sk_pppox(relay_po)->sk_state & PPPOX_CONNECTED) == 0)
352 goto abort_put;
354 if (!__pppoe_xmit(sk_pppox(relay_po), skb))
355 goto abort_put;
356 } else {
357 if (sock_queue_rcv_skb(sk, skb))
358 goto abort_kfree;
361 return NET_RX_SUCCESS;
363 abort_put:
364 sock_put(sk_pppox(relay_po));
366 abort_kfree:
367 kfree_skb(skb);
368 return NET_RX_DROP;
371 /************************************************************************
373 * Receive wrapper called in BH context.
375 ***********************************************************************/
376 static int pppoe_rcv(struct sk_buff *skb,
377 struct net_device *dev,
378 struct packet_type *pt,
379 struct net_device *orig_dev)
382 struct pppoe_hdr *ph;
383 struct pppox_sock *po;
384 int len;
386 if (!(skb = skb_share_check(skb, GFP_ATOMIC)))
387 goto out;
389 if (dev_net(dev) != &init_net)
390 goto drop;
392 if (!pskb_may_pull(skb, sizeof(struct pppoe_hdr)))
393 goto drop;
395 ph = pppoe_hdr(skb);
396 len = ntohs(ph->length);
398 skb_pull_rcsum(skb, sizeof(*ph));
399 if (skb->len < len)
400 goto drop;
402 po = get_item(ph->sid, eth_hdr(skb)->h_source, dev->ifindex);
403 if (!po)
404 goto drop;
406 if (pskb_trim_rcsum(skb, len))
407 goto drop;
409 return sk_receive_skb(sk_pppox(po), skb, 0);
411 drop:
412 kfree_skb(skb);
413 out:
414 return NET_RX_DROP;
417 /************************************************************************
419 * Receive a PPPoE Discovery frame.
420 * This is solely for detection of PADT frames
422 ***********************************************************************/
423 static int pppoe_disc_rcv(struct sk_buff *skb,
424 struct net_device *dev,
425 struct packet_type *pt,
426 struct net_device *orig_dev)
429 struct pppoe_hdr *ph;
430 struct pppox_sock *po;
432 if (dev_net(dev) != &init_net)
433 goto abort;
435 if (!(skb = skb_share_check(skb, GFP_ATOMIC)))
436 goto out;
438 if (!pskb_may_pull(skb, sizeof(struct pppoe_hdr)))
439 goto abort;
441 ph = pppoe_hdr(skb);
442 if (ph->code != PADT_CODE)
443 goto abort;
445 po = get_item(ph->sid, eth_hdr(skb)->h_source, dev->ifindex);
446 if (po) {
447 struct sock *sk = sk_pppox(po);
449 bh_lock_sock(sk);
451 /* If the user has locked the socket, just ignore
452 * the packet. With the way two rcv protocols hook into
453 * one socket family type, we cannot (easily) distinguish
454 * what kind of SKB it is during backlog rcv.
456 if (sock_owned_by_user(sk) == 0) {
457 /* We're no longer connect at the PPPOE layer,
458 * and must wait for ppp channel to disconnect us.
460 sk->sk_state = PPPOX_ZOMBIE;
463 bh_unlock_sock(sk);
464 sock_put(sk);
467 abort:
468 kfree_skb(skb);
469 out:
470 return NET_RX_SUCCESS; /* Lies... :-) */
473 static struct packet_type pppoes_ptype = {
474 .type = __constant_htons(ETH_P_PPP_SES),
475 .func = pppoe_rcv,
478 static struct packet_type pppoed_ptype = {
479 .type = __constant_htons(ETH_P_PPP_DISC),
480 .func = pppoe_disc_rcv,
483 static struct proto pppoe_sk_proto = {
484 .name = "PPPOE",
485 .owner = THIS_MODULE,
486 .obj_size = sizeof(struct pppox_sock),
489 /***********************************************************************
491 * Initialize a new struct sock.
493 **********************************************************************/
494 static int pppoe_create(struct net *net, struct socket *sock)
496 int error = -ENOMEM;
497 struct sock *sk;
499 sk = sk_alloc(net, PF_PPPOX, GFP_KERNEL, &pppoe_sk_proto);
500 if (!sk)
501 goto out;
503 sock_init_data(sock, sk);
505 sock->state = SS_UNCONNECTED;
506 sock->ops = &pppoe_ops;
508 sk->sk_backlog_rcv = pppoe_rcv_core;
509 sk->sk_state = PPPOX_NONE;
510 sk->sk_type = SOCK_STREAM;
511 sk->sk_family = PF_PPPOX;
512 sk->sk_protocol = PX_PROTO_OE;
514 error = 0;
515 out: return error;
518 static int pppoe_release(struct socket *sock)
520 struct sock *sk = sock->sk;
521 struct pppox_sock *po;
523 if (!sk)
524 return 0;
526 lock_sock(sk);
527 if (sock_flag(sk, SOCK_DEAD)){
528 release_sock(sk);
529 return -EBADF;
532 pppox_unbind_sock(sk);
534 /* Signal the death of the socket. */
535 sk->sk_state = PPPOX_DEAD;
538 /* Write lock on hash lock protects the entire "po" struct from
539 * concurrent updates via pppoe_flush_dev. The "po" struct should
540 * be considered part of the hash table contents, thus protected
541 * by the hash table lock */
542 write_lock_bh(&pppoe_hash_lock);
544 po = pppox_sk(sk);
545 if (po->pppoe_pa.sid) {
546 __delete_item(po->pppoe_pa.sid,
547 po->pppoe_pa.remote, po->pppoe_ifindex);
550 if (po->pppoe_dev) {
551 dev_put(po->pppoe_dev);
552 po->pppoe_dev = NULL;
555 write_unlock_bh(&pppoe_hash_lock);
557 sock_orphan(sk);
558 sock->sk = NULL;
560 skb_queue_purge(&sk->sk_receive_queue);
561 release_sock(sk);
562 sock_put(sk);
564 return 0;
568 static int pppoe_connect(struct socket *sock, struct sockaddr *uservaddr,
569 int sockaddr_len, int flags)
571 struct sock *sk = sock->sk;
572 struct net_device *dev;
573 struct sockaddr_pppox *sp = (struct sockaddr_pppox *) uservaddr;
574 struct pppox_sock *po = pppox_sk(sk);
575 int error;
577 lock_sock(sk);
579 error = -EINVAL;
580 if (sp->sa_protocol != PX_PROTO_OE)
581 goto end;
583 /* Check for already bound sockets */
584 error = -EBUSY;
585 if ((sk->sk_state & PPPOX_CONNECTED) && sp->sa_addr.pppoe.sid)
586 goto end;
588 /* Check for already disconnected sockets, on attempts to disconnect */
589 error = -EALREADY;
590 if ((sk->sk_state & PPPOX_DEAD) && !sp->sa_addr.pppoe.sid )
591 goto end;
593 error = 0;
594 if (po->pppoe_pa.sid) {
595 pppox_unbind_sock(sk);
597 /* Delete the old binding */
598 delete_item(po->pppoe_pa.sid,po->pppoe_pa.remote,po->pppoe_ifindex);
600 if(po->pppoe_dev)
601 dev_put(po->pppoe_dev);
603 memset(sk_pppox(po) + 1, 0,
604 sizeof(struct pppox_sock) - sizeof(struct sock));
606 sk->sk_state = PPPOX_NONE;
609 /* Don't re-bind if sid==0 */
610 if (sp->sa_addr.pppoe.sid != 0) {
611 dev = dev_get_by_name(&init_net, sp->sa_addr.pppoe.dev);
613 error = -ENODEV;
614 if (!dev)
615 goto end;
617 po->pppoe_dev = dev;
618 po->pppoe_ifindex = dev->ifindex;
620 write_lock_bh(&pppoe_hash_lock);
621 if (!(dev->flags & IFF_UP)){
622 write_unlock_bh(&pppoe_hash_lock);
623 goto err_put;
626 memcpy(&po->pppoe_pa,
627 &sp->sa_addr.pppoe,
628 sizeof(struct pppoe_addr));
630 error = __set_item(po);
631 write_unlock_bh(&pppoe_hash_lock);
632 if (error < 0)
633 goto err_put;
635 po->chan.hdrlen = (sizeof(struct pppoe_hdr) +
636 dev->hard_header_len);
638 po->chan.mtu = dev->mtu - sizeof(struct pppoe_hdr);
639 po->chan.private = sk;
640 po->chan.ops = &pppoe_chan_ops;
642 error = ppp_register_channel(&po->chan);
643 if (error)
644 goto err_put;
646 sk->sk_state = PPPOX_CONNECTED;
649 po->num = sp->sa_addr.pppoe.sid;
651 end:
652 release_sock(sk);
653 return error;
654 err_put:
655 if (po->pppoe_dev) {
656 dev_put(po->pppoe_dev);
657 po->pppoe_dev = NULL;
659 goto end;
663 static int pppoe_getname(struct socket *sock, struct sockaddr *uaddr,
664 int *usockaddr_len, int peer)
666 int len = sizeof(struct sockaddr_pppox);
667 struct sockaddr_pppox sp;
669 sp.sa_family = AF_PPPOX;
670 sp.sa_protocol = PX_PROTO_OE;
671 memcpy(&sp.sa_addr.pppoe, &pppox_sk(sock->sk)->pppoe_pa,
672 sizeof(struct pppoe_addr));
674 memcpy(uaddr, &sp, len);
676 *usockaddr_len = len;
678 return 0;
682 static int pppoe_ioctl(struct socket *sock, unsigned int cmd,
683 unsigned long arg)
685 struct sock *sk = sock->sk;
686 struct pppox_sock *po = pppox_sk(sk);
687 int val;
688 int err;
690 switch (cmd) {
691 case PPPIOCGMRU:
692 err = -ENXIO;
694 if (!(sk->sk_state & PPPOX_CONNECTED))
695 break;
697 err = -EFAULT;
698 if (put_user(po->pppoe_dev->mtu -
699 sizeof(struct pppoe_hdr) -
700 PPP_HDRLEN,
701 (int __user *) arg))
702 break;
703 err = 0;
704 break;
706 case PPPIOCSMRU:
707 err = -ENXIO;
708 if (!(sk->sk_state & PPPOX_CONNECTED))
709 break;
711 err = -EFAULT;
712 if (get_user(val,(int __user *) arg))
713 break;
715 if (val < (po->pppoe_dev->mtu
716 - sizeof(struct pppoe_hdr)
717 - PPP_HDRLEN))
718 err = 0;
719 else
720 err = -EINVAL;
721 break;
723 case PPPIOCSFLAGS:
724 err = -EFAULT;
725 if (get_user(val, (int __user *) arg))
726 break;
727 err = 0;
728 break;
730 case PPPOEIOCSFWD:
732 struct pppox_sock *relay_po;
734 err = -EBUSY;
735 if (sk->sk_state & (PPPOX_BOUND | PPPOX_ZOMBIE | PPPOX_DEAD))
736 break;
738 err = -ENOTCONN;
739 if (!(sk->sk_state & PPPOX_CONNECTED))
740 break;
742 /* PPPoE address from the user specifies an outbound
743 PPPoE address which frames are forwarded to */
744 err = -EFAULT;
745 if (copy_from_user(&po->pppoe_relay,
746 (void __user *)arg,
747 sizeof(struct sockaddr_pppox)))
748 break;
750 err = -EINVAL;
751 if (po->pppoe_relay.sa_family != AF_PPPOX ||
752 po->pppoe_relay.sa_protocol!= PX_PROTO_OE)
753 break;
755 /* Check that the socket referenced by the address
756 actually exists. */
757 relay_po = get_item_by_addr(&po->pppoe_relay);
759 if (!relay_po)
760 break;
762 sock_put(sk_pppox(relay_po));
763 sk->sk_state |= PPPOX_RELAY;
764 err = 0;
765 break;
768 case PPPOEIOCDFWD:
769 err = -EALREADY;
770 if (!(sk->sk_state & PPPOX_RELAY))
771 break;
773 sk->sk_state &= ~PPPOX_RELAY;
774 err = 0;
775 break;
777 default:
778 err = -ENOTTY;
781 return err;
785 static int pppoe_sendmsg(struct kiocb *iocb, struct socket *sock,
786 struct msghdr *m, size_t total_len)
788 struct sk_buff *skb;
789 struct sock *sk = sock->sk;
790 struct pppox_sock *po = pppox_sk(sk);
791 int error;
792 struct pppoe_hdr hdr;
793 struct pppoe_hdr *ph;
794 struct net_device *dev;
795 char *start;
797 lock_sock(sk);
798 if (sock_flag(sk, SOCK_DEAD) || !(sk->sk_state & PPPOX_CONNECTED)) {
799 error = -ENOTCONN;
800 goto end;
803 hdr.ver = 1;
804 hdr.type = 1;
805 hdr.code = 0;
806 hdr.sid = po->num;
808 dev = po->pppoe_dev;
810 error = -EMSGSIZE;
811 if (total_len > (dev->mtu + dev->hard_header_len))
812 goto end;
815 skb = sock_wmalloc(sk, total_len + dev->hard_header_len + 32,
816 0, GFP_KERNEL);
817 if (!skb) {
818 error = -ENOMEM;
819 goto end;
822 /* Reserve space for headers. */
823 skb_reserve(skb, dev->hard_header_len);
824 skb_reset_network_header(skb);
826 skb->dev = dev;
828 skb->priority = sk->sk_priority;
829 skb->protocol = __constant_htons(ETH_P_PPP_SES);
831 ph = (struct pppoe_hdr *) skb_put(skb, total_len + sizeof(struct pppoe_hdr));
832 start = (char *) &ph->tag[0];
834 error = memcpy_fromiovec(start, m->msg_iov, total_len);
836 if (error < 0) {
837 kfree_skb(skb);
838 goto end;
841 error = total_len;
842 dev_hard_header(skb, dev, ETH_P_PPP_SES,
843 po->pppoe_pa.remote, NULL, total_len);
845 memcpy(ph, &hdr, sizeof(struct pppoe_hdr));
847 ph->length = htons(total_len);
849 dev_queue_xmit(skb);
851 end:
852 release_sock(sk);
853 return error;
857 /************************************************************************
859 * xmit function for internal use.
861 ***********************************************************************/
862 static int __pppoe_xmit(struct sock *sk, struct sk_buff *skb)
864 struct pppox_sock *po = pppox_sk(sk);
865 struct net_device *dev = po->pppoe_dev;
866 struct pppoe_hdr *ph;
867 int data_len = skb->len;
869 if (sock_flag(sk, SOCK_DEAD) || !(sk->sk_state & PPPOX_CONNECTED))
870 goto abort;
872 if (!dev)
873 goto abort;
875 /* Copy the data if there is no space for the header or if it's
876 * read-only.
878 if (skb_cow_head(skb, sizeof(*ph) + dev->hard_header_len))
879 goto abort;
881 __skb_push(skb, sizeof(*ph));
882 skb_reset_network_header(skb);
884 ph = pppoe_hdr(skb);
885 ph->ver = 1;
886 ph->type = 1;
887 ph->code = 0;
888 ph->sid = po->num;
889 ph->length = htons(data_len);
891 skb->protocol = __constant_htons(ETH_P_PPP_SES);
892 skb->dev = dev;
894 dev_hard_header(skb, dev, ETH_P_PPP_SES,
895 po->pppoe_pa.remote, NULL, data_len);
897 dev_queue_xmit(skb);
899 return 1;
901 abort:
902 kfree_skb(skb);
903 return 1;
907 /************************************************************************
909 * xmit function called by generic PPP driver
910 * sends PPP frame over PPPoE socket
912 ***********************************************************************/
913 static int pppoe_xmit(struct ppp_channel *chan, struct sk_buff *skb)
915 struct sock *sk = (struct sock *) chan->private;
916 return __pppoe_xmit(sk, skb);
920 static struct ppp_channel_ops pppoe_chan_ops = {
921 .start_xmit = pppoe_xmit,
924 static int pppoe_recvmsg(struct kiocb *iocb, struct socket *sock,
925 struct msghdr *m, size_t total_len, int flags)
927 struct sock *sk = sock->sk;
928 struct sk_buff *skb;
929 int error = 0;
931 if (sk->sk_state & PPPOX_BOUND) {
932 error = -EIO;
933 goto end;
936 skb = skb_recv_datagram(sk, flags & ~MSG_DONTWAIT,
937 flags & MSG_DONTWAIT, &error);
939 if (error < 0)
940 goto end;
942 m->msg_namelen = 0;
944 if (skb) {
945 total_len = min_t(size_t, total_len, skb->len);
946 error = skb_copy_datagram_iovec(skb, 0, m->msg_iov, total_len);
947 if (error == 0)
948 error = total_len;
951 kfree_skb(skb);
952 end:
953 return error;
956 #ifdef CONFIG_PROC_FS
957 static int pppoe_seq_show(struct seq_file *seq, void *v)
959 struct pppox_sock *po;
960 char *dev_name;
961 DECLARE_MAC_BUF(mac);
963 if (v == SEQ_START_TOKEN) {
964 seq_puts(seq, "Id Address Device\n");
965 goto out;
968 po = v;
969 dev_name = po->pppoe_pa.dev;
971 seq_printf(seq, "%08X %s %8s\n",
972 po->pppoe_pa.sid, print_mac(mac, po->pppoe_pa.remote), dev_name);
973 out:
974 return 0;
977 static __inline__ struct pppox_sock *pppoe_get_idx(loff_t pos)
979 struct pppox_sock *po;
980 int i = 0;
982 for (; i < PPPOE_HASH_SIZE; i++) {
983 po = item_hash_table[i];
984 while (po) {
985 if (!pos--)
986 goto out;
987 po = po->next;
990 out:
991 return po;
994 static void *pppoe_seq_start(struct seq_file *seq, loff_t *pos)
995 __acquires(pppoe_hash_lock)
997 loff_t l = *pos;
999 read_lock_bh(&pppoe_hash_lock);
1000 return l ? pppoe_get_idx(--l) : SEQ_START_TOKEN;
1003 static void *pppoe_seq_next(struct seq_file *seq, void *v, loff_t *pos)
1005 struct pppox_sock *po;
1007 ++*pos;
1008 if (v == SEQ_START_TOKEN) {
1009 po = pppoe_get_idx(0);
1010 goto out;
1012 po = v;
1013 if (po->next)
1014 po = po->next;
1015 else {
1016 int hash = hash_item(po->pppoe_pa.sid, po->pppoe_pa.remote);
1018 while (++hash < PPPOE_HASH_SIZE) {
1019 po = item_hash_table[hash];
1020 if (po)
1021 break;
1024 out:
1025 return po;
1028 static void pppoe_seq_stop(struct seq_file *seq, void *v)
1029 __releases(pppoe_hash_lock)
1031 read_unlock_bh(&pppoe_hash_lock);
1034 static struct seq_operations pppoe_seq_ops = {
1035 .start = pppoe_seq_start,
1036 .next = pppoe_seq_next,
1037 .stop = pppoe_seq_stop,
1038 .show = pppoe_seq_show,
1041 static int pppoe_seq_open(struct inode *inode, struct file *file)
1043 return seq_open(file, &pppoe_seq_ops);
1046 static const struct file_operations pppoe_seq_fops = {
1047 .owner = THIS_MODULE,
1048 .open = pppoe_seq_open,
1049 .read = seq_read,
1050 .llseek = seq_lseek,
1051 .release = seq_release,
1054 static int __init pppoe_proc_init(void)
1056 struct proc_dir_entry *p;
1058 p = proc_net_fops_create(&init_net, "pppoe", S_IRUGO, &pppoe_seq_fops);
1059 if (!p)
1060 return -ENOMEM;
1061 return 0;
1063 #else /* CONFIG_PROC_FS */
1064 static inline int pppoe_proc_init(void) { return 0; }
1065 #endif /* CONFIG_PROC_FS */
1067 static const struct proto_ops pppoe_ops = {
1068 .family = AF_PPPOX,
1069 .owner = THIS_MODULE,
1070 .release = pppoe_release,
1071 .bind = sock_no_bind,
1072 .connect = pppoe_connect,
1073 .socketpair = sock_no_socketpair,
1074 .accept = sock_no_accept,
1075 .getname = pppoe_getname,
1076 .poll = datagram_poll,
1077 .listen = sock_no_listen,
1078 .shutdown = sock_no_shutdown,
1079 .setsockopt = sock_no_setsockopt,
1080 .getsockopt = sock_no_getsockopt,
1081 .sendmsg = pppoe_sendmsg,
1082 .recvmsg = pppoe_recvmsg,
1083 .mmap = sock_no_mmap,
1084 .ioctl = pppox_ioctl,
1087 static struct pppox_proto pppoe_proto = {
1088 .create = pppoe_create,
1089 .ioctl = pppoe_ioctl,
1090 .owner = THIS_MODULE,
1094 static int __init pppoe_init(void)
1096 int err = proto_register(&pppoe_sk_proto, 0);
1098 if (err)
1099 goto out;
1101 err = register_pppox_proto(PX_PROTO_OE, &pppoe_proto);
1102 if (err)
1103 goto out_unregister_pppoe_proto;
1105 err = pppoe_proc_init();
1106 if (err)
1107 goto out_unregister_pppox_proto;
1109 dev_add_pack(&pppoes_ptype);
1110 dev_add_pack(&pppoed_ptype);
1111 register_netdevice_notifier(&pppoe_notifier);
1112 out:
1113 return err;
1114 out_unregister_pppox_proto:
1115 unregister_pppox_proto(PX_PROTO_OE);
1116 out_unregister_pppoe_proto:
1117 proto_unregister(&pppoe_sk_proto);
1118 goto out;
1121 static void __exit pppoe_exit(void)
1123 unregister_pppox_proto(PX_PROTO_OE);
1124 dev_remove_pack(&pppoes_ptype);
1125 dev_remove_pack(&pppoed_ptype);
1126 unregister_netdevice_notifier(&pppoe_notifier);
1127 remove_proc_entry("pppoe", init_net.proc_net);
1128 proto_unregister(&pppoe_sk_proto);
1131 module_init(pppoe_init);
1132 module_exit(pppoe_exit);
1134 MODULE_AUTHOR("Michal Ostrowski <mostrows@speakeasy.net>");
1135 MODULE_DESCRIPTION("PPP over Ethernet driver");
1136 MODULE_LICENSE("GPL");
1137 MODULE_ALIAS_NETPROTO(PF_PPPOX);