2 * Generic PPP layer for Linux.
4 * Copyright 1999-2002 Paul Mackerras.
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version
9 * 2 of the License, or (at your option) any later version.
11 * The generic PPP layer handles the PPP network interfaces, the
12 * /dev/ppp device, packet and VJ compression, and multilink.
13 * It talks to PPP `channels' via the interface defined in
14 * include/linux/ppp_channel.h. Channels provide the basic means for
15 * sending and receiving PPP frames on some kind of communications
18 * Part of the code in this driver was inspired by the old async-only
19 * PPP driver, written by Michael Callahan and Al Longyear, and
20 * subsequently hacked by Paul Mackerras.
22 * ==FILEVERSION 20041108==
25 #include <linux/config.h>
26 #include <linux/module.h>
27 #include <linux/kernel.h>
28 #include <linux/kmod.h>
29 #include <linux/init.h>
30 #include <linux/list.h>
31 #include <linux/devfs_fs_kernel.h>
32 #include <linux/netdevice.h>
33 #include <linux/poll.h>
34 #include <linux/ppp_defs.h>
35 #include <linux/filter.h>
36 #include <linux/if_ppp.h>
37 #include <linux/ppp_channel.h>
38 #include <linux/ppp-comp.h>
39 #include <linux/skbuff.h>
40 #include <linux/rtnetlink.h>
41 #include <linux/if_arp.h>
43 #include <linux/tcp.h>
44 #include <linux/spinlock.h>
45 #include <linux/smp_lock.h>
46 #include <linux/rwsem.h>
47 #include <linux/stddef.h>
48 #include <linux/device.h>
49 #include <net/slhc_vj.h>
50 #include <asm/atomic.h>
52 #define PPP_VERSION "2.4.2"
55 * Network protocols we support.
57 #define NP_IP 0 /* Internet Protocol V4 */
58 #define NP_IPV6 1 /* Internet Protocol V6 */
59 #define NP_IPX 2 /* IPX protocol */
60 #define NP_AT 3 /* Appletalk protocol */
61 #define NP_MPLS_UC 4 /* MPLS unicast */
62 #define NP_MPLS_MC 5 /* MPLS multicast */
63 #define NUM_NP 6 /* Number of NPs. */
65 #define MPHDRLEN 6 /* multilink protocol header length */
66 #define MPHDRLEN_SSN 4 /* ditto with short sequence numbers */
67 #define MIN_FRAG_SIZE 64
70 * An instance of /dev/ppp can be associated with either a ppp
71 * interface unit or a ppp channel. In both cases, file->private_data
72 * points to one of these.
78 struct sk_buff_head xq
; /* pppd transmit queue */
79 struct sk_buff_head rq
; /* receive queue for pppd */
80 wait_queue_head_t rwait
; /* for poll on reading /dev/ppp */
81 atomic_t refcnt
; /* # refs (incl /dev/ppp attached) */
82 int hdrlen
; /* space to leave for headers */
83 int index
; /* interface unit / channel number */
84 int dead
; /* unit/channel has been shut down */
87 #define PF_TO_X(pf, X) ((X *)((char *)(pf) - offsetof(X, file)))
89 #define PF_TO_PPP(pf) PF_TO_X(pf, struct ppp)
90 #define PF_TO_CHANNEL(pf) PF_TO_X(pf, struct channel)
92 #define ROUNDUP(n, x) (((n) + (x) - 1) / (x))
95 * Data structure describing one ppp unit.
96 * A ppp unit corresponds to a ppp network interface device
97 * and represents a multilink bundle.
98 * It can have 0 or more ppp channels connected to it.
101 struct ppp_file file
; /* stuff for read/write/poll 0 */
102 struct file
*owner
; /* file that owns this unit 48 */
103 struct list_head channels
; /* list of attached channels 4c */
104 int n_channels
; /* how many channels are attached 54 */
105 spinlock_t rlock
; /* lock for receive side 58 */
106 spinlock_t wlock
; /* lock for transmit side 5c */
107 int mru
; /* max receive unit 60 */
108 unsigned int flags
; /* control bits 64 */
109 unsigned int xstate
; /* transmit state bits 68 */
110 unsigned int rstate
; /* receive state bits 6c */
111 int debug
; /* debug flags 70 */
112 struct slcompress
*vj
; /* state for VJ header compression */
113 enum NPmode npmode
[NUM_NP
]; /* what to do with each net proto 78 */
114 struct sk_buff
*xmit_pending
; /* a packet ready to go out 88 */
115 struct compressor
*xcomp
; /* transmit packet compressor 8c */
116 void *xc_state
; /* its internal state 90 */
117 struct compressor
*rcomp
; /* receive decompressor 94 */
118 void *rc_state
; /* its internal state 98 */
119 unsigned long last_xmit
; /* jiffies when last pkt sent 9c */
120 unsigned long last_recv
; /* jiffies when last pkt rcvd a0 */
121 struct net_device
*dev
; /* network interface device a4 */
122 #ifdef CONFIG_PPP_MULTILINK
123 int nxchan
; /* next channel to send something on */
124 u32 nxseq
; /* next sequence number to send */
125 int mrru
; /* MP: max reconst. receive unit */
126 u32 nextseq
; /* MP: seq no of next packet */
127 u32 minseq
; /* MP: min of most recent seqnos */
128 struct sk_buff_head mrq
; /* MP: receive reconstruction queue */
129 #endif /* CONFIG_PPP_MULTILINK */
130 struct net_device_stats stats
; /* statistics */
131 #ifdef CONFIG_PPP_FILTER
132 struct sock_filter
*pass_filter
; /* filter for packets to pass */
133 struct sock_filter
*active_filter
;/* filter for pkts to reset idle */
134 unsigned pass_len
, active_len
;
135 #endif /* CONFIG_PPP_FILTER */
139 * Bits in flags: SC_NO_TCP_CCID, SC_CCP_OPEN, SC_CCP_UP, SC_LOOP_TRAFFIC,
140 * SC_MULTILINK, SC_MP_SHORTSEQ, SC_MP_XSHORTSEQ, SC_COMP_TCP, SC_REJ_COMP_TCP.
141 * Bits in rstate: SC_DECOMP_RUN, SC_DC_ERROR, SC_DC_FERROR.
142 * Bits in xstate: SC_COMP_RUN
144 #define SC_FLAG_BITS (SC_NO_TCP_CCID|SC_CCP_OPEN|SC_CCP_UP|SC_LOOP_TRAFFIC \
145 |SC_MULTILINK|SC_MP_SHORTSEQ|SC_MP_XSHORTSEQ \
146 |SC_COMP_TCP|SC_REJ_COMP_TCP)
149 * Private data structure for each channel.
150 * This includes the data structure used for multilink.
153 struct ppp_file file
; /* stuff for read/write/poll */
154 struct list_head list
; /* link in all/new_channels list */
155 struct ppp_channel
*chan
; /* public channel data structure */
156 struct rw_semaphore chan_sem
; /* protects `chan' during chan ioctl */
157 spinlock_t downl
; /* protects `chan', file.xq dequeue */
158 struct ppp
*ppp
; /* ppp unit we're connected to */
159 struct list_head clist
; /* link in list of channels per unit */
160 rwlock_t upl
; /* protects `ppp' */
161 #ifdef CONFIG_PPP_MULTILINK
162 u8 avail
; /* flag used in multilink stuff */
163 u8 had_frag
; /* >= 1 fragments have been sent */
164 u32 lastseq
; /* MP: last sequence # received */
165 #endif /* CONFIG_PPP_MULTILINK */
169 * SMP locking issues:
170 * Both the ppp.rlock and ppp.wlock locks protect the ppp.channels
171 * list and the ppp.n_channels field, you need to take both locks
172 * before you modify them.
173 * The lock ordering is: channel.upl -> ppp.wlock -> ppp.rlock ->
178 * A cardmap represents a mapping from unsigned integers to pointers,
179 * and provides a fast "find lowest unused number" operation.
180 * It uses a broad (32-way) tree with a bitmap at each level.
181 * It is designed to be space-efficient for small numbers of entries
182 * and time-efficient for large numbers of entries.
184 #define CARDMAP_ORDER 5
185 #define CARDMAP_WIDTH (1U << CARDMAP_ORDER)
186 #define CARDMAP_MASK (CARDMAP_WIDTH - 1)
191 struct cardmap
*parent
;
192 void *ptr
[CARDMAP_WIDTH
];
194 static void *cardmap_get(struct cardmap
*map
, unsigned int nr
);
195 static void cardmap_set(struct cardmap
**map
, unsigned int nr
, void *ptr
);
196 static unsigned int cardmap_find_first_free(struct cardmap
*map
);
197 static void cardmap_destroy(struct cardmap
**map
);
200 * all_ppp_sem protects the all_ppp_units mapping.
201 * It also ensures that finding a ppp unit in the all_ppp_units map
202 * and updating its file.refcnt field is atomic.
204 static DECLARE_MUTEX(all_ppp_sem
);
205 static struct cardmap
*all_ppp_units
;
206 static atomic_t ppp_unit_count
= ATOMIC_INIT(0);
209 * all_channels_lock protects all_channels and last_channel_index,
210 * and the atomicity of find a channel and updating its file.refcnt
213 static DEFINE_SPINLOCK(all_channels_lock
);
214 static LIST_HEAD(all_channels
);
215 static LIST_HEAD(new_channels
);
216 static int last_channel_index
;
217 static atomic_t channel_count
= ATOMIC_INIT(0);
219 /* Get the PPP protocol number from a skb */
220 #define PPP_PROTO(skb) (((skb)->data[0] << 8) + (skb)->data[1])
222 /* We limit the length of ppp->file.rq to this (arbitrary) value */
223 #define PPP_MAX_RQLEN 32
226 * Maximum number of multilink fragments queued up.
227 * This has to be large enough to cope with the maximum latency of
228 * the slowest channel relative to the others. Strictly it should
229 * depend on the number of channels and their characteristics.
231 #define PPP_MP_MAX_QLEN 128
233 /* Multilink header bits. */
234 #define B 0x80 /* this fragment begins a packet */
235 #define E 0x40 /* this fragment ends a packet */
237 /* Compare multilink sequence numbers (assumed to be 32 bits wide) */
238 #define seq_before(a, b) ((s32)((a) - (b)) < 0)
239 #define seq_after(a, b) ((s32)((a) - (b)) > 0)
242 static int ppp_unattached_ioctl(struct ppp_file
*pf
, struct file
*file
,
243 unsigned int cmd
, unsigned long arg
);
244 static void ppp_xmit_process(struct ppp
*ppp
);
245 static void ppp_send_frame(struct ppp
*ppp
, struct sk_buff
*skb
);
246 static void ppp_push(struct ppp
*ppp
);
247 static void ppp_channel_push(struct channel
*pch
);
248 static void ppp_receive_frame(struct ppp
*ppp
, struct sk_buff
*skb
,
249 struct channel
*pch
);
250 static void ppp_receive_error(struct ppp
*ppp
);
251 static void ppp_receive_nonmp_frame(struct ppp
*ppp
, struct sk_buff
*skb
);
252 static struct sk_buff
*ppp_decompress_frame(struct ppp
*ppp
,
253 struct sk_buff
*skb
);
254 #ifdef CONFIG_PPP_MULTILINK
255 static void ppp_receive_mp_frame(struct ppp
*ppp
, struct sk_buff
*skb
,
256 struct channel
*pch
);
257 static void ppp_mp_insert(struct ppp
*ppp
, struct sk_buff
*skb
);
258 static struct sk_buff
*ppp_mp_reconstruct(struct ppp
*ppp
);
259 static int ppp_mp_explode(struct ppp
*ppp
, struct sk_buff
*skb
);
260 #endif /* CONFIG_PPP_MULTILINK */
261 static int ppp_set_compress(struct ppp
*ppp
, unsigned long arg
);
262 static void ppp_ccp_peek(struct ppp
*ppp
, struct sk_buff
*skb
, int inbound
);
263 static void ppp_ccp_closed(struct ppp
*ppp
);
264 static struct compressor
*find_compressor(int type
);
265 static void ppp_get_stats(struct ppp
*ppp
, struct ppp_stats
*st
);
266 static struct ppp
*ppp_create_interface(int unit
, int *retp
);
267 static void init_ppp_file(struct ppp_file
*pf
, int kind
);
268 static void ppp_shutdown_interface(struct ppp
*ppp
);
269 static void ppp_destroy_interface(struct ppp
*ppp
);
270 static struct ppp
*ppp_find_unit(int unit
);
271 static struct channel
*ppp_find_channel(int unit
);
272 static int ppp_connect_channel(struct channel
*pch
, int unit
);
273 static int ppp_disconnect_channel(struct channel
*pch
);
274 static void ppp_destroy_channel(struct channel
*pch
);
276 static struct class *ppp_class
;
278 /* Translates a PPP protocol number to a NP index (NP == network protocol) */
279 static inline int proto_to_npindex(int proto
)
298 /* Translates an NP index into a PPP protocol number */
299 static const int npindex_to_proto
[NUM_NP
] = {
308 /* Translates an ethertype into an NP index */
309 static inline int ethertype_to_npindex(int ethertype
)
329 /* Translates an NP index into an ethertype */
330 static const int npindex_to_ethertype
[NUM_NP
] = {
342 #define ppp_xmit_lock(ppp) spin_lock_bh(&(ppp)->wlock)
343 #define ppp_xmit_unlock(ppp) spin_unlock_bh(&(ppp)->wlock)
344 #define ppp_recv_lock(ppp) spin_lock_bh(&(ppp)->rlock)
345 #define ppp_recv_unlock(ppp) spin_unlock_bh(&(ppp)->rlock)
346 #define ppp_lock(ppp) do { ppp_xmit_lock(ppp); \
347 ppp_recv_lock(ppp); } while (0)
348 #define ppp_unlock(ppp) do { ppp_recv_unlock(ppp); \
349 ppp_xmit_unlock(ppp); } while (0)
352 * /dev/ppp device routines.
353 * The /dev/ppp device is used by pppd to control the ppp unit.
354 * It supports the read, write, ioctl and poll functions.
355 * Open instances of /dev/ppp can be in one of three states:
356 * unattached, attached to a ppp unit, or attached to a ppp channel.
358 static int ppp_open(struct inode
*inode
, struct file
*file
)
361 * This could (should?) be enforced by the permissions on /dev/ppp.
363 if (!capable(CAP_NET_ADMIN
))
368 static int ppp_release(struct inode
*inode
, struct file
*file
)
370 struct ppp_file
*pf
= file
->private_data
;
374 file
->private_data
= NULL
;
375 if (pf
->kind
== INTERFACE
) {
377 if (file
== ppp
->owner
)
378 ppp_shutdown_interface(ppp
);
380 if (atomic_dec_and_test(&pf
->refcnt
)) {
383 ppp_destroy_interface(PF_TO_PPP(pf
));
386 ppp_destroy_channel(PF_TO_CHANNEL(pf
));
394 static ssize_t
ppp_read(struct file
*file
, char __user
*buf
,
395 size_t count
, loff_t
*ppos
)
397 struct ppp_file
*pf
= file
->private_data
;
398 DECLARE_WAITQUEUE(wait
, current
);
400 struct sk_buff
*skb
= NULL
;
406 add_wait_queue(&pf
->rwait
, &wait
);
408 set_current_state(TASK_INTERRUPTIBLE
);
409 skb
= skb_dequeue(&pf
->rq
);
415 if (pf
->kind
== INTERFACE
) {
417 * Return 0 (EOF) on an interface that has no
418 * channels connected, unless it is looping
419 * network traffic (demand mode).
421 struct ppp
*ppp
= PF_TO_PPP(pf
);
422 if (ppp
->n_channels
== 0
423 && (ppp
->flags
& SC_LOOP_TRAFFIC
) == 0)
427 if (file
->f_flags
& O_NONBLOCK
)
430 if (signal_pending(current
))
434 set_current_state(TASK_RUNNING
);
435 remove_wait_queue(&pf
->rwait
, &wait
);
441 if (skb
->len
> count
)
444 if (copy_to_user(buf
, skb
->data
, skb
->len
))
454 static ssize_t
ppp_write(struct file
*file
, const char __user
*buf
,
455 size_t count
, loff_t
*ppos
)
457 struct ppp_file
*pf
= file
->private_data
;
464 skb
= alloc_skb(count
+ pf
->hdrlen
, GFP_KERNEL
);
467 skb_reserve(skb
, pf
->hdrlen
);
469 if (copy_from_user(skb_put(skb
, count
), buf
, count
)) {
474 skb_queue_tail(&pf
->xq
, skb
);
478 ppp_xmit_process(PF_TO_PPP(pf
));
481 ppp_channel_push(PF_TO_CHANNEL(pf
));
491 /* No kernel lock - fine */
492 static unsigned int ppp_poll(struct file
*file
, poll_table
*wait
)
494 struct ppp_file
*pf
= file
->private_data
;
499 poll_wait(file
, &pf
->rwait
, wait
);
500 mask
= POLLOUT
| POLLWRNORM
;
501 if (skb_peek(&pf
->rq
) != 0)
502 mask
|= POLLIN
| POLLRDNORM
;
505 else if (pf
->kind
== INTERFACE
) {
506 /* see comment in ppp_read */
507 struct ppp
*ppp
= PF_TO_PPP(pf
);
508 if (ppp
->n_channels
== 0
509 && (ppp
->flags
& SC_LOOP_TRAFFIC
) == 0)
510 mask
|= POLLIN
| POLLRDNORM
;
516 #ifdef CONFIG_PPP_FILTER
517 static int get_filter(void __user
*arg
, struct sock_filter
**p
)
519 struct sock_fprog uprog
;
520 struct sock_filter
*code
= NULL
;
523 if (copy_from_user(&uprog
, arg
, sizeof(uprog
)))
526 if (uprog
.len
> BPF_MAXINSNS
)
534 len
= uprog
.len
* sizeof(struct sock_filter
);
535 code
= kmalloc(len
, GFP_KERNEL
);
539 if (copy_from_user(code
, uprog
.filter
, len
)) {
544 err
= sk_chk_filter(code
, uprog
.len
);
553 #endif /* CONFIG_PPP_FILTER */
555 static int ppp_ioctl(struct inode
*inode
, struct file
*file
,
556 unsigned int cmd
, unsigned long arg
)
558 struct ppp_file
*pf
= file
->private_data
;
560 int err
= -EFAULT
, val
, val2
, i
;
561 struct ppp_idle idle
;
564 struct slcompress
*vj
;
565 void __user
*argp
= (void __user
*)arg
;
566 int __user
*p
= argp
;
569 return ppp_unattached_ioctl(pf
, file
, cmd
, arg
);
571 if (cmd
== PPPIOCDETACH
) {
573 * We have to be careful here... if the file descriptor
574 * has been dup'd, we could have another process in the
575 * middle of a poll using the same file *, so we had
576 * better not free the interface data structures -
577 * instead we fail the ioctl. Even in this case, we
578 * shut down the interface if we are the owner of it.
579 * Actually, we should get rid of PPPIOCDETACH, userland
580 * (i.e. pppd) could achieve the same effect by closing
581 * this fd and reopening /dev/ppp.
584 if (pf
->kind
== INTERFACE
) {
586 if (file
== ppp
->owner
)
587 ppp_shutdown_interface(ppp
);
589 if (atomic_read(&file
->f_count
) <= 2) {
590 ppp_release(inode
, file
);
593 printk(KERN_DEBUG
"PPPIOCDETACH file->f_count=%d\n",
594 atomic_read(&file
->f_count
));
598 if (pf
->kind
== CHANNEL
) {
599 struct channel
*pch
= PF_TO_CHANNEL(pf
);
600 struct ppp_channel
*chan
;
604 if (get_user(unit
, p
))
606 err
= ppp_connect_channel(pch
, unit
);
610 err
= ppp_disconnect_channel(pch
);
614 down_read(&pch
->chan_sem
);
617 if (chan
&& chan
->ops
->ioctl
)
618 err
= chan
->ops
->ioctl(chan
, cmd
, arg
);
619 up_read(&pch
->chan_sem
);
624 if (pf
->kind
!= INTERFACE
) {
626 printk(KERN_ERR
"PPP: not interface or channel??\n");
633 if (get_user(val
, p
))
640 if (get_user(val
, p
))
643 cflags
= ppp
->flags
& ~val
;
644 ppp
->flags
= val
& SC_FLAG_BITS
;
646 if (cflags
& SC_CCP_OPEN
)
652 val
= ppp
->flags
| ppp
->xstate
| ppp
->rstate
;
653 if (put_user(val
, p
))
658 case PPPIOCSCOMPRESS
:
659 err
= ppp_set_compress(ppp
, arg
);
663 if (put_user(ppp
->file
.index
, p
))
669 if (get_user(val
, p
))
676 if (put_user(ppp
->debug
, p
))
682 idle
.xmit_idle
= (jiffies
- ppp
->last_xmit
) / HZ
;
683 idle
.recv_idle
= (jiffies
- ppp
->last_recv
) / HZ
;
684 if (copy_to_user(argp
, &idle
, sizeof(idle
)))
690 if (get_user(val
, p
))
693 if ((val
>> 16) != 0) {
697 vj
= slhc_init(val2
+1, val
+1);
699 printk(KERN_ERR
"PPP: no memory (VJ compressor)\n");
713 if (copy_from_user(&npi
, argp
, sizeof(npi
)))
715 err
= proto_to_npindex(npi
.protocol
);
719 if (cmd
== PPPIOCGNPMODE
) {
721 npi
.mode
= ppp
->npmode
[i
];
722 if (copy_to_user(argp
, &npi
, sizeof(npi
)))
725 ppp
->npmode
[i
] = npi
.mode
;
726 /* we may be able to transmit more packets now (??) */
727 netif_wake_queue(ppp
->dev
);
732 #ifdef CONFIG_PPP_FILTER
735 struct sock_filter
*code
;
736 err
= get_filter(argp
, &code
);
739 kfree(ppp
->pass_filter
);
740 ppp
->pass_filter
= code
;
749 struct sock_filter
*code
;
750 err
= get_filter(argp
, &code
);
753 kfree(ppp
->active_filter
);
754 ppp
->active_filter
= code
;
755 ppp
->active_len
= err
;
761 #endif /* CONFIG_PPP_FILTER */
763 #ifdef CONFIG_PPP_MULTILINK
765 if (get_user(val
, p
))
769 ppp_recv_unlock(ppp
);
772 #endif /* CONFIG_PPP_MULTILINK */
781 static int ppp_unattached_ioctl(struct ppp_file
*pf
, struct file
*file
,
782 unsigned int cmd
, unsigned long arg
)
784 int unit
, err
= -EFAULT
;
786 struct channel
*chan
;
787 int __user
*p
= (int __user
*)arg
;
791 /* Create a new ppp unit */
792 if (get_user(unit
, p
))
794 ppp
= ppp_create_interface(unit
, &err
);
797 file
->private_data
= &ppp
->file
;
800 if (put_user(ppp
->file
.index
, p
))
806 /* Attach to an existing ppp unit */
807 if (get_user(unit
, p
))
811 ppp
= ppp_find_unit(unit
);
813 atomic_inc(&ppp
->file
.refcnt
);
814 file
->private_data
= &ppp
->file
;
821 if (get_user(unit
, p
))
823 spin_lock_bh(&all_channels_lock
);
825 chan
= ppp_find_channel(unit
);
827 atomic_inc(&chan
->file
.refcnt
);
828 file
->private_data
= &chan
->file
;
831 spin_unlock_bh(&all_channels_lock
);
840 static struct file_operations ppp_device_fops
= {
841 .owner
= THIS_MODULE
,
847 .release
= ppp_release
850 #define PPP_MAJOR 108
852 /* Called at boot time if ppp is compiled into the kernel,
853 or at module load time (from init_module) if compiled as a module. */
854 static int __init
ppp_init(void)
858 printk(KERN_INFO
"PPP generic driver version " PPP_VERSION
"\n");
859 err
= register_chrdev(PPP_MAJOR
, "ppp", &ppp_device_fops
);
861 ppp_class
= class_create(THIS_MODULE
, "ppp");
862 if (IS_ERR(ppp_class
)) {
863 err
= PTR_ERR(ppp_class
);
866 class_device_create(ppp_class
, MKDEV(PPP_MAJOR
, 0), NULL
, "ppp");
867 err
= devfs_mk_cdev(MKDEV(PPP_MAJOR
, 0),
868 S_IFCHR
|S_IRUSR
|S_IWUSR
, "ppp");
875 printk(KERN_ERR
"failed to register PPP device (%d)\n", err
);
879 class_device_destroy(ppp_class
, MKDEV(PPP_MAJOR
,0));
880 class_destroy(ppp_class
);
882 unregister_chrdev(PPP_MAJOR
, "ppp");
887 * Network interface unit routines.
890 ppp_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
892 struct ppp
*ppp
= (struct ppp
*) dev
->priv
;
896 npi
= ethertype_to_npindex(ntohs(skb
->protocol
));
900 /* Drop, accept or reject the packet */
901 switch (ppp
->npmode
[npi
]) {
905 /* it would be nice to have a way to tell the network
906 system to queue this one up for later. */
913 /* Put the 2-byte PPP protocol number on the front,
914 making sure there is room for the address and control fields. */
915 if (skb_headroom(skb
) < PPP_HDRLEN
) {
918 ns
= alloc_skb(skb
->len
+ dev
->hard_header_len
, GFP_ATOMIC
);
921 skb_reserve(ns
, dev
->hard_header_len
);
922 skb_copy_bits(skb
, 0, skb_put(ns
, skb
->len
), skb
->len
);
926 pp
= skb_push(skb
, 2);
927 proto
= npindex_to_proto
[npi
];
931 netif_stop_queue(dev
);
932 skb_queue_tail(&ppp
->file
.xq
, skb
);
933 ppp_xmit_process(ppp
);
938 ++ppp
->stats
.tx_dropped
;
942 static struct net_device_stats
*
943 ppp_net_stats(struct net_device
*dev
)
945 struct ppp
*ppp
= (struct ppp
*) dev
->priv
;
951 ppp_net_ioctl(struct net_device
*dev
, struct ifreq
*ifr
, int cmd
)
953 struct ppp
*ppp
= dev
->priv
;
955 void __user
*addr
= (void __user
*) ifr
->ifr_ifru
.ifru_data
;
956 struct ppp_stats stats
;
957 struct ppp_comp_stats cstats
;
962 ppp_get_stats(ppp
, &stats
);
963 if (copy_to_user(addr
, &stats
, sizeof(stats
)))
969 memset(&cstats
, 0, sizeof(cstats
));
970 if (ppp
->xc_state
!= 0)
971 ppp
->xcomp
->comp_stat(ppp
->xc_state
, &cstats
.c
);
972 if (ppp
->rc_state
!= 0)
973 ppp
->rcomp
->decomp_stat(ppp
->rc_state
, &cstats
.d
);
974 if (copy_to_user(addr
, &cstats
, sizeof(cstats
)))
981 if (copy_to_user(addr
, vers
, strlen(vers
) + 1))
993 static void ppp_setup(struct net_device
*dev
)
995 dev
->hard_header_len
= PPP_HDRLEN
;
998 dev
->tx_queue_len
= 3;
999 dev
->type
= ARPHRD_PPP
;
1000 dev
->flags
= IFF_POINTOPOINT
| IFF_NOARP
| IFF_MULTICAST
;
1004 * Transmit-side routines.
1008 * Called to do any work queued up on the transmit side
1009 * that can now be done.
1012 ppp_xmit_process(struct ppp
*ppp
)
1014 struct sk_buff
*skb
;
1017 if (ppp
->dev
!= 0) {
1019 while (ppp
->xmit_pending
== 0
1020 && (skb
= skb_dequeue(&ppp
->file
.xq
)) != 0)
1021 ppp_send_frame(ppp
, skb
);
1022 /* If there's no work left to do, tell the core net
1023 code that we can accept some more. */
1024 if (ppp
->xmit_pending
== 0 && skb_peek(&ppp
->file
.xq
) == 0)
1025 netif_wake_queue(ppp
->dev
);
1027 ppp_xmit_unlock(ppp
);
1031 * Compress and send a frame.
1032 * The caller should have locked the xmit path,
1033 * and xmit_pending should be 0.
1036 ppp_send_frame(struct ppp
*ppp
, struct sk_buff
*skb
)
1038 int proto
= PPP_PROTO(skb
);
1039 struct sk_buff
*new_skb
;
1043 if (proto
< 0x8000) {
1044 #ifdef CONFIG_PPP_FILTER
1045 /* check if we should pass this packet */
1046 /* the filter instructions are constructed assuming
1047 a four-byte PPP header on each packet */
1048 *skb_push(skb
, 2) = 1;
1049 if (ppp
->pass_filter
1050 && sk_run_filter(skb
, ppp
->pass_filter
,
1051 ppp
->pass_len
) == 0) {
1053 printk(KERN_DEBUG
"PPP: outbound frame not passed\n");
1057 /* if this packet passes the active filter, record the time */
1058 if (!(ppp
->active_filter
1059 && sk_run_filter(skb
, ppp
->active_filter
,
1060 ppp
->active_len
) == 0))
1061 ppp
->last_xmit
= jiffies
;
1064 /* for data packets, record the time */
1065 ppp
->last_xmit
= jiffies
;
1066 #endif /* CONFIG_PPP_FILTER */
1069 ++ppp
->stats
.tx_packets
;
1070 ppp
->stats
.tx_bytes
+= skb
->len
- 2;
1074 if (ppp
->vj
== 0 || (ppp
->flags
& SC_COMP_TCP
) == 0)
1076 /* try to do VJ TCP header compression */
1077 new_skb
= alloc_skb(skb
->len
+ ppp
->dev
->hard_header_len
- 2,
1080 printk(KERN_ERR
"PPP: no memory (VJ comp pkt)\n");
1083 skb_reserve(new_skb
, ppp
->dev
->hard_header_len
- 2);
1085 len
= slhc_compress(ppp
->vj
, cp
, skb
->len
- 2,
1086 new_skb
->data
+ 2, &cp
,
1087 !(ppp
->flags
& SC_NO_TCP_CCID
));
1088 if (cp
== skb
->data
+ 2) {
1089 /* didn't compress */
1092 if (cp
[0] & SL_TYPE_COMPRESSED_TCP
) {
1093 proto
= PPP_VJC_COMP
;
1094 cp
[0] &= ~SL_TYPE_COMPRESSED_TCP
;
1096 proto
= PPP_VJC_UNCOMP
;
1097 cp
[0] = skb
->data
[2];
1101 cp
= skb_put(skb
, len
+ 2);
1108 /* peek at outbound CCP frames */
1109 ppp_ccp_peek(ppp
, skb
, 0);
1113 /* try to do packet compression */
1114 if ((ppp
->xstate
& SC_COMP_RUN
) && ppp
->xc_state
!= 0
1115 && proto
!= PPP_LCP
&& proto
!= PPP_CCP
) {
1116 new_skb
= alloc_skb(ppp
->dev
->mtu
+ ppp
->dev
->hard_header_len
,
1119 printk(KERN_ERR
"PPP: no memory (comp pkt)\n");
1122 if (ppp
->dev
->hard_header_len
> PPP_HDRLEN
)
1123 skb_reserve(new_skb
,
1124 ppp
->dev
->hard_header_len
- PPP_HDRLEN
);
1126 /* compressor still expects A/C bytes in hdr */
1127 len
= ppp
->xcomp
->compress(ppp
->xc_state
, skb
->data
- 2,
1128 new_skb
->data
, skb
->len
+ 2,
1129 ppp
->dev
->mtu
+ PPP_HDRLEN
);
1130 if (len
> 0 && (ppp
->flags
& SC_CCP_UP
)) {
1134 skb_pull(skb
, 2); /* pull off A/C bytes */
1136 /* didn't compress, or CCP not up yet */
1142 * If we are waiting for traffic (demand dialling),
1143 * queue it up for pppd to receive.
1145 if (ppp
->flags
& SC_LOOP_TRAFFIC
) {
1146 if (ppp
->file
.rq
.qlen
> PPP_MAX_RQLEN
)
1148 skb_queue_tail(&ppp
->file
.rq
, skb
);
1149 wake_up_interruptible(&ppp
->file
.rwait
);
1153 ppp
->xmit_pending
= skb
;
1159 ++ppp
->stats
.tx_errors
;
1163 * Try to send the frame in xmit_pending.
1164 * The caller should have the xmit path locked.
1167 ppp_push(struct ppp
*ppp
)
1169 struct list_head
*list
;
1170 struct channel
*pch
;
1171 struct sk_buff
*skb
= ppp
->xmit_pending
;
1176 list
= &ppp
->channels
;
1177 if (list_empty(list
)) {
1178 /* nowhere to send the packet, just drop it */
1179 ppp
->xmit_pending
= NULL
;
1184 if ((ppp
->flags
& SC_MULTILINK
) == 0) {
1185 /* not doing multilink: send it down the first channel */
1187 pch
= list_entry(list
, struct channel
, clist
);
1189 spin_lock_bh(&pch
->downl
);
1191 if (pch
->chan
->ops
->start_xmit(pch
->chan
, skb
))
1192 ppp
->xmit_pending
= NULL
;
1194 /* channel got unregistered */
1196 ppp
->xmit_pending
= NULL
;
1198 spin_unlock_bh(&pch
->downl
);
1202 #ifdef CONFIG_PPP_MULTILINK
1203 /* Multilink: fragment the packet over as many links
1204 as can take the packet at the moment. */
1205 if (!ppp_mp_explode(ppp
, skb
))
1207 #endif /* CONFIG_PPP_MULTILINK */
1209 ppp
->xmit_pending
= NULL
;
1213 #ifdef CONFIG_PPP_MULTILINK
1215 * Divide a packet to be transmitted into fragments and
1216 * send them out the individual links.
1218 static int ppp_mp_explode(struct ppp
*ppp
, struct sk_buff
*skb
)
1221 int i
, bits
, hdrlen
, mtu
;
1225 unsigned char *p
, *q
;
1226 struct list_head
*list
;
1227 struct channel
*pch
;
1228 struct sk_buff
*frag
;
1229 struct ppp_channel
*chan
;
1231 nfree
= 0; /* # channels which have no packet already queued */
1232 navail
= 0; /* total # of usable channels (not deregistered) */
1233 hdrlen
= (ppp
->flags
& SC_MP_XSHORTSEQ
)? MPHDRLEN_SSN
: MPHDRLEN
;
1235 list_for_each_entry(pch
, &ppp
->channels
, clist
) {
1236 navail
+= pch
->avail
= (pch
->chan
!= NULL
);
1238 if (skb_queue_empty(&pch
->file
.xq
) ||
1243 if (!pch
->had_frag
&& i
< ppp
->nxchan
)
1250 * Don't start sending this packet unless at least half of
1251 * the channels are free. This gives much better TCP
1252 * performance if we have a lot of channels.
1254 if (nfree
== 0 || nfree
< navail
/ 2)
1255 return 0; /* can't take now, leave it in xmit_pending */
1257 /* Do protocol field compression (XXX this should be optional) */
1266 * Decide on fragment size.
1267 * We create a fragment for each free channel regardless of
1268 * how small they are (i.e. even 0 length) in order to minimize
1269 * the time that it will take to detect when a channel drops
1274 fragsize
= ROUNDUP(fragsize
, nfree
);
1275 /* nbigger channels get fragsize bytes, the rest get fragsize-1,
1276 except if nbigger==0, then they all get fragsize. */
1277 nbigger
= len
% nfree
;
1279 /* skip to the channel after the one we last used
1280 and start at that one */
1281 list
= &ppp
->channels
;
1282 for (i
= 0; i
< ppp
->nxchan
; ++i
) {
1284 if (list
== &ppp
->channels
) {
1290 /* create a fragment for each channel */
1292 while (nfree
> 0 || len
> 0) {
1294 if (list
== &ppp
->channels
) {
1298 pch
= list_entry(list
, struct channel
, clist
);
1304 * Skip this channel if it has a fragment pending already and
1305 * we haven't given a fragment to all of the free channels.
1307 if (pch
->avail
== 1) {
1315 /* check the channel's mtu and whether it is still attached. */
1316 spin_lock_bh(&pch
->downl
);
1317 if (pch
->chan
== NULL
) {
1318 /* can't use this channel, it's being deregistered */
1319 spin_unlock_bh(&pch
->downl
);
1327 * Create a fragment for this channel of
1328 * min(max(mtu+2-hdrlen, 4), fragsize, len) bytes.
1329 * If mtu+2-hdrlen < 4, that is a ridiculously small
1330 * MTU, so we use mtu = 2 + hdrlen.
1335 mtu
= pch
->chan
->mtu
+ 2 - hdrlen
;
1340 if (flen
== len
&& nfree
== 0)
1342 frag
= alloc_skb(flen
+ hdrlen
+ (flen
== 0), GFP_ATOMIC
);
1345 q
= skb_put(frag
, flen
+ hdrlen
);
1347 /* make the MP header */
1350 if (ppp
->flags
& SC_MP_XSHORTSEQ
) {
1351 q
[2] = bits
+ ((ppp
->nxseq
>> 8) & 0xf);
1355 q
[3] = ppp
->nxseq
>> 16;
1356 q
[4] = ppp
->nxseq
>> 8;
1362 * Unfortunately there is a bug in older versions of
1363 * the Linux PPP multilink reconstruction code where it
1364 * drops 0-length fragments. Therefore we make sure the
1365 * fragment has at least one byte of data. Any bytes
1366 * we add in this situation will end up as padding on the
1367 * end of the reconstructed packet.
1370 *skb_put(frag
, 1) = 0;
1372 memcpy(q
+ hdrlen
, p
, flen
);
1374 /* try to send it down the channel */
1376 if (!skb_queue_empty(&pch
->file
.xq
) ||
1377 !chan
->ops
->start_xmit(chan
, frag
))
1378 skb_queue_tail(&pch
->file
.xq
, frag
);
1384 spin_unlock_bh(&pch
->downl
);
1386 if (--nbigger
== 0 && fragsize
> 0)
1394 spin_unlock_bh(&pch
->downl
);
1396 printk(KERN_ERR
"PPP: no memory (fragment)\n");
1397 ++ppp
->stats
.tx_errors
;
1399 return 1; /* abandon the frame */
1401 #endif /* CONFIG_PPP_MULTILINK */
1404 * Try to send data out on a channel.
1407 ppp_channel_push(struct channel
*pch
)
1409 struct sk_buff
*skb
;
1412 spin_lock_bh(&pch
->downl
);
1413 if (pch
->chan
!= 0) {
1414 while (!skb_queue_empty(&pch
->file
.xq
)) {
1415 skb
= skb_dequeue(&pch
->file
.xq
);
1416 if (!pch
->chan
->ops
->start_xmit(pch
->chan
, skb
)) {
1417 /* put the packet back and try again later */
1418 skb_queue_head(&pch
->file
.xq
, skb
);
1423 /* channel got deregistered */
1424 skb_queue_purge(&pch
->file
.xq
);
1426 spin_unlock_bh(&pch
->downl
);
1427 /* see if there is anything from the attached unit to be sent */
1428 if (skb_queue_empty(&pch
->file
.xq
)) {
1429 read_lock_bh(&pch
->upl
);
1432 ppp_xmit_process(ppp
);
1433 read_unlock_bh(&pch
->upl
);
1438 * Receive-side routines.
1441 /* misuse a few fields of the skb for MP reconstruction */
1442 #define sequence priority
1443 #define BEbits cb[0]
1446 ppp_do_recv(struct ppp
*ppp
, struct sk_buff
*skb
, struct channel
*pch
)
1449 /* ppp->dev == 0 means interface is closing down */
1451 ppp_receive_frame(ppp
, skb
, pch
);
1454 ppp_recv_unlock(ppp
);
1458 ppp_input(struct ppp_channel
*chan
, struct sk_buff
*skb
)
1460 struct channel
*pch
= chan
->ppp
;
1463 if (pch
== 0 || skb
->len
== 0) {
1468 proto
= PPP_PROTO(skb
);
1469 read_lock_bh(&pch
->upl
);
1470 if (pch
->ppp
== 0 || proto
>= 0xc000 || proto
== PPP_CCPFRAG
) {
1471 /* put it on the channel queue */
1472 skb_queue_tail(&pch
->file
.rq
, skb
);
1473 /* drop old frames if queue too long */
1474 while (pch
->file
.rq
.qlen
> PPP_MAX_RQLEN
1475 && (skb
= skb_dequeue(&pch
->file
.rq
)) != 0)
1477 wake_up_interruptible(&pch
->file
.rwait
);
1479 ppp_do_recv(pch
->ppp
, skb
, pch
);
1481 read_unlock_bh(&pch
->upl
);
1484 /* Put a 0-length skb in the receive queue as an error indication */
1486 ppp_input_error(struct ppp_channel
*chan
, int code
)
1488 struct channel
*pch
= chan
->ppp
;
1489 struct sk_buff
*skb
;
1494 read_lock_bh(&pch
->upl
);
1495 if (pch
->ppp
!= 0) {
1496 skb
= alloc_skb(0, GFP_ATOMIC
);
1498 skb
->len
= 0; /* probably unnecessary */
1500 ppp_do_recv(pch
->ppp
, skb
, pch
);
1503 read_unlock_bh(&pch
->upl
);
1507 * We come in here to process a received frame.
1508 * The receive side of the ppp unit is locked.
1511 ppp_receive_frame(struct ppp
*ppp
, struct sk_buff
*skb
, struct channel
*pch
)
1513 if (skb
->len
>= 2) {
1514 #ifdef CONFIG_PPP_MULTILINK
1515 /* XXX do channel-level decompression here */
1516 if (PPP_PROTO(skb
) == PPP_MP
)
1517 ppp_receive_mp_frame(ppp
, skb
, pch
);
1519 #endif /* CONFIG_PPP_MULTILINK */
1520 ppp_receive_nonmp_frame(ppp
, skb
);
1525 /* note: a 0-length skb is used as an error indication */
1526 ++ppp
->stats
.rx_length_errors
;
1529 ppp_receive_error(ppp
);
1533 ppp_receive_error(struct ppp
*ppp
)
1535 ++ppp
->stats
.rx_errors
;
1541 ppp_receive_nonmp_frame(struct ppp
*ppp
, struct sk_buff
*skb
)
1544 int proto
, len
, npi
;
1547 * Decompress the frame, if compressed.
1548 * Note that some decompressors need to see uncompressed frames
1549 * that come in as well as compressed frames.
1551 if (ppp
->rc_state
!= 0 && (ppp
->rstate
& SC_DECOMP_RUN
)
1552 && (ppp
->rstate
& (SC_DC_FERROR
| SC_DC_ERROR
)) == 0)
1553 skb
= ppp_decompress_frame(ppp
, skb
);
1555 proto
= PPP_PROTO(skb
);
1558 /* decompress VJ compressed packets */
1559 if (ppp
->vj
== 0 || (ppp
->flags
& SC_REJ_COMP_TCP
))
1562 if (skb_tailroom(skb
) < 124) {
1563 /* copy to a new sk_buff with more tailroom */
1564 ns
= dev_alloc_skb(skb
->len
+ 128);
1566 printk(KERN_ERR
"PPP: no memory (VJ decomp)\n");
1570 skb_copy_bits(skb
, 0, skb_put(ns
, skb
->len
), skb
->len
);
1574 else if (!pskb_may_pull(skb
, skb
->len
))
1577 len
= slhc_uncompress(ppp
->vj
, skb
->data
+ 2, skb
->len
- 2);
1579 printk(KERN_DEBUG
"PPP: VJ decompression error\n");
1584 skb_put(skb
, len
- skb
->len
);
1585 else if (len
< skb
->len
)
1590 case PPP_VJC_UNCOMP
:
1591 if (ppp
->vj
== 0 || (ppp
->flags
& SC_REJ_COMP_TCP
))
1594 /* Until we fix the decompressor need to make sure
1595 * data portion is linear.
1597 if (!pskb_may_pull(skb
, skb
->len
))
1600 if (slhc_remember(ppp
->vj
, skb
->data
+ 2, skb
->len
- 2) <= 0) {
1601 printk(KERN_ERR
"PPP: VJ uncompressed error\n");
1608 ppp_ccp_peek(ppp
, skb
, 1);
1612 ++ppp
->stats
.rx_packets
;
1613 ppp
->stats
.rx_bytes
+= skb
->len
- 2;
1615 npi
= proto_to_npindex(proto
);
1617 /* control or unknown frame - pass it to pppd */
1618 skb_queue_tail(&ppp
->file
.rq
, skb
);
1619 /* limit queue length by dropping old frames */
1620 while (ppp
->file
.rq
.qlen
> PPP_MAX_RQLEN
1621 && (skb
= skb_dequeue(&ppp
->file
.rq
)) != 0)
1623 /* wake up any process polling or blocking on read */
1624 wake_up_interruptible(&ppp
->file
.rwait
);
1627 /* network protocol frame - give it to the kernel */
1629 #ifdef CONFIG_PPP_FILTER
1630 /* check if the packet passes the pass and active filters */
1631 /* the filter instructions are constructed assuming
1632 a four-byte PPP header on each packet */
1633 *skb_push(skb
, 2) = 0;
1634 if (ppp
->pass_filter
1635 && sk_run_filter(skb
, ppp
->pass_filter
,
1636 ppp
->pass_len
) == 0) {
1638 printk(KERN_DEBUG
"PPP: inbound frame not passed\n");
1642 if (!(ppp
->active_filter
1643 && sk_run_filter(skb
, ppp
->active_filter
,
1644 ppp
->active_len
) == 0))
1645 ppp
->last_recv
= jiffies
;
1648 ppp
->last_recv
= jiffies
;
1649 #endif /* CONFIG_PPP_FILTER */
1651 if ((ppp
->dev
->flags
& IFF_UP
) == 0
1652 || ppp
->npmode
[npi
] != NPMODE_PASS
) {
1655 skb_pull(skb
, 2); /* chop off protocol */
1656 skb
->dev
= ppp
->dev
;
1657 skb
->protocol
= htons(npindex_to_ethertype
[npi
]);
1658 skb
->mac
.raw
= skb
->data
;
1660 ppp
->dev
->last_rx
= jiffies
;
1667 ppp_receive_error(ppp
);
1670 static struct sk_buff
*
1671 ppp_decompress_frame(struct ppp
*ppp
, struct sk_buff
*skb
)
1673 int proto
= PPP_PROTO(skb
);
1677 /* Until we fix all the decompressor's need to make sure
1678 * data portion is linear.
1680 if (!pskb_may_pull(skb
, skb
->len
))
1683 if (proto
== PPP_COMP
) {
1684 ns
= dev_alloc_skb(ppp
->mru
+ PPP_HDRLEN
);
1686 printk(KERN_ERR
"ppp_decompress_frame: no memory\n");
1689 /* the decompressor still expects the A/C bytes in the hdr */
1690 len
= ppp
->rcomp
->decompress(ppp
->rc_state
, skb
->data
- 2,
1691 skb
->len
+ 2, ns
->data
, ppp
->mru
+ PPP_HDRLEN
);
1693 /* Pass the compressed frame to pppd as an
1694 error indication. */
1695 if (len
== DECOMP_FATALERROR
)
1696 ppp
->rstate
|= SC_DC_FERROR
;
1704 skb_pull(skb
, 2); /* pull off the A/C bytes */
1707 /* Uncompressed frame - pass to decompressor so it
1708 can update its dictionary if necessary. */
1709 if (ppp
->rcomp
->incomp
)
1710 ppp
->rcomp
->incomp(ppp
->rc_state
, skb
->data
- 2,
1717 ppp
->rstate
|= SC_DC_ERROR
;
1718 ppp_receive_error(ppp
);
1722 #ifdef CONFIG_PPP_MULTILINK
1724 * Receive a multilink frame.
1725 * We put it on the reconstruction queue and then pull off
1726 * as many completed frames as we can.
1729 ppp_receive_mp_frame(struct ppp
*ppp
, struct sk_buff
*skb
, struct channel
*pch
)
1733 int mphdrlen
= (ppp
->flags
& SC_MP_SHORTSEQ
)? MPHDRLEN_SSN
: MPHDRLEN
;
1735 if (!pskb_may_pull(skb
, mphdrlen
) || ppp
->mrru
== 0)
1736 goto err
; /* no good, throw it away */
1738 /* Decode sequence number and begin/end bits */
1739 if (ppp
->flags
& SC_MP_SHORTSEQ
) {
1740 seq
= ((skb
->data
[2] & 0x0f) << 8) | skb
->data
[3];
1743 seq
= (skb
->data
[3] << 16) | (skb
->data
[4] << 8)| skb
->data
[5];
1746 skb
->BEbits
= skb
->data
[2];
1747 skb_pull(skb
, mphdrlen
); /* pull off PPP and MP headers */
1750 * Do protocol ID decompression on the first fragment of each packet.
1752 if ((skb
->BEbits
& B
) && (skb
->data
[0] & 1))
1753 *skb_push(skb
, 1) = 0;
1756 * Expand sequence number to 32 bits, making it as close
1757 * as possible to ppp->minseq.
1759 seq
|= ppp
->minseq
& ~mask
;
1760 if ((int)(ppp
->minseq
- seq
) > (int)(mask
>> 1))
1762 else if ((int)(seq
- ppp
->minseq
) > (int)(mask
>> 1))
1763 seq
-= mask
+ 1; /* should never happen */
1764 skb
->sequence
= seq
;
1768 * If this packet comes before the next one we were expecting,
1771 if (seq_before(seq
, ppp
->nextseq
)) {
1773 ++ppp
->stats
.rx_dropped
;
1774 ppp_receive_error(ppp
);
1779 * Reevaluate minseq, the minimum over all channels of the
1780 * last sequence number received on each channel. Because of
1781 * the increasing sequence number rule, we know that any fragment
1782 * before `minseq' which hasn't arrived is never going to arrive.
1783 * The list of channels can't change because we have the receive
1784 * side of the ppp unit locked.
1786 list_for_each_entry(ch
, &ppp
->channels
, clist
) {
1787 if (seq_before(ch
->lastseq
, seq
))
1790 if (seq_before(ppp
->minseq
, seq
))
1793 /* Put the fragment on the reconstruction queue */
1794 ppp_mp_insert(ppp
, skb
);
1796 /* If the queue is getting long, don't wait any longer for packets
1797 before the start of the queue. */
1798 if (skb_queue_len(&ppp
->mrq
) >= PPP_MP_MAX_QLEN
1799 && seq_before(ppp
->minseq
, ppp
->mrq
.next
->sequence
))
1800 ppp
->minseq
= ppp
->mrq
.next
->sequence
;
1802 /* Pull completed packets off the queue and receive them. */
1803 while ((skb
= ppp_mp_reconstruct(ppp
)) != 0)
1804 ppp_receive_nonmp_frame(ppp
, skb
);
1810 ppp_receive_error(ppp
);
1814 * Insert a fragment on the MP reconstruction queue.
1815 * The queue is ordered by increasing sequence number.
1818 ppp_mp_insert(struct ppp
*ppp
, struct sk_buff
*skb
)
1821 struct sk_buff_head
*list
= &ppp
->mrq
;
1822 u32 seq
= skb
->sequence
;
1824 /* N.B. we don't need to lock the list lock because we have the
1825 ppp unit receive-side lock. */
1826 for (p
= list
->next
; p
!= (struct sk_buff
*)list
; p
= p
->next
)
1827 if (seq_before(seq
, p
->sequence
))
1829 __skb_insert(skb
, p
->prev
, p
, list
);
1833 * Reconstruct a packet from the MP fragment queue.
1834 * We go through increasing sequence numbers until we find a
1835 * complete packet, or we get to the sequence number for a fragment
1836 * which hasn't arrived but might still do so.
1839 ppp_mp_reconstruct(struct ppp
*ppp
)
1841 u32 seq
= ppp
->nextseq
;
1842 u32 minseq
= ppp
->minseq
;
1843 struct sk_buff_head
*list
= &ppp
->mrq
;
1844 struct sk_buff
*p
, *next
;
1845 struct sk_buff
*head
, *tail
;
1846 struct sk_buff
*skb
= NULL
;
1847 int lost
= 0, len
= 0;
1849 if (ppp
->mrru
== 0) /* do nothing until mrru is set */
1853 for (p
= head
; p
!= (struct sk_buff
*) list
; p
= next
) {
1855 if (seq_before(p
->sequence
, seq
)) {
1856 /* this can't happen, anyway ignore the skb */
1857 printk(KERN_ERR
"ppp_mp_reconstruct bad seq %u < %u\n",
1862 if (p
->sequence
!= seq
) {
1863 /* Fragment `seq' is missing. If it is after
1864 minseq, it might arrive later, so stop here. */
1865 if (seq_after(seq
, minseq
))
1867 /* Fragment `seq' is lost, keep going. */
1869 seq
= seq_before(minseq
, p
->sequence
)?
1870 minseq
+ 1: p
->sequence
;
1876 * At this point we know that all the fragments from
1877 * ppp->nextseq to seq are either present or lost.
1878 * Also, there are no complete packets in the queue
1879 * that have no missing fragments and end before this
1883 /* B bit set indicates this fragment starts a packet */
1884 if (p
->BEbits
& B
) {
1892 /* Got a complete packet yet? */
1893 if (lost
== 0 && (p
->BEbits
& E
) && (head
->BEbits
& B
)) {
1894 if (len
> ppp
->mrru
+ 2) {
1895 ++ppp
->stats
.rx_length_errors
;
1896 printk(KERN_DEBUG
"PPP: reconstructed packet"
1897 " is too long (%d)\n", len
);
1898 } else if (p
== head
) {
1899 /* fragment is complete packet - reuse skb */
1903 } else if ((skb
= dev_alloc_skb(len
)) == NULL
) {
1904 ++ppp
->stats
.rx_missed_errors
;
1905 printk(KERN_DEBUG
"PPP: no memory for "
1906 "reconstructed packet");
1911 ppp
->nextseq
= seq
+ 1;
1915 * If this is the ending fragment of a packet,
1916 * and we haven't found a complete valid packet yet,
1917 * we can discard up to and including this fragment.
1925 /* If we have a complete packet, copy it all into one skb. */
1927 /* If we have discarded any fragments,
1928 signal a receive error. */
1929 if (head
->sequence
!= ppp
->nextseq
) {
1931 printk(KERN_DEBUG
" missed pkts %u..%u\n",
1932 ppp
->nextseq
, head
->sequence
-1);
1933 ++ppp
->stats
.rx_dropped
;
1934 ppp_receive_error(ppp
);
1938 /* copy to a single skb */
1939 for (p
= head
; p
!= tail
->next
; p
= p
->next
)
1940 skb_copy_bits(p
, 0, skb_put(skb
, p
->len
), p
->len
);
1941 ppp
->nextseq
= tail
->sequence
+ 1;
1945 /* Discard all the skbuffs that we have copied the data out of
1946 or that we can't use. */
1947 while ((p
= list
->next
) != head
) {
1948 __skb_unlink(p
, list
);
1954 #endif /* CONFIG_PPP_MULTILINK */
1957 * Channel interface.
1961 * Create a new, unattached ppp channel.
1964 ppp_register_channel(struct ppp_channel
*chan
)
1966 struct channel
*pch
;
1968 pch
= kmalloc(sizeof(struct channel
), GFP_KERNEL
);
1971 memset(pch
, 0, sizeof(struct channel
));
1975 init_ppp_file(&pch
->file
, CHANNEL
);
1976 pch
->file
.hdrlen
= chan
->hdrlen
;
1977 #ifdef CONFIG_PPP_MULTILINK
1979 #endif /* CONFIG_PPP_MULTILINK */
1980 init_rwsem(&pch
->chan_sem
);
1981 spin_lock_init(&pch
->downl
);
1982 rwlock_init(&pch
->upl
);
1983 spin_lock_bh(&all_channels_lock
);
1984 pch
->file
.index
= ++last_channel_index
;
1985 list_add(&pch
->list
, &new_channels
);
1986 atomic_inc(&channel_count
);
1987 spin_unlock_bh(&all_channels_lock
);
1992 * Return the index of a channel.
1994 int ppp_channel_index(struct ppp_channel
*chan
)
1996 struct channel
*pch
= chan
->ppp
;
1999 return pch
->file
.index
;
2004 * Return the PPP unit number to which a channel is connected.
2006 int ppp_unit_number(struct ppp_channel
*chan
)
2008 struct channel
*pch
= chan
->ppp
;
2012 read_lock_bh(&pch
->upl
);
2014 unit
= pch
->ppp
->file
.index
;
2015 read_unlock_bh(&pch
->upl
);
2021 * Disconnect a channel from the generic layer.
2022 * This must be called in process context.
2025 ppp_unregister_channel(struct ppp_channel
*chan
)
2027 struct channel
*pch
= chan
->ppp
;
2030 return; /* should never happen */
2034 * This ensures that we have returned from any calls into the
2035 * the channel's start_xmit or ioctl routine before we proceed.
2037 down_write(&pch
->chan_sem
);
2038 spin_lock_bh(&pch
->downl
);
2040 spin_unlock_bh(&pch
->downl
);
2041 up_write(&pch
->chan_sem
);
2042 ppp_disconnect_channel(pch
);
2043 spin_lock_bh(&all_channels_lock
);
2044 list_del(&pch
->list
);
2045 spin_unlock_bh(&all_channels_lock
);
2047 wake_up_interruptible(&pch
->file
.rwait
);
2048 if (atomic_dec_and_test(&pch
->file
.refcnt
))
2049 ppp_destroy_channel(pch
);
2053 * Callback from a channel when it can accept more to transmit.
2054 * This should be called at BH/softirq level, not interrupt level.
2057 ppp_output_wakeup(struct ppp_channel
*chan
)
2059 struct channel
*pch
= chan
->ppp
;
2063 ppp_channel_push(pch
);
2067 * Compression control.
2070 /* Process the PPPIOCSCOMPRESS ioctl. */
2072 ppp_set_compress(struct ppp
*ppp
, unsigned long arg
)
2075 struct compressor
*cp
, *ocomp
;
2076 struct ppp_option_data data
;
2077 void *state
, *ostate
;
2078 unsigned char ccp_option
[CCP_MAX_OPTION_LENGTH
];
2081 if (copy_from_user(&data
, (void __user
*) arg
, sizeof(data
))
2082 || (data
.length
<= CCP_MAX_OPTION_LENGTH
2083 && copy_from_user(ccp_option
, (void __user
*) data
.ptr
, data
.length
)))
2086 if (data
.length
> CCP_MAX_OPTION_LENGTH
2087 || ccp_option
[1] < 2 || ccp_option
[1] > data
.length
)
2090 cp
= find_compressor(ccp_option
[0]);
2093 request_module("ppp-compress-%d", ccp_option
[0]);
2094 cp
= find_compressor(ccp_option
[0]);
2096 #endif /* CONFIG_KMOD */
2101 if (data
.transmit
) {
2102 state
= cp
->comp_alloc(ccp_option
, data
.length
);
2105 ppp
->xstate
&= ~SC_COMP_RUN
;
2107 ostate
= ppp
->xc_state
;
2109 ppp
->xc_state
= state
;
2110 ppp_xmit_unlock(ppp
);
2112 ocomp
->comp_free(ostate
);
2113 module_put(ocomp
->owner
);
2117 module_put(cp
->owner
);
2120 state
= cp
->decomp_alloc(ccp_option
, data
.length
);
2123 ppp
->rstate
&= ~SC_DECOMP_RUN
;
2125 ostate
= ppp
->rc_state
;
2127 ppp
->rc_state
= state
;
2128 ppp_recv_unlock(ppp
);
2130 ocomp
->decomp_free(ostate
);
2131 module_put(ocomp
->owner
);
2135 module_put(cp
->owner
);
2143 * Look at a CCP packet and update our state accordingly.
2144 * We assume the caller has the xmit or recv path locked.
2147 ppp_ccp_peek(struct ppp
*ppp
, struct sk_buff
*skb
, int inbound
)
2152 if (!pskb_may_pull(skb
, CCP_HDRLEN
+ 2))
2153 return; /* no header */
2156 switch (CCP_CODE(dp
)) {
2159 /* A ConfReq starts negotiation of compression
2160 * in one direction of transmission,
2161 * and hence brings it down...but which way?
2164 * A ConfReq indicates what the sender would like to receive
2167 /* He is proposing what I should send */
2168 ppp
->xstate
&= ~SC_COMP_RUN
;
2170 /* I am proposing to what he should send */
2171 ppp
->rstate
&= ~SC_DECOMP_RUN
;
2178 * CCP is going down, both directions of transmission
2180 ppp
->rstate
&= ~SC_DECOMP_RUN
;
2181 ppp
->xstate
&= ~SC_COMP_RUN
;
2185 if ((ppp
->flags
& (SC_CCP_OPEN
| SC_CCP_UP
)) != SC_CCP_OPEN
)
2187 len
= CCP_LENGTH(dp
);
2188 if (!pskb_may_pull(skb
, len
+ 2))
2189 return; /* too short */
2192 if (len
< CCP_OPT_MINLEN
|| len
< CCP_OPT_LENGTH(dp
))
2195 /* we will start receiving compressed packets */
2196 if (ppp
->rc_state
== 0)
2198 if (ppp
->rcomp
->decomp_init(ppp
->rc_state
, dp
, len
,
2199 ppp
->file
.index
, 0, ppp
->mru
, ppp
->debug
)) {
2200 ppp
->rstate
|= SC_DECOMP_RUN
;
2201 ppp
->rstate
&= ~(SC_DC_ERROR
| SC_DC_FERROR
);
2204 /* we will soon start sending compressed packets */
2205 if (ppp
->xc_state
== 0)
2207 if (ppp
->xcomp
->comp_init(ppp
->xc_state
, dp
, len
,
2208 ppp
->file
.index
, 0, ppp
->debug
))
2209 ppp
->xstate
|= SC_COMP_RUN
;
2214 /* reset the [de]compressor */
2215 if ((ppp
->flags
& SC_CCP_UP
) == 0)
2218 if (ppp
->rc_state
&& (ppp
->rstate
& SC_DECOMP_RUN
)) {
2219 ppp
->rcomp
->decomp_reset(ppp
->rc_state
);
2220 ppp
->rstate
&= ~SC_DC_ERROR
;
2223 if (ppp
->xc_state
&& (ppp
->xstate
& SC_COMP_RUN
))
2224 ppp
->xcomp
->comp_reset(ppp
->xc_state
);
2230 /* Free up compression resources. */
2232 ppp_ccp_closed(struct ppp
*ppp
)
2234 void *xstate
, *rstate
;
2235 struct compressor
*xcomp
, *rcomp
;
2238 ppp
->flags
&= ~(SC_CCP_OPEN
| SC_CCP_UP
);
2241 xstate
= ppp
->xc_state
;
2242 ppp
->xc_state
= NULL
;
2245 rstate
= ppp
->rc_state
;
2246 ppp
->rc_state
= NULL
;
2250 xcomp
->comp_free(xstate
);
2251 module_put(xcomp
->owner
);
2254 rcomp
->decomp_free(rstate
);
2255 module_put(rcomp
->owner
);
2259 /* List of compressors. */
2260 static LIST_HEAD(compressor_list
);
2261 static DEFINE_SPINLOCK(compressor_list_lock
);
2263 struct compressor_entry
{
2264 struct list_head list
;
2265 struct compressor
*comp
;
2268 static struct compressor_entry
*
2269 find_comp_entry(int proto
)
2271 struct compressor_entry
*ce
;
2273 list_for_each_entry(ce
, &compressor_list
, list
) {
2274 if (ce
->comp
->compress_proto
== proto
)
2280 /* Register a compressor */
2282 ppp_register_compressor(struct compressor
*cp
)
2284 struct compressor_entry
*ce
;
2286 spin_lock(&compressor_list_lock
);
2288 if (find_comp_entry(cp
->compress_proto
) != 0)
2291 ce
= kmalloc(sizeof(struct compressor_entry
), GFP_ATOMIC
);
2296 list_add(&ce
->list
, &compressor_list
);
2298 spin_unlock(&compressor_list_lock
);
2302 /* Unregister a compressor */
2304 ppp_unregister_compressor(struct compressor
*cp
)
2306 struct compressor_entry
*ce
;
2308 spin_lock(&compressor_list_lock
);
2309 ce
= find_comp_entry(cp
->compress_proto
);
2310 if (ce
!= 0 && ce
->comp
== cp
) {
2311 list_del(&ce
->list
);
2314 spin_unlock(&compressor_list_lock
);
2317 /* Find a compressor. */
2318 static struct compressor
*
2319 find_compressor(int type
)
2321 struct compressor_entry
*ce
;
2322 struct compressor
*cp
= NULL
;
2324 spin_lock(&compressor_list_lock
);
2325 ce
= find_comp_entry(type
);
2328 if (!try_module_get(cp
->owner
))
2331 spin_unlock(&compressor_list_lock
);
2336 * Miscelleneous stuff.
2340 ppp_get_stats(struct ppp
*ppp
, struct ppp_stats
*st
)
2342 struct slcompress
*vj
= ppp
->vj
;
2344 memset(st
, 0, sizeof(*st
));
2345 st
->p
.ppp_ipackets
= ppp
->stats
.rx_packets
;
2346 st
->p
.ppp_ierrors
= ppp
->stats
.rx_errors
;
2347 st
->p
.ppp_ibytes
= ppp
->stats
.rx_bytes
;
2348 st
->p
.ppp_opackets
= ppp
->stats
.tx_packets
;
2349 st
->p
.ppp_oerrors
= ppp
->stats
.tx_errors
;
2350 st
->p
.ppp_obytes
= ppp
->stats
.tx_bytes
;
2353 st
->vj
.vjs_packets
= vj
->sls_o_compressed
+ vj
->sls_o_uncompressed
;
2354 st
->vj
.vjs_compressed
= vj
->sls_o_compressed
;
2355 st
->vj
.vjs_searches
= vj
->sls_o_searches
;
2356 st
->vj
.vjs_misses
= vj
->sls_o_misses
;
2357 st
->vj
.vjs_errorin
= vj
->sls_i_error
;
2358 st
->vj
.vjs_tossed
= vj
->sls_i_tossed
;
2359 st
->vj
.vjs_uncompressedin
= vj
->sls_i_uncompressed
;
2360 st
->vj
.vjs_compressedin
= vj
->sls_i_compressed
;
2364 * Stuff for handling the lists of ppp units and channels
2365 * and for initialization.
2369 * Create a new ppp interface unit. Fails if it can't allocate memory
2370 * or if there is already a unit with the requested number.
2371 * unit == -1 means allocate a new number.
2374 ppp_create_interface(int unit
, int *retp
)
2377 struct net_device
*dev
= NULL
;
2381 ppp
= kmalloc(sizeof(struct ppp
), GFP_KERNEL
);
2384 dev
= alloc_netdev(0, "", ppp_setup
);
2387 memset(ppp
, 0, sizeof(struct ppp
));
2390 init_ppp_file(&ppp
->file
, INTERFACE
);
2391 ppp
->file
.hdrlen
= PPP_HDRLEN
- 2; /* don't count proto bytes */
2392 for (i
= 0; i
< NUM_NP
; ++i
)
2393 ppp
->npmode
[i
] = NPMODE_PASS
;
2394 INIT_LIST_HEAD(&ppp
->channels
);
2395 spin_lock_init(&ppp
->rlock
);
2396 spin_lock_init(&ppp
->wlock
);
2397 #ifdef CONFIG_PPP_MULTILINK
2399 skb_queue_head_init(&ppp
->mrq
);
2400 #endif /* CONFIG_PPP_MULTILINK */
2404 dev
->hard_start_xmit
= ppp_start_xmit
;
2405 dev
->get_stats
= ppp_net_stats
;
2406 dev
->do_ioctl
= ppp_net_ioctl
;
2411 unit
= cardmap_find_first_free(all_ppp_units
);
2412 else if (cardmap_get(all_ppp_units
, unit
) != NULL
)
2413 goto out2
; /* unit already exists */
2415 /* Initialize the new ppp unit */
2416 ppp
->file
.index
= unit
;
2417 sprintf(dev
->name
, "ppp%d", unit
);
2419 ret
= register_netdev(dev
);
2421 printk(KERN_ERR
"PPP: couldn't register device %s (%d)\n",
2426 atomic_inc(&ppp_unit_count
);
2427 cardmap_set(&all_ppp_units
, unit
, ppp
);
2443 * Initialize a ppp_file structure.
2446 init_ppp_file(struct ppp_file
*pf
, int kind
)
2449 skb_queue_head_init(&pf
->xq
);
2450 skb_queue_head_init(&pf
->rq
);
2451 atomic_set(&pf
->refcnt
, 1);
2452 init_waitqueue_head(&pf
->rwait
);
2456 * Take down a ppp interface unit - called when the owning file
2457 * (the one that created the unit) is closed or detached.
2459 static void ppp_shutdown_interface(struct ppp
*ppp
)
2461 struct net_device
*dev
;
2468 /* This will call dev_close() for us. */
2470 unregister_netdev(dev
);
2473 cardmap_set(&all_ppp_units
, ppp
->file
.index
, NULL
);
2476 wake_up_interruptible(&ppp
->file
.rwait
);
2481 * Free the memory used by a ppp unit. This is only called once
2482 * there are no channels connected to the unit and no file structs
2483 * that reference the unit.
2485 static void ppp_destroy_interface(struct ppp
*ppp
)
2487 atomic_dec(&ppp_unit_count
);
2489 if (!ppp
->file
.dead
|| ppp
->n_channels
) {
2490 /* "can't happen" */
2491 printk(KERN_ERR
"ppp: destroying ppp struct %p but dead=%d "
2492 "n_channels=%d !\n", ppp
, ppp
->file
.dead
,
2497 ppp_ccp_closed(ppp
);
2502 skb_queue_purge(&ppp
->file
.xq
);
2503 skb_queue_purge(&ppp
->file
.rq
);
2504 #ifdef CONFIG_PPP_MULTILINK
2505 skb_queue_purge(&ppp
->mrq
);
2506 #endif /* CONFIG_PPP_MULTILINK */
2507 #ifdef CONFIG_PPP_FILTER
2508 kfree(ppp
->pass_filter
);
2509 ppp
->pass_filter
= NULL
;
2510 kfree(ppp
->active_filter
);
2511 ppp
->active_filter
= NULL
;
2512 #endif /* CONFIG_PPP_FILTER */
2518 * Locate an existing ppp unit.
2519 * The caller should have locked the all_ppp_sem.
2522 ppp_find_unit(int unit
)
2524 return cardmap_get(all_ppp_units
, unit
);
2528 * Locate an existing ppp channel.
2529 * The caller should have locked the all_channels_lock.
2530 * First we look in the new_channels list, then in the
2531 * all_channels list. If found in the new_channels list,
2532 * we move it to the all_channels list. This is for speed
2533 * when we have a lot of channels in use.
2535 static struct channel
*
2536 ppp_find_channel(int unit
)
2538 struct channel
*pch
;
2540 list_for_each_entry(pch
, &new_channels
, list
) {
2541 if (pch
->file
.index
== unit
) {
2542 list_del(&pch
->list
);
2543 list_add(&pch
->list
, &all_channels
);
2547 list_for_each_entry(pch
, &all_channels
, list
) {
2548 if (pch
->file
.index
== unit
)
2555 * Connect a PPP channel to a PPP interface unit.
2558 ppp_connect_channel(struct channel
*pch
, int unit
)
2565 ppp
= ppp_find_unit(unit
);
2568 write_lock_bh(&pch
->upl
);
2574 if (pch
->file
.hdrlen
> ppp
->file
.hdrlen
)
2575 ppp
->file
.hdrlen
= pch
->file
.hdrlen
;
2576 hdrlen
= pch
->file
.hdrlen
+ 2; /* for protocol bytes */
2577 if (ppp
->dev
&& hdrlen
> ppp
->dev
->hard_header_len
)
2578 ppp
->dev
->hard_header_len
= hdrlen
;
2579 list_add_tail(&pch
->clist
, &ppp
->channels
);
2582 atomic_inc(&ppp
->file
.refcnt
);
2587 write_unlock_bh(&pch
->upl
);
2594 * Disconnect a channel from its ppp unit.
2597 ppp_disconnect_channel(struct channel
*pch
)
2602 write_lock_bh(&pch
->upl
);
2605 write_unlock_bh(&pch
->upl
);
2607 /* remove it from the ppp unit's list */
2609 list_del(&pch
->clist
);
2610 if (--ppp
->n_channels
== 0)
2611 wake_up_interruptible(&ppp
->file
.rwait
);
2613 if (atomic_dec_and_test(&ppp
->file
.refcnt
))
2614 ppp_destroy_interface(ppp
);
2621 * Free up the resources used by a ppp channel.
2623 static void ppp_destroy_channel(struct channel
*pch
)
2625 atomic_dec(&channel_count
);
2627 if (!pch
->file
.dead
) {
2628 /* "can't happen" */
2629 printk(KERN_ERR
"ppp: destroying undead channel %p !\n",
2633 skb_queue_purge(&pch
->file
.xq
);
2634 skb_queue_purge(&pch
->file
.rq
);
2638 static void __exit
ppp_cleanup(void)
2640 /* should never happen */
2641 if (atomic_read(&ppp_unit_count
) || atomic_read(&channel_count
))
2642 printk(KERN_ERR
"PPP: removing module but units remain!\n");
2643 cardmap_destroy(&all_ppp_units
);
2644 if (unregister_chrdev(PPP_MAJOR
, "ppp") != 0)
2645 printk(KERN_ERR
"PPP: failed to unregister PPP device\n");
2646 devfs_remove("ppp");
2647 class_device_destroy(ppp_class
, MKDEV(PPP_MAJOR
, 0));
2648 class_destroy(ppp_class
);
2652 * Cardmap implementation.
2654 static void *cardmap_get(struct cardmap
*map
, unsigned int nr
)
2659 for (p
= map
; p
!= NULL
; ) {
2660 if ((i
= nr
>> p
->shift
) >= CARDMAP_WIDTH
)
2664 nr
&= ~(CARDMAP_MASK
<< p
->shift
);
2670 static void cardmap_set(struct cardmap
**pmap
, unsigned int nr
, void *ptr
)
2676 if (p
== NULL
|| (nr
>> p
->shift
) >= CARDMAP_WIDTH
) {
2678 /* need a new top level */
2679 struct cardmap
*np
= kmalloc(sizeof(*np
), GFP_KERNEL
);
2680 memset(np
, 0, sizeof(*np
));
2683 np
->shift
= p
->shift
+ CARDMAP_ORDER
;
2688 } while ((nr
>> p
->shift
) >= CARDMAP_WIDTH
);
2691 while (p
->shift
> 0) {
2692 i
= (nr
>> p
->shift
) & CARDMAP_MASK
;
2693 if (p
->ptr
[i
] == NULL
) {
2694 struct cardmap
*np
= kmalloc(sizeof(*np
), GFP_KERNEL
);
2695 memset(np
, 0, sizeof(*np
));
2696 np
->shift
= p
->shift
- CARDMAP_ORDER
;
2701 clear_bit(i
, &p
->inuse
);
2704 i
= nr
& CARDMAP_MASK
;
2707 set_bit(i
, &p
->inuse
);
2709 clear_bit(i
, &p
->inuse
);
2712 static unsigned int cardmap_find_first_free(struct cardmap
*map
)
2715 unsigned int nr
= 0;
2718 if ((p
= map
) == NULL
)
2721 i
= find_first_zero_bit(&p
->inuse
, CARDMAP_WIDTH
);
2722 if (i
>= CARDMAP_WIDTH
) {
2723 if (p
->parent
== NULL
)
2724 return CARDMAP_WIDTH
<< p
->shift
;
2726 i
= (nr
>> p
->shift
) & CARDMAP_MASK
;
2727 set_bit(i
, &p
->inuse
);
2730 nr
= (nr
& (~CARDMAP_MASK
<< p
->shift
)) | (i
<< p
->shift
);
2731 if (p
->shift
== 0 || p
->ptr
[i
] == NULL
)
2737 static void cardmap_destroy(struct cardmap
**pmap
)
2739 struct cardmap
*p
, *np
;
2742 for (p
= *pmap
; p
!= NULL
; p
= np
) {
2743 if (p
->shift
!= 0) {
2744 for (i
= 0; i
< CARDMAP_WIDTH
; ++i
)
2745 if (p
->ptr
[i
] != NULL
)
2747 if (i
< CARDMAP_WIDTH
) {
2759 /* Module/initialization stuff */
2761 module_init(ppp_init
);
2762 module_exit(ppp_cleanup
);
2764 EXPORT_SYMBOL(ppp_register_channel
);
2765 EXPORT_SYMBOL(ppp_unregister_channel
);
2766 EXPORT_SYMBOL(ppp_channel_index
);
2767 EXPORT_SYMBOL(ppp_unit_number
);
2768 EXPORT_SYMBOL(ppp_input
);
2769 EXPORT_SYMBOL(ppp_input_error
);
2770 EXPORT_SYMBOL(ppp_output_wakeup
);
2771 EXPORT_SYMBOL(ppp_register_compressor
);
2772 EXPORT_SYMBOL(ppp_unregister_compressor
);
2773 MODULE_LICENSE("GPL");
2774 MODULE_ALIAS_CHARDEV_MAJOR(PPP_MAJOR
);
2775 MODULE_ALIAS("/dev/ppp");