blob: fe824e0cbb252cedda78527fac18f2a40876a9df [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/* $Id: isdn_ppp.c,v 1.1.2.3 2004/02/10 01:07:13 keil Exp $
2 *
3 * Linux ISDN subsystem, functions for synchronous PPP (linklevel).
4 *
5 * Copyright 1995,96 by Michael Hipp (Michael.Hipp@student.uni-tuebingen.de)
6 *
7 * This software may be used and distributed according to the terms
8 * of the GNU General Public License, incorporated herein by reference.
9 *
10 */
11
Linus Torvalds1da177e2005-04-16 15:20:36 -070012#include <linux/isdn.h>
13#include <linux/poll.h>
14#include <linux/ppp-comp.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090015#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070016#ifdef CONFIG_IPPP_FILTER
17#include <linux/filter.h>
18#endif
19
20#include "isdn_common.h"
21#include "isdn_ppp.h"
22#include "isdn_net.h"
23
24#ifndef PPP_IPX
25#define PPP_IPX 0x002b
26#endif
27
28/* Prototypes */
29static int isdn_ppp_fill_rq(unsigned char *buf, int len, int proto, int slot);
30static int isdn_ppp_closewait(int slot);
31static void isdn_ppp_push_higher(isdn_net_dev * net_dev, isdn_net_local * lp,
32 struct sk_buff *skb, int proto);
33static int isdn_ppp_if_get_unit(char *namebuf);
34static int isdn_ppp_set_compressor(struct ippp_struct *is,struct isdn_ppp_comp_data *);
35static struct sk_buff *isdn_ppp_decompress(struct sk_buff *,
36 struct ippp_struct *,struct ippp_struct *,int *proto);
37static void isdn_ppp_receive_ccp(isdn_net_dev * net_dev, isdn_net_local * lp,
38 struct sk_buff *skb,int proto);
39static struct sk_buff *isdn_ppp_compress(struct sk_buff *skb_in,int *proto,
40 struct ippp_struct *is,struct ippp_struct *master,int type);
41static void isdn_ppp_send_ccp(isdn_net_dev *net_dev, isdn_net_local *lp,
42 struct sk_buff *skb);
43
44/* New CCP stuff */
45static void isdn_ppp_ccp_kickup(struct ippp_struct *is);
46static void isdn_ppp_ccp_xmit_reset(struct ippp_struct *is, int proto,
47 unsigned char code, unsigned char id,
48 unsigned char *data, int len);
49static struct ippp_ccp_reset *isdn_ppp_ccp_reset_alloc(struct ippp_struct *is);
50static void isdn_ppp_ccp_reset_free(struct ippp_struct *is);
51static void isdn_ppp_ccp_reset_free_state(struct ippp_struct *is,
52 unsigned char id);
53static void isdn_ppp_ccp_timer_callback(unsigned long closure);
54static struct ippp_ccp_reset_state *isdn_ppp_ccp_reset_alloc_state(struct ippp_struct *is,
55 unsigned char id);
56static void isdn_ppp_ccp_reset_trans(struct ippp_struct *is,
57 struct isdn_ppp_resetparams *rp);
58static void isdn_ppp_ccp_reset_ack_rcvd(struct ippp_struct *is,
59 unsigned char id);
60
61
62
63#ifdef CONFIG_ISDN_MPP
64static ippp_bundle * isdn_ppp_bundle_arr = NULL;
65
66static int isdn_ppp_mp_bundle_array_init(void);
67static int isdn_ppp_mp_init( isdn_net_local * lp, ippp_bundle * add_to );
68static void isdn_ppp_mp_receive(isdn_net_dev * net_dev, isdn_net_local * lp,
69 struct sk_buff *skb);
70static void isdn_ppp_mp_cleanup( isdn_net_local * lp );
71
72static int isdn_ppp_bundle(struct ippp_struct *, int unit);
73#endif /* CONFIG_ISDN_MPP */
74
75char *isdn_ppp_revision = "$Revision: 1.1.2.3 $";
76
77static struct ippp_struct *ippp_table[ISDN_MAX_CHANNELS];
78
79static struct isdn_ppp_compressor *ipc_head = NULL;
80
81/*
82 * frame log (debug)
83 */
84static void
85isdn_ppp_frame_log(char *info, char *data, int len, int maxlen,int unit,int slot)
86{
87 int cnt,
88 j,
89 i;
90 char buf[80];
91
92 if (len < maxlen)
93 maxlen = len;
94
95 for (i = 0, cnt = 0; cnt < maxlen; i++) {
96 for (j = 0; j < 16 && cnt < maxlen; j++, cnt++)
97 sprintf(buf + j * 3, "%02x ", (unsigned char) data[cnt]);
98 printk(KERN_DEBUG "[%d/%d].%s[%d]: %s\n",unit,slot, info, i, buf);
99 }
100}
101
102/*
103 * unbind isdn_net_local <=> ippp-device
104 * note: it can happen, that we hangup/free the master before the slaves
105 * in this case we bind another lp to the master device
106 */
107int
108isdn_ppp_free(isdn_net_local * lp)
109{
110 struct ippp_struct *is;
111
Eric Sesterhenn052bb882006-04-11 17:29:17 -0700112 if (lp->ppp_slot < 0 || lp->ppp_slot >= ISDN_MAX_CHANNELS) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113 printk(KERN_ERR "%s: ppp_slot(%d) out of range\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -0700114 __func__, lp->ppp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700115 return 0;
116 }
117
118#ifdef CONFIG_ISDN_MPP
119 spin_lock(&lp->netdev->pb->lock);
120#endif
121 isdn_net_rm_from_bundle(lp);
122#ifdef CONFIG_ISDN_MPP
123 if (lp->netdev->pb->ref_ct == 1) /* last link in queue? */
124 isdn_ppp_mp_cleanup(lp);
125
126 lp->netdev->pb->ref_ct--;
127 spin_unlock(&lp->netdev->pb->lock);
128#endif /* CONFIG_ISDN_MPP */
Eric Sesterhenn052bb882006-04-11 17:29:17 -0700129 if (lp->ppp_slot < 0 || lp->ppp_slot >= ISDN_MAX_CHANNELS) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130 printk(KERN_ERR "%s: ppp_slot(%d) now invalid\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -0700131 __func__, lp->ppp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700132 return 0;
133 }
134 is = ippp_table[lp->ppp_slot];
135 if ((is->state & IPPP_CONNECT))
136 isdn_ppp_closewait(lp->ppp_slot); /* force wakeup on ippp device */
137 else if (is->state & IPPP_ASSIGNED)
138 is->state = IPPP_OPEN; /* fallback to 'OPEN but not ASSIGNED' state */
139
140 if (is->debug & 0x1)
141 printk(KERN_DEBUG "isdn_ppp_free %d %lx %lx\n", lp->ppp_slot, (long) lp, (long) is->lp);
142
143 is->lp = NULL; /* link is down .. set lp to NULL */
144 lp->ppp_slot = -1; /* is this OK ?? */
145
146 return 0;
147}
148
149/*
150 * bind isdn_net_local <=> ippp-device
151 *
152 * This function is allways called with holding dev->lock so
153 * no additional lock is needed
154 */
155int
156isdn_ppp_bind(isdn_net_local * lp)
157{
158 int i;
159 int unit = 0;
160 struct ippp_struct *is;
161 int retval;
162
163 if (lp->pppbind < 0) { /* device bounded to ippp device ? */
164 isdn_net_dev *net_dev = dev->netdev;
165 char exclusive[ISDN_MAX_CHANNELS]; /* exclusive flags */
166 memset(exclusive, 0, ISDN_MAX_CHANNELS);
167 while (net_dev) { /* step through net devices to find exclusive minors */
168 isdn_net_local *lp = net_dev->local;
169 if (lp->pppbind >= 0)
170 exclusive[lp->pppbind] = 1;
171 net_dev = net_dev->next;
172 }
173 /*
174 * search a free device / slot
175 */
176 for (i = 0; i < ISDN_MAX_CHANNELS; i++) {
177 if (ippp_table[i]->state == IPPP_OPEN && !exclusive[ippp_table[i]->minor]) { /* OPEN, but not connected! */
178 break;
179 }
180 }
181 } else {
182 for (i = 0; i < ISDN_MAX_CHANNELS; i++) {
183 if (ippp_table[i]->minor == lp->pppbind &&
184 (ippp_table[i]->state & IPPP_OPEN) == IPPP_OPEN)
185 break;
186 }
187 }
188
189 if (i >= ISDN_MAX_CHANNELS) {
190 printk(KERN_WARNING "isdn_ppp_bind: Can't find a (free) connection to the ipppd daemon.\n");
191 retval = -1;
192 goto out;
193 }
Karsten Keilfaca94f2007-10-15 02:11:44 -0700194 /* get unit number from interface name .. ugly! */
195 unit = isdn_ppp_if_get_unit(lp->netdev->dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196 if (unit < 0) {
Karsten Keilfaca94f2007-10-15 02:11:44 -0700197 printk(KERN_ERR "isdn_ppp_bind: illegal interface name %s.\n",
198 lp->netdev->dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700199 retval = -1;
200 goto out;
201 }
202
203 lp->ppp_slot = i;
204 is = ippp_table[i];
205 is->lp = lp;
206 is->unit = unit;
207 is->state = IPPP_OPEN | IPPP_ASSIGNED; /* assigned to a netdevice but not connected */
208#ifdef CONFIG_ISDN_MPP
209 retval = isdn_ppp_mp_init(lp, NULL);
210 if (retval < 0)
211 goto out;
212#endif /* CONFIG_ISDN_MPP */
213
214 retval = lp->ppp_slot;
215
216 out:
217 return retval;
218}
219
220/*
221 * kick the ipppd on the device
222 * (wakes up daemon after B-channel connect)
223 */
224
225void
226isdn_ppp_wakeup_daemon(isdn_net_local * lp)
227{
228 if (lp->ppp_slot < 0 || lp->ppp_slot >= ISDN_MAX_CHANNELS) {
229 printk(KERN_ERR "%s: ppp_slot(%d) out of range\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -0700230 __func__, lp->ppp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231 return;
232 }
233 ippp_table[lp->ppp_slot]->state = IPPP_OPEN | IPPP_CONNECT | IPPP_NOBLOCK;
234 wake_up_interruptible(&ippp_table[lp->ppp_slot]->wq);
235}
236
237/*
238 * there was a hangup on the netdevice
239 * force wakeup of the ippp device
240 * go into 'device waits for release' state
241 */
242static int
243isdn_ppp_closewait(int slot)
244{
245 struct ippp_struct *is;
246
247 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
248 printk(KERN_ERR "%s: slot(%d) out of range\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -0700249 __func__, slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250 return 0;
251 }
252 is = ippp_table[slot];
253 if (is->state)
254 wake_up_interruptible(&is->wq);
255 is->state = IPPP_CLOSEWAIT;
256 return 1;
257}
258
259/*
260 * isdn_ppp_find_slot / isdn_ppp_free_slot
261 */
262
263static int
264isdn_ppp_get_slot(void)
265{
266 int i;
267 for (i = 0; i < ISDN_MAX_CHANNELS; i++) {
268 if (!ippp_table[i]->state)
269 return i;
270 }
271 return -1;
272}
273
274/*
275 * isdn_ppp_open
276 */
277
278int
279isdn_ppp_open(int min, struct file *file)
280{
281 int slot;
282 struct ippp_struct *is;
283
Eric Sesterhenn052bb882006-04-11 17:29:17 -0700284 if (min < 0 || min >= ISDN_MAX_CHANNELS)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285 return -ENODEV;
286
287 slot = isdn_ppp_get_slot();
288 if (slot < 0) {
289 return -EBUSY;
290 }
291 is = file->private_data = ippp_table[slot];
292
293 printk(KERN_DEBUG "ippp, open, slot: %d, minor: %d, state: %04x\n",
294 slot, min, is->state);
295
296 /* compression stuff */
297 is->link_compressor = is->compressor = NULL;
298 is->link_decompressor = is->decompressor = NULL;
299 is->link_comp_stat = is->comp_stat = NULL;
300 is->link_decomp_stat = is->decomp_stat = NULL;
301 is->compflags = 0;
302
303 is->reset = isdn_ppp_ccp_reset_alloc(is);
304
305 is->lp = NULL;
306 is->mp_seqno = 0; /* MP sequence number */
307 is->pppcfg = 0; /* ppp configuration */
308 is->mpppcfg = 0; /* mppp configuration */
309 is->last_link_seqno = -1; /* MP: maybe set to Bundle-MIN, when joining a bundle ?? */
310 is->unit = -1; /* set, when we have our interface */
311 is->mru = 1524; /* MRU, default 1524 */
312 is->maxcid = 16; /* VJ: maxcid */
313 is->tk = current;
314 init_waitqueue_head(&is->wq);
315 is->first = is->rq + NUM_RCV_BUFFS - 1; /* receive queue */
316 is->last = is->rq;
317 is->minor = min;
318#ifdef CONFIG_ISDN_PPP_VJ
319 /*
320 * VJ header compression init
321 */
322 is->slcomp = slhc_init(16, 16); /* not necessary for 2. link in bundle */
323#endif
324#ifdef CONFIG_IPPP_FILTER
325 is->pass_filter = NULL;
326 is->active_filter = NULL;
327#endif
328 is->state = IPPP_OPEN;
329
330 return 0;
331}
332
333/*
334 * release ippp device
335 */
336void
337isdn_ppp_release(int min, struct file *file)
338{
339 int i;
340 struct ippp_struct *is;
341
342 if (min < 0 || min >= ISDN_MAX_CHANNELS)
343 return;
344 is = file->private_data;
345
346 if (!is) {
Harvey Harrison156f1ed2008-04-28 02:14:40 -0700347 printk(KERN_ERR "%s: no file->private_data\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348 return;
349 }
350 if (is->debug & 0x1)
351 printk(KERN_DEBUG "ippp: release, minor: %d %lx\n", min, (long) is->lp);
352
353 if (is->lp) { /* a lp address says: this link is still up */
354 isdn_net_dev *p = is->lp->netdev;
355
356 if (!p) {
Harvey Harrison156f1ed2008-04-28 02:14:40 -0700357 printk(KERN_ERR "%s: no lp->netdev\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358 return;
359 }
360 is->state &= ~IPPP_CONNECT; /* -> effect: no call of wakeup */
361 /*
362 * isdn_net_hangup() calls isdn_ppp_free()
363 * isdn_ppp_free() sets is->lp to NULL and lp->ppp_slot to -1
364 * removing the IPPP_CONNECT flag omits calling of isdn_ppp_wakeup_daemon()
365 */
Karsten Keild62a38d2007-10-08 20:37:11 -0700366 isdn_net_hangup(p->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367 }
368 for (i = 0; i < NUM_RCV_BUFFS; i++) {
Jesper Juhl3c7208f2005-11-07 01:01:29 -0800369 kfree(is->rq[i].buf);
370 is->rq[i].buf = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371 }
372 is->first = is->rq + NUM_RCV_BUFFS - 1; /* receive queue */
373 is->last = is->rq;
374
375#ifdef CONFIG_ISDN_PPP_VJ
376/* TODO: if this was the previous master: link the slcomp to the new master */
377 slhc_free(is->slcomp);
378 is->slcomp = NULL;
379#endif
380#ifdef CONFIG_IPPP_FILTER
Jesper Juhl3c7208f2005-11-07 01:01:29 -0800381 kfree(is->pass_filter);
382 is->pass_filter = NULL;
383 kfree(is->active_filter);
384 is->active_filter = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385#endif
386
387/* TODO: if this was the previous master: link the stuff to the new master */
388 if(is->comp_stat)
389 is->compressor->free(is->comp_stat);
390 if(is->link_comp_stat)
391 is->link_compressor->free(is->link_comp_stat);
392 if(is->link_decomp_stat)
393 is->link_decompressor->free(is->link_decomp_stat);
394 if(is->decomp_stat)
395 is->decompressor->free(is->decomp_stat);
396 is->compressor = is->link_compressor = NULL;
397 is->decompressor = is->link_decompressor = NULL;
398 is->comp_stat = is->link_comp_stat = NULL;
399 is->decomp_stat = is->link_decomp_stat = NULL;
400
401 /* Clean up if necessary */
402 if(is->reset)
403 isdn_ppp_ccp_reset_free(is);
404
405 /* this slot is ready for new connections */
406 is->state = 0;
407}
408
409/*
410 * get_arg .. ioctl helper
411 */
412static int
413get_arg(void __user *b, void *val, int len)
414{
415 if (len <= 0)
416 len = sizeof(void *);
417 if (copy_from_user(val, b, len))
418 return -EFAULT;
419 return 0;
420}
421
422/*
423 * set arg .. ioctl helper
424 */
425static int
426set_arg(void __user *b, void *val,int len)
427{
428 if(len <= 0)
429 len = sizeof(void *);
430 if (copy_to_user(b, val, len))
431 return -EFAULT;
432 return 0;
433}
434
Daniele Venzano26285ba2009-01-26 12:24:38 -0800435#ifdef CONFIG_IPPP_FILTER
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436static int get_filter(void __user *arg, struct sock_filter **p)
437{
438 struct sock_fprog uprog;
439 struct sock_filter *code = NULL;
440 int len, err;
441
442 if (copy_from_user(&uprog, arg, sizeof(uprog)))
443 return -EFAULT;
444
445 if (!uprog.len) {
446 *p = NULL;
447 return 0;
448 }
449
450 /* uprog.len is unsigned short, so no overflow here */
451 len = uprog.len * sizeof(struct sock_filter);
Julia Lawall024cb8a2010-05-21 22:26:42 +0000452 code = memdup_user(uprog.filter, len);
453 if (IS_ERR(code))
454 return PTR_ERR(code);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700455
456 err = sk_chk_filter(code, uprog.len);
457 if (err) {
458 kfree(code);
459 return err;
460 }
461
462 *p = code;
463 return uprog.len;
464}
Daniele Venzano26285ba2009-01-26 12:24:38 -0800465#endif /* CONFIG_IPPP_FILTER */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700466
467/*
468 * ippp device ioctl
469 */
470int
471isdn_ppp_ioctl(int min, struct file *file, unsigned int cmd, unsigned long arg)
472{
473 unsigned long val;
474 int r,i,j;
475 struct ippp_struct *is;
476 isdn_net_local *lp;
477 struct isdn_ppp_comp_data data;
478 void __user *argp = (void __user *)arg;
479
Joe Perches54cbb1c2010-07-12 10:50:02 +0000480 is = file->private_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 lp = is->lp;
482
483 if (is->debug & 0x1)
484 printk(KERN_DEBUG "isdn_ppp_ioctl: minor: %d cmd: %x state: %x\n", min, cmd, is->state);
485
486 if (!(is->state & IPPP_OPEN))
487 return -EINVAL;
488
489 switch (cmd) {
490 case PPPIOCBUNDLE:
491#ifdef CONFIG_ISDN_MPP
492 if (!(is->state & IPPP_CONNECT))
493 return -EINVAL;
494 if ((r = get_arg(argp, &val, sizeof(val) )))
495 return r;
496 printk(KERN_DEBUG "iPPP-bundle: minor: %d, slave unit: %d, master unit: %d\n",
497 (int) min, (int) is->unit, (int) val);
498 return isdn_ppp_bundle(is, val);
499#else
500 return -1;
501#endif
502 break;
503 case PPPIOCGUNIT: /* get ppp/isdn unit number */
504 if ((r = set_arg(argp, &is->unit, sizeof(is->unit) )))
505 return r;
506 break;
507 case PPPIOCGIFNAME:
508 if(!lp)
509 return -EINVAL;
Karsten Keilfaca94f2007-10-15 02:11:44 -0700510 if ((r = set_arg(argp, lp->netdev->dev->name,
511 strlen(lp->netdev->dev->name))))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512 return r;
513 break;
514 case PPPIOCGMPFLAGS: /* get configuration flags */
515 if ((r = set_arg(argp, &is->mpppcfg, sizeof(is->mpppcfg) )))
516 return r;
517 break;
518 case PPPIOCSMPFLAGS: /* set configuration flags */
519 if ((r = get_arg(argp, &val, sizeof(val) )))
520 return r;
521 is->mpppcfg = val;
522 break;
523 case PPPIOCGFLAGS: /* get configuration flags */
524 if ((r = set_arg(argp, &is->pppcfg,sizeof(is->pppcfg) )))
525 return r;
526 break;
527 case PPPIOCSFLAGS: /* set configuration flags */
528 if ((r = get_arg(argp, &val, sizeof(val) ))) {
529 return r;
530 }
531 if (val & SC_ENABLE_IP && !(is->pppcfg & SC_ENABLE_IP) && (is->state & IPPP_CONNECT)) {
532 if (lp) {
533 /* OK .. we are ready to send buffers */
534 is->pppcfg = val; /* isdn_ppp_xmit test for SC_ENABLE_IP !!! */
Karsten Keild62a38d2007-10-08 20:37:11 -0700535 netif_wake_queue(lp->netdev->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536 break;
537 }
538 }
539 is->pppcfg = val;
540 break;
541 case PPPIOCGIDLE: /* get idle time information */
542 if (lp) {
543 struct ppp_idle pidle;
544 pidle.xmit_idle = pidle.recv_idle = lp->huptimer;
545 if ((r = set_arg(argp, &pidle,sizeof(struct ppp_idle))))
546 return r;
547 }
548 break;
549 case PPPIOCSMRU: /* set receive unit size for PPP */
550 if ((r = get_arg(argp, &val, sizeof(val) )))
551 return r;
552 is->mru = val;
553 break;
554 case PPPIOCSMPMRU:
555 break;
556 case PPPIOCSMPMTU:
557 break;
558 case PPPIOCSMAXCID: /* set the maximum compression slot id */
559 if ((r = get_arg(argp, &val, sizeof(val) )))
560 return r;
561 val++;
562 if (is->maxcid != val) {
563#ifdef CONFIG_ISDN_PPP_VJ
564 struct slcompress *sltmp;
565#endif
566 if (is->debug & 0x1)
567 printk(KERN_DEBUG "ippp, ioctl: changed MAXCID to %ld\n", val);
568 is->maxcid = val;
569#ifdef CONFIG_ISDN_PPP_VJ
570 sltmp = slhc_init(16, val);
571 if (!sltmp) {
572 printk(KERN_ERR "ippp, can't realloc slhc struct\n");
573 return -ENOMEM;
574 }
575 if (is->slcomp)
576 slhc_free(is->slcomp);
577 is->slcomp = sltmp;
578#endif
579 }
580 break;
581 case PPPIOCGDEBUG:
582 if ((r = set_arg(argp, &is->debug, sizeof(is->debug) )))
583 return r;
584 break;
585 case PPPIOCSDEBUG:
586 if ((r = get_arg(argp, &val, sizeof(val) )))
587 return r;
588 is->debug = val;
589 break;
590 case PPPIOCGCOMPRESSORS:
591 {
592 unsigned long protos[8] = {0,};
593 struct isdn_ppp_compressor *ipc = ipc_head;
594 while(ipc) {
595 j = ipc->num / (sizeof(long)*8);
596 i = ipc->num % (sizeof(long)*8);
597 if(j < 8)
598 protos[j] |= (0x1<<i);
599 ipc = ipc->next;
600 }
601 if ((r = set_arg(argp,protos,8*sizeof(long) )))
602 return r;
603 }
604 break;
605 case PPPIOCSCOMPRESSOR:
606 if ((r = get_arg(argp, &data, sizeof(struct isdn_ppp_comp_data))))
607 return r;
608 return isdn_ppp_set_compressor(is, &data);
609 case PPPIOCGCALLINFO:
610 {
611 struct pppcallinfo pci;
612 memset((char *) &pci,0,sizeof(struct pppcallinfo));
613 if(lp)
614 {
615 strncpy(pci.local_num,lp->msn,63);
616 if(lp->dial) {
617 strncpy(pci.remote_num,lp->dial->num,63);
618 }
619 pci.charge_units = lp->charge;
620 if(lp->outgoing)
621 pci.calltype = CALLTYPE_OUTGOING;
622 else
623 pci.calltype = CALLTYPE_INCOMING;
624 if(lp->flags & ISDN_NET_CALLBACK)
625 pci.calltype |= CALLTYPE_CALLBACK;
626 }
627 return set_arg(argp,&pci,sizeof(struct pppcallinfo));
628 }
629#ifdef CONFIG_IPPP_FILTER
630 case PPPIOCSPASS:
631 {
632 struct sock_filter *code;
633 int len = get_filter(argp, &code);
634 if (len < 0)
635 return len;
636 kfree(is->pass_filter);
637 is->pass_filter = code;
638 is->pass_len = len;
639 break;
640 }
641 case PPPIOCSACTIVE:
642 {
643 struct sock_filter *code;
644 int len = get_filter(argp, &code);
645 if (len < 0)
646 return len;
647 kfree(is->active_filter);
648 is->active_filter = code;
649 is->active_len = len;
650 break;
651 }
652#endif /* CONFIG_IPPP_FILTER */
653 default:
654 break;
655 }
656 return 0;
657}
658
659unsigned int
660isdn_ppp_poll(struct file *file, poll_table * wait)
661{
662 u_int mask;
663 struct ippp_buf_queue *bf, *bl;
664 u_long flags;
665 struct ippp_struct *is;
666
667 is = file->private_data;
668
669 if (is->debug & 0x2)
670 printk(KERN_DEBUG "isdn_ppp_poll: minor: %d\n",
Josef Sipek4482dfa2006-12-08 02:37:13 -0800671 iminor(file->f_path.dentry->d_inode));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700672
673 /* just registers wait_queue hook. This doesn't really wait. */
674 poll_wait(file, &is->wq, wait);
675
676 if (!(is->state & IPPP_OPEN)) {
677 if(is->state == IPPP_CLOSEWAIT)
678 return POLLHUP;
679 printk(KERN_DEBUG "isdn_ppp: device not open\n");
680 return POLLERR;
681 }
682 /* we're always ready to send .. */
683 mask = POLLOUT | POLLWRNORM;
684
685 spin_lock_irqsave(&is->buflock, flags);
686 bl = is->last;
687 bf = is->first;
688 /*
689 * if IPPP_NOBLOCK is set we return even if we have nothing to read
690 */
691 if (bf->next != bl || (is->state & IPPP_NOBLOCK)) {
692 is->state &= ~IPPP_NOBLOCK;
693 mask |= POLLIN | POLLRDNORM;
694 }
695 spin_unlock_irqrestore(&is->buflock, flags);
696 return mask;
697}
698
699/*
700 * fill up isdn_ppp_read() queue ..
701 */
702
703static int
704isdn_ppp_fill_rq(unsigned char *buf, int len, int proto, int slot)
705{
706 struct ippp_buf_queue *bf, *bl;
707 u_long flags;
708 u_char *nbuf;
709 struct ippp_struct *is;
710
711 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
712 printk(KERN_WARNING "ippp: illegal slot(%d).\n", slot);
713 return 0;
714 }
715 is = ippp_table[slot];
716
717 if (!(is->state & IPPP_CONNECT)) {
718 printk(KERN_DEBUG "ippp: device not activated.\n");
719 return 0;
720 }
Robert P. J. Day5cbded52006-12-13 00:35:56 -0800721 nbuf = kmalloc(len + 4, GFP_ATOMIC);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700722 if (!nbuf) {
723 printk(KERN_WARNING "ippp: Can't alloc buf\n");
724 return 0;
725 }
726 nbuf[0] = PPP_ALLSTATIONS;
727 nbuf[1] = PPP_UI;
728 nbuf[2] = proto >> 8;
729 nbuf[3] = proto & 0xff;
730 memcpy(nbuf + 4, buf, len);
731
732 spin_lock_irqsave(&is->buflock, flags);
733 bf = is->first;
734 bl = is->last;
735
736 if (bf == bl) {
737 printk(KERN_WARNING "ippp: Queue is full; discarding first buffer\n");
738 bf = bf->next;
739 kfree(bf->buf);
740 is->first = bf;
741 }
742 bl->buf = (char *) nbuf;
743 bl->len = len + 4;
744
745 is->last = bl->next;
746 spin_unlock_irqrestore(&is->buflock, flags);
747 wake_up_interruptible(&is->wq);
748 return len;
749}
750
751/*
752 * read() .. non-blocking: ipppd calls it only after select()
753 * reports, that there is data
754 */
755
756int
757isdn_ppp_read(int min, struct file *file, char __user *buf, int count)
758{
759 struct ippp_struct *is;
760 struct ippp_buf_queue *b;
761 u_long flags;
762 u_char *save_buf;
763
764 is = file->private_data;
765
766 if (!(is->state & IPPP_OPEN))
767 return 0;
768
769 if (!access_ok(VERIFY_WRITE, buf, count))
770 return -EFAULT;
771
772 spin_lock_irqsave(&is->buflock, flags);
773 b = is->first->next;
774 save_buf = b->buf;
775 if (!save_buf) {
776 spin_unlock_irqrestore(&is->buflock, flags);
777 return -EAGAIN;
778 }
779 if (b->len < count)
780 count = b->len;
781 b->buf = NULL;
782 is->first = b;
783
784 spin_unlock_irqrestore(&is->buflock, flags);
Jesper Juhlc41a24c2006-03-25 03:07:02 -0800785 if (copy_to_user(buf, save_buf, count))
786 count = -EFAULT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700787 kfree(save_buf);
788
789 return count;
790}
791
792/*
793 * ipppd wanna write a packet to the card .. non-blocking
794 */
795
796int
797isdn_ppp_write(int min, struct file *file, const char __user *buf, int count)
798{
799 isdn_net_local *lp;
800 struct ippp_struct *is;
801 int proto;
802 unsigned char protobuf[4];
803
804 is = file->private_data;
805
806 if (!(is->state & IPPP_CONNECT))
807 return 0;
808
809 lp = is->lp;
810
811 /* -> push it directly to the lowlevel interface */
812
813 if (!lp)
814 printk(KERN_DEBUG "isdn_ppp_write: lp == NULL\n");
815 else {
816 /*
817 * Don't reset huptimer for
818 * LCP packets. (Echo requests).
819 */
820 if (copy_from_user(protobuf, buf, 4))
821 return -EFAULT;
822 proto = PPP_PROTOCOL(protobuf);
823 if (proto != PPP_LCP)
824 lp->huptimer = 0;
825
826 if (lp->isdn_device < 0 || lp->isdn_channel < 0)
827 return 0;
828
829 if ((dev->drv[lp->isdn_device]->flags & DRV_FLAG_RUNNING) &&
830 lp->dialstate == 0 &&
831 (lp->flags & ISDN_NET_CONNECTED)) {
832 unsigned short hl;
833 struct sk_buff *skb;
834 /*
André Goddard Rosaaf901ca2009-11-14 13:09:05 -0200835 * we need to reserve enough space in front of
Linus Torvalds1da177e2005-04-16 15:20:36 -0700836 * sk_buff. old call to dev_alloc_skb only reserved
837 * 16 bytes, now we are looking what the driver want
838 */
839 hl = dev->drv[lp->isdn_device]->interface->hl_hdrlen;
840 skb = alloc_skb(hl+count, GFP_ATOMIC);
841 if (!skb) {
842 printk(KERN_WARNING "isdn_ppp_write: out of memory!\n");
843 return count;
844 }
845 skb_reserve(skb, hl);
846 if (copy_from_user(skb_put(skb, count), buf, count))
847 {
848 kfree_skb(skb);
849 return -EFAULT;
850 }
851 if (is->debug & 0x40) {
852 printk(KERN_DEBUG "ppp xmit: len %d\n", (int) skb->len);
853 isdn_ppp_frame_log("xmit", skb->data, skb->len, 32,is->unit,lp->ppp_slot);
854 }
855
856 isdn_ppp_send_ccp(lp->netdev,lp,skb); /* keeps CCP/compression states in sync */
857
858 isdn_net_write_super(lp, skb);
859 }
860 }
861 return count;
862}
863
864/*
865 * init memory, structures etc.
866 */
867
868int
869isdn_ppp_init(void)
870{
871 int i,
872 j;
873
874#ifdef CONFIG_ISDN_MPP
875 if( isdn_ppp_mp_bundle_array_init() < 0 )
876 return -ENOMEM;
877#endif /* CONFIG_ISDN_MPP */
878
879 for (i = 0; i < ISDN_MAX_CHANNELS; i++) {
Burman Yan41f96932006-12-08 02:39:35 -0800880 if (!(ippp_table[i] = kzalloc(sizeof(struct ippp_struct), GFP_KERNEL))) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700881 printk(KERN_WARNING "isdn_ppp_init: Could not alloc ippp_table\n");
882 for (j = 0; j < i; j++)
883 kfree(ippp_table[j]);
884 return -1;
885 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700886 spin_lock_init(&ippp_table[i]->buflock);
887 ippp_table[i]->state = 0;
888 ippp_table[i]->first = ippp_table[i]->rq + NUM_RCV_BUFFS - 1;
889 ippp_table[i]->last = ippp_table[i]->rq;
890
891 for (j = 0; j < NUM_RCV_BUFFS; j++) {
892 ippp_table[i]->rq[j].buf = NULL;
893 ippp_table[i]->rq[j].last = ippp_table[i]->rq +
894 (NUM_RCV_BUFFS + j - 1) % NUM_RCV_BUFFS;
895 ippp_table[i]->rq[j].next = ippp_table[i]->rq + (j + 1) % NUM_RCV_BUFFS;
896 }
897 }
898 return 0;
899}
900
901void
902isdn_ppp_cleanup(void)
903{
904 int i;
905
906 for (i = 0; i < ISDN_MAX_CHANNELS; i++)
907 kfree(ippp_table[i]);
908
909#ifdef CONFIG_ISDN_MPP
Jesper Juhl3c7208f2005-11-07 01:01:29 -0800910 kfree(isdn_ppp_bundle_arr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700911#endif /* CONFIG_ISDN_MPP */
912
913}
914
915/*
916 * check for address/control field and skip if allowed
917 * retval != 0 -> discard packet silently
918 */
919static int isdn_ppp_skip_ac(struct ippp_struct *is, struct sk_buff *skb)
920{
921 if (skb->len < 1)
922 return -1;
923
924 if (skb->data[0] == 0xff) {
925 if (skb->len < 2)
926 return -1;
927
928 if (skb->data[1] != 0x03)
929 return -1;
930
931 // skip address/control (AC) field
932 skb_pull(skb, 2);
933 } else {
934 if (is->pppcfg & SC_REJ_COMP_AC)
935 // if AC compression was not negotiated, but used, discard packet
936 return -1;
937 }
938 return 0;
939}
940
941/*
942 * get the PPP protocol header and pull skb
943 * retval < 0 -> discard packet silently
944 */
945static int isdn_ppp_strip_proto(struct sk_buff *skb)
946{
947 int proto;
948
949 if (skb->len < 1)
950 return -1;
951
952 if (skb->data[0] & 0x1) {
953 // protocol field is compressed
954 proto = skb->data[0];
955 skb_pull(skb, 1);
956 } else {
957 if (skb->len < 2)
958 return -1;
959 proto = ((int) skb->data[0] << 8) + skb->data[1];
960 skb_pull(skb, 2);
961 }
962 return proto;
963}
964
965
966/*
967 * handler for incoming packets on a syncPPP interface
968 */
969void isdn_ppp_receive(isdn_net_dev * net_dev, isdn_net_local * lp, struct sk_buff *skb)
970{
971 struct ippp_struct *is;
972 int slot;
973 int proto;
974
Eric Sesterhenn6dd44a72006-03-26 18:19:26 +0200975 BUG_ON(net_dev->local->master); // we're called with the master device always
Linus Torvalds1da177e2005-04-16 15:20:36 -0700976
977 slot = lp->ppp_slot;
978 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
979 printk(KERN_ERR "isdn_ppp_receive: lp->ppp_slot(%d)\n",
980 lp->ppp_slot);
981 kfree_skb(skb);
982 return;
983 }
984 is = ippp_table[slot];
985
986 if (is->debug & 0x4) {
987 printk(KERN_DEBUG "ippp_receive: is:%08lx lp:%08lx slot:%d unit:%d len:%d\n",
988 (long)is,(long)lp,lp->ppp_slot,is->unit,(int) skb->len);
989 isdn_ppp_frame_log("receive", skb->data, skb->len, 32,is->unit,lp->ppp_slot);
990 }
991
992 if (isdn_ppp_skip_ac(is, skb) < 0) {
993 kfree_skb(skb);
994 return;
995 }
996 proto = isdn_ppp_strip_proto(skb);
997 if (proto < 0) {
998 kfree_skb(skb);
999 return;
1000 }
1001
1002#ifdef CONFIG_ISDN_MPP
1003 if (is->compflags & SC_LINK_DECOMP_ON) {
1004 skb = isdn_ppp_decompress(skb, is, NULL, &proto);
1005 if (!skb) // decompression error
1006 return;
1007 }
1008
1009 if (!(is->mpppcfg & SC_REJ_MP_PROT)) { // we agreed to receive MPPP
1010 if (proto == PPP_MP) {
1011 isdn_ppp_mp_receive(net_dev, lp, skb);
1012 return;
1013 }
1014 }
1015#endif
1016 isdn_ppp_push_higher(net_dev, lp, skb, proto);
1017}
1018
1019/*
1020 * we receive a reassembled frame, MPPP has been taken care of before.
1021 * address/control and protocol have been stripped from the skb
1022 * note: net_dev has to be master net_dev
1023 */
1024static void
1025isdn_ppp_push_higher(isdn_net_dev * net_dev, isdn_net_local * lp, struct sk_buff *skb, int proto)
1026{
Karsten Keild62a38d2007-10-08 20:37:11 -07001027 struct net_device *dev = net_dev->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001028 struct ippp_struct *is, *mis;
1029 isdn_net_local *mlp = NULL;
1030 int slot;
1031
1032 slot = lp->ppp_slot;
1033 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
1034 printk(KERN_ERR "isdn_ppp_push_higher: lp->ppp_slot(%d)\n",
1035 lp->ppp_slot);
1036 goto drop_packet;
1037 }
1038 is = ippp_table[slot];
1039
1040 if (lp->master) { // FIXME?
Wang Chen838361f2008-12-03 15:49:46 -08001041 mlp = ISDN_MASTER_PRIV(lp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001042 slot = mlp->ppp_slot;
Eric Sesterhenn052bb882006-04-11 17:29:17 -07001043 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001044 printk(KERN_ERR "isdn_ppp_push_higher: master->ppp_slot(%d)\n",
1045 lp->ppp_slot);
1046 goto drop_packet;
1047 }
1048 }
1049 mis = ippp_table[slot];
1050
1051 if (is->debug & 0x10) {
1052 printk(KERN_DEBUG "push, skb %d %04x\n", (int) skb->len, proto);
1053 isdn_ppp_frame_log("rpush", skb->data, skb->len, 32,is->unit,lp->ppp_slot);
1054 }
1055 if (mis->compflags & SC_DECOMP_ON) {
1056 skb = isdn_ppp_decompress(skb, is, mis, &proto);
1057 if (!skb) // decompression error
1058 return;
1059 }
1060 switch (proto) {
1061 case PPP_IPX: /* untested */
1062 if (is->debug & 0x20)
1063 printk(KERN_DEBUG "isdn_ppp: IPX\n");
1064 skb->protocol = htons(ETH_P_IPX);
1065 break;
1066 case PPP_IP:
1067 if (is->debug & 0x20)
1068 printk(KERN_DEBUG "isdn_ppp: IP\n");
1069 skb->protocol = htons(ETH_P_IP);
1070 break;
1071 case PPP_COMP:
1072 case PPP_COMPFRAG:
1073 printk(KERN_INFO "isdn_ppp: unexpected compressed frame dropped\n");
1074 goto drop_packet;
1075#ifdef CONFIG_ISDN_PPP_VJ
1076 case PPP_VJC_UNCOMP:
1077 if (is->debug & 0x20)
1078 printk(KERN_DEBUG "isdn_ppp: VJC_UNCOMP\n");
1079 if (net_dev->local->ppp_slot < 0) {
1080 printk(KERN_ERR "%s: net_dev->local->ppp_slot(%d) out of range\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -07001081 __func__, net_dev->local->ppp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001082 goto drop_packet;
1083 }
1084 if (slhc_remember(ippp_table[net_dev->local->ppp_slot]->slcomp, skb->data, skb->len) <= 0) {
1085 printk(KERN_WARNING "isdn_ppp: received illegal VJC_UNCOMP frame!\n");
1086 goto drop_packet;
1087 }
1088 skb->protocol = htons(ETH_P_IP);
1089 break;
1090 case PPP_VJC_COMP:
1091 if (is->debug & 0x20)
1092 printk(KERN_DEBUG "isdn_ppp: VJC_COMP\n");
1093 {
1094 struct sk_buff *skb_old = skb;
1095 int pkt_len;
1096 skb = dev_alloc_skb(skb_old->len + 128);
1097
1098 if (!skb) {
1099 printk(KERN_WARNING "%s: Memory squeeze, dropping packet.\n", dev->name);
1100 skb = skb_old;
1101 goto drop_packet;
1102 }
1103 skb_put(skb, skb_old->len + 128);
Arnaldo Carvalho de Melod626f622007-03-27 18:55:52 -03001104 skb_copy_from_linear_data(skb_old, skb->data,
1105 skb_old->len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001106 if (net_dev->local->ppp_slot < 0) {
1107 printk(KERN_ERR "%s: net_dev->local->ppp_slot(%d) out of range\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -07001108 __func__, net_dev->local->ppp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001109 goto drop_packet;
1110 }
1111 pkt_len = slhc_uncompress(ippp_table[net_dev->local->ppp_slot]->slcomp,
1112 skb->data, skb_old->len);
1113 kfree_skb(skb_old);
1114 if (pkt_len < 0)
1115 goto drop_packet;
1116
1117 skb_trim(skb, pkt_len);
1118 skb->protocol = htons(ETH_P_IP);
1119 }
1120 break;
1121#endif
1122 case PPP_CCP:
1123 case PPP_CCPFRAG:
1124 isdn_ppp_receive_ccp(net_dev,lp,skb,proto);
1125 /* Dont pop up ResetReq/Ack stuff to the daemon any
1126 longer - the job is done already */
1127 if(skb->data[0] == CCP_RESETREQ ||
1128 skb->data[0] == CCP_RESETACK)
1129 break;
1130 /* fall through */
1131 default:
1132 isdn_ppp_fill_rq(skb->data, skb->len, proto, lp->ppp_slot); /* push data to pppd device */
1133 kfree_skb(skb);
1134 return;
1135 }
1136
1137#ifdef CONFIG_IPPP_FILTER
1138 /* check if the packet passes the pass and active filters
1139 * the filter instructions are constructed assuming
1140 * a four-byte PPP header on each packet (which is still present) */
1141 skb_push(skb, 4);
1142
1143 {
1144 u_int16_t *p = (u_int16_t *) skb->data;
1145
Karsten Keild8470b72005-04-21 08:30:30 -07001146 *p = 0; /* indicate inbound */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001147 }
1148
1149 if (is->pass_filter
1150 && sk_run_filter(skb, is->pass_filter, is->pass_len) == 0) {
1151 if (is->debug & 0x2)
1152 printk(KERN_DEBUG "IPPP: inbound frame filtered.\n");
1153 kfree_skb(skb);
1154 return;
1155 }
1156 if (!(is->active_filter
1157 && sk_run_filter(skb, is->active_filter,
1158 is->active_len) == 0)) {
1159 if (is->debug & 0x2)
1160 printk(KERN_DEBUG "IPPP: link-active filter: reseting huptimer.\n");
1161 lp->huptimer = 0;
1162 if (mlp)
1163 mlp->huptimer = 0;
1164 }
1165 skb_pull(skb, 4);
1166#else /* CONFIG_IPPP_FILTER */
1167 lp->huptimer = 0;
1168 if (mlp)
1169 mlp->huptimer = 0;
1170#endif /* CONFIG_IPPP_FILTER */
1171 skb->dev = dev;
Arnaldo Carvalho de Melo459a98e2007-03-19 15:30:44 -07001172 skb_reset_mac_header(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001173 netif_rx(skb);
1174 /* net_dev->local->stats.rx_packets++; done in isdn_net.c */
1175 return;
1176
1177 drop_packet:
1178 net_dev->local->stats.rx_dropped++;
1179 kfree_skb(skb);
1180}
1181
1182/*
1183 * isdn_ppp_skb_push ..
1184 * checks whether we have enough space at the beginning of the skb
1185 * and allocs a new SKB if necessary
1186 */
1187static unsigned char *isdn_ppp_skb_push(struct sk_buff **skb_p,int len)
1188{
1189 struct sk_buff *skb = *skb_p;
1190
1191 if(skb_headroom(skb) < len) {
1192 struct sk_buff *nskb = skb_realloc_headroom(skb, len);
1193
1194 if (!nskb) {
1195 printk(KERN_ERR "isdn_ppp_skb_push: can't realloc headroom!\n");
1196 dev_kfree_skb(skb);
1197 return NULL;
1198 }
1199 printk(KERN_DEBUG "isdn_ppp_skb_push:under %d %d\n",skb_headroom(skb),len);
1200 dev_kfree_skb(skb);
1201 *skb_p = nskb;
1202 return skb_push(nskb, len);
1203 }
1204 return skb_push(skb,len);
1205}
1206
1207/*
1208 * send ppp frame .. we expect a PIDCOMPressable proto --
1209 * (here: currently always PPP_IP,PPP_VJC_COMP,PPP_VJC_UNCOMP)
1210 *
1211 * VJ compression may change skb pointer!!! .. requeue with old
1212 * skb isn't allowed!!
1213 */
1214
1215int
1216isdn_ppp_xmit(struct sk_buff *skb, struct net_device *netdev)
1217{
1218 isdn_net_local *lp,*mlp;
1219 isdn_net_dev *nd;
1220 unsigned int proto = PPP_IP; /* 0x21 */
1221 struct ippp_struct *ipt,*ipts;
Patrick McHardyec634fe2009-07-05 19:23:38 -07001222 int slot, retval = NETDEV_TX_OK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001223
Wang Chen838361f2008-12-03 15:49:46 -08001224 mlp = (isdn_net_local *) netdev_priv(netdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001225 nd = mlp->netdev; /* get master lp */
1226
1227 slot = mlp->ppp_slot;
1228 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
1229 printk(KERN_ERR "isdn_ppp_xmit: lp->ppp_slot(%d)\n",
1230 mlp->ppp_slot);
1231 kfree_skb(skb);
1232 goto out;
1233 }
1234 ipts = ippp_table[slot];
1235
1236 if (!(ipts->pppcfg & SC_ENABLE_IP)) { /* PPP connected ? */
1237 if (ipts->debug & 0x1)
1238 printk(KERN_INFO "%s: IP frame delayed.\n", netdev->name);
Patrick McHardyec634fe2009-07-05 19:23:38 -07001239 retval = NETDEV_TX_BUSY;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001240 goto out;
1241 }
1242
1243 switch (ntohs(skb->protocol)) {
1244 case ETH_P_IP:
1245 proto = PPP_IP;
1246 break;
1247 case ETH_P_IPX:
1248 proto = PPP_IPX; /* untested */
1249 break;
1250 default:
1251 printk(KERN_ERR "isdn_ppp: skipped unsupported protocol: %#x.\n",
1252 skb->protocol);
1253 dev_kfree_skb(skb);
1254 goto out;
1255 }
1256
1257 lp = isdn_net_get_locked_lp(nd);
1258 if (!lp) {
1259 printk(KERN_WARNING "%s: all channels busy - requeuing!\n", netdev->name);
Patrick McHardyec634fe2009-07-05 19:23:38 -07001260 retval = NETDEV_TX_BUSY;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001261 goto out;
1262 }
1263 /* we have our lp locked from now on */
1264
1265 slot = lp->ppp_slot;
Eric Sesterhenn052bb882006-04-11 17:29:17 -07001266 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001267 printk(KERN_ERR "isdn_ppp_xmit: lp->ppp_slot(%d)\n",
1268 lp->ppp_slot);
1269 kfree_skb(skb);
1270 goto unlock;
1271 }
1272 ipt = ippp_table[slot];
1273
1274 /*
1275 * after this line .. requeueing in the device queue is no longer allowed!!!
1276 */
1277
1278 /* Pull off the fake header we stuck on earlier to keep
1279 * the fragmentation code happy.
1280 */
1281 skb_pull(skb,IPPP_MAX_HEADER);
1282
1283#ifdef CONFIG_IPPP_FILTER
1284 /* check if we should pass this packet
1285 * the filter instructions are constructed assuming
1286 * a four-byte PPP header on each packet */
Karsten Keild8470b72005-04-21 08:30:30 -07001287 *skb_push(skb, 4) = 1; /* indicate outbound */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001288
1289 {
Harvey Harrisonc19d0362008-11-20 04:10:51 -08001290 __be16 *p = (__be16 *)skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001291
Karsten Keild8470b72005-04-21 08:30:30 -07001292 p++;
Harvey Harrisonc19d0362008-11-20 04:10:51 -08001293 *p = htons(proto);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001294 }
1295
1296 if (ipt->pass_filter
1297 && sk_run_filter(skb, ipt->pass_filter, ipt->pass_len) == 0) {
1298 if (ipt->debug & 0x4)
1299 printk(KERN_DEBUG "IPPP: outbound frame filtered.\n");
1300 kfree_skb(skb);
1301 goto unlock;
1302 }
1303 if (!(ipt->active_filter
1304 && sk_run_filter(skb, ipt->active_filter,
1305 ipt->active_len) == 0)) {
1306 if (ipt->debug & 0x4)
1307 printk(KERN_DEBUG "IPPP: link-active filter: reseting huptimer.\n");
1308 lp->huptimer = 0;
1309 }
1310 skb_pull(skb, 4);
1311#else /* CONFIG_IPPP_FILTER */
1312 lp->huptimer = 0;
1313#endif /* CONFIG_IPPP_FILTER */
1314
1315 if (ipt->debug & 0x4)
1316 printk(KERN_DEBUG "xmit skb, len %d\n", (int) skb->len);
1317 if (ipts->debug & 0x40)
1318 isdn_ppp_frame_log("xmit0", skb->data, skb->len, 32,ipts->unit,lp->ppp_slot);
1319
1320#ifdef CONFIG_ISDN_PPP_VJ
1321 if (proto == PPP_IP && ipts->pppcfg & SC_COMP_TCP) { /* ipts here? probably yes, but check this again */
1322 struct sk_buff *new_skb;
1323 unsigned short hl;
1324 /*
André Goddard Rosaaf901ca2009-11-14 13:09:05 -02001325 * we need to reserve enough space in front of
Linus Torvalds1da177e2005-04-16 15:20:36 -07001326 * sk_buff. old call to dev_alloc_skb only reserved
1327 * 16 bytes, now we are looking what the driver want.
1328 */
1329 hl = dev->drv[lp->isdn_device]->interface->hl_hdrlen + IPPP_MAX_HEADER;
1330 /*
1331 * Note: hl might still be insufficient because the method
1332 * above does not account for a possibible MPPP slave channel
1333 * which had larger HL header space requirements than the
1334 * master.
1335 */
1336 new_skb = alloc_skb(hl+skb->len, GFP_ATOMIC);
1337 if (new_skb) {
1338 u_char *buf;
1339 int pktlen;
1340
1341 skb_reserve(new_skb, hl);
1342 new_skb->dev = skb->dev;
1343 skb_put(new_skb, skb->len);
1344 buf = skb->data;
1345
1346 pktlen = slhc_compress(ipts->slcomp, skb->data, skb->len, new_skb->data,
1347 &buf, !(ipts->pppcfg & SC_NO_TCP_CCID));
1348
1349 if (buf != skb->data) {
1350 if (new_skb->data != buf)
1351 printk(KERN_ERR "isdn_ppp: FATAL error after slhc_compress!!\n");
1352 dev_kfree_skb(skb);
1353 skb = new_skb;
1354 } else {
1355 dev_kfree_skb(new_skb);
1356 }
1357
1358 skb_trim(skb, pktlen);
1359 if (skb->data[0] & SL_TYPE_COMPRESSED_TCP) { /* cslip? style -> PPP */
1360 proto = PPP_VJC_COMP;
1361 skb->data[0] ^= SL_TYPE_COMPRESSED_TCP;
1362 } else {
1363 if (skb->data[0] >= SL_TYPE_UNCOMPRESSED_TCP)
1364 proto = PPP_VJC_UNCOMP;
1365 skb->data[0] = (skb->data[0] & 0x0f) | 0x40;
1366 }
1367 }
1368 }
1369#endif
1370
1371 /*
1372 * normal (single link) or bundle compression
1373 */
1374 if(ipts->compflags & SC_COMP_ON) {
1375 /* We send compressed only if both down- und upstream
1376 compression is negotiated, that means, CCP is up */
1377 if(ipts->compflags & SC_DECOMP_ON) {
1378 skb = isdn_ppp_compress(skb,&proto,ipt,ipts,0);
1379 } else {
1380 printk(KERN_DEBUG "isdn_ppp: CCP not yet up - sending as-is\n");
1381 }
1382 }
1383
1384 if (ipt->debug & 0x24)
1385 printk(KERN_DEBUG "xmit2 skb, len %d, proto %04x\n", (int) skb->len, proto);
1386
1387#ifdef CONFIG_ISDN_MPP
1388 if (ipt->mpppcfg & SC_MP_PROT) {
1389 /* we get mp_seqno from static isdn_net_local */
1390 long mp_seqno = ipts->mp_seqno;
1391 ipts->mp_seqno++;
1392 if (ipt->mpppcfg & SC_OUT_SHORT_SEQ) {
1393 unsigned char *data = isdn_ppp_skb_push(&skb, 3);
1394 if(!data)
1395 goto unlock;
1396 mp_seqno &= 0xfff;
1397 data[0] = MP_BEGIN_FRAG | MP_END_FRAG | ((mp_seqno >> 8) & 0xf); /* (B)egin & (E)ndbit .. */
1398 data[1] = mp_seqno & 0xff;
1399 data[2] = proto; /* PID compression */
1400 } else {
1401 unsigned char *data = isdn_ppp_skb_push(&skb, 5);
1402 if(!data)
1403 goto unlock;
1404 data[0] = MP_BEGIN_FRAG | MP_END_FRAG; /* (B)egin & (E)ndbit .. */
1405 data[1] = (mp_seqno >> 16) & 0xff; /* sequence number: 24bit */
1406 data[2] = (mp_seqno >> 8) & 0xff;
1407 data[3] = (mp_seqno >> 0) & 0xff;
1408 data[4] = proto; /* PID compression */
1409 }
1410 proto = PPP_MP; /* MP Protocol, 0x003d */
1411 }
1412#endif
1413
1414 /*
1415 * 'link in bundle' compression ...
1416 */
1417 if(ipt->compflags & SC_LINK_COMP_ON)
1418 skb = isdn_ppp_compress(skb,&proto,ipt,ipts,1);
1419
1420 if( (ipt->pppcfg & SC_COMP_PROT) && (proto <= 0xff) ) {
1421 unsigned char *data = isdn_ppp_skb_push(&skb,1);
1422 if(!data)
1423 goto unlock;
1424 data[0] = proto & 0xff;
1425 }
1426 else {
1427 unsigned char *data = isdn_ppp_skb_push(&skb,2);
1428 if(!data)
1429 goto unlock;
1430 data[0] = (proto >> 8) & 0xff;
1431 data[1] = proto & 0xff;
1432 }
1433 if(!(ipt->pppcfg & SC_COMP_AC)) {
1434 unsigned char *data = isdn_ppp_skb_push(&skb,2);
1435 if(!data)
1436 goto unlock;
1437 data[0] = 0xff; /* All Stations */
1438 data[1] = 0x03; /* Unnumbered information */
1439 }
1440
1441 /* tx-stats are now updated via BSENT-callback */
1442
1443 if (ipts->debug & 0x40) {
1444 printk(KERN_DEBUG "skb xmit: len: %d\n", (int) skb->len);
1445 isdn_ppp_frame_log("xmit", skb->data, skb->len, 32,ipt->unit,lp->ppp_slot);
1446 }
1447
1448 isdn_net_writebuf_skb(lp, skb);
1449
1450 unlock:
1451 spin_unlock_bh(&lp->xmit_lock);
1452 out:
1453 return retval;
1454}
1455
1456#ifdef CONFIG_IPPP_FILTER
1457/*
1458 * check if this packet may trigger auto-dial.
1459 */
1460
1461int isdn_ppp_autodial_filter(struct sk_buff *skb, isdn_net_local *lp)
1462{
1463 struct ippp_struct *is = ippp_table[lp->ppp_slot];
1464 u_int16_t proto;
1465 int drop = 0;
1466
1467 switch (ntohs(skb->protocol)) {
1468 case ETH_P_IP:
1469 proto = PPP_IP;
1470 break;
1471 case ETH_P_IPX:
1472 proto = PPP_IPX;
1473 break;
1474 default:
1475 printk(KERN_ERR "isdn_ppp_autodial_filter: unsupported protocol 0x%x.\n",
1476 skb->protocol);
1477 return 1;
1478 }
1479
1480 /* the filter instructions are constructed assuming
1481 * a four-byte PPP header on each packet. we have to
1482 * temporarily remove part of the fake header stuck on
1483 * earlier.
1484 */
Karsten Keild8470b72005-04-21 08:30:30 -07001485 *skb_pull(skb, IPPP_MAX_HEADER - 4) = 1; /* indicate outbound */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001486
1487 {
Harvey Harrisonc19d0362008-11-20 04:10:51 -08001488 __be16 *p = (__be16 *)skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001489
Karsten Keild8470b72005-04-21 08:30:30 -07001490 p++;
Harvey Harrisonc19d0362008-11-20 04:10:51 -08001491 *p = htons(proto);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001492 }
1493
1494 drop |= is->pass_filter
1495 && sk_run_filter(skb, is->pass_filter, is->pass_len) == 0;
1496 drop |= is->active_filter
1497 && sk_run_filter(skb, is->active_filter, is->active_len) == 0;
1498
1499 skb_push(skb, IPPP_MAX_HEADER - 4);
1500 return drop;
1501}
1502#endif
1503#ifdef CONFIG_ISDN_MPP
1504
1505/* this is _not_ rfc1990 header, but something we convert both short and long
1506 * headers to for convinience's sake:
1507 * byte 0 is flags as in rfc1990
1508 * bytes 1...4 is 24-bit seqence number converted to host byte order
1509 */
1510#define MP_HEADER_LEN 5
1511
1512#define MP_LONGSEQ_MASK 0x00ffffff
1513#define MP_SHORTSEQ_MASK 0x00000fff
1514#define MP_LONGSEQ_MAX MP_LONGSEQ_MASK
1515#define MP_SHORTSEQ_MAX MP_SHORTSEQ_MASK
1516#define MP_LONGSEQ_MAXBIT ((MP_LONGSEQ_MASK+1)>>1)
1517#define MP_SHORTSEQ_MAXBIT ((MP_SHORTSEQ_MASK+1)>>1)
1518
1519/* sequence-wrap safe comparisions (for long sequence)*/
1520#define MP_LT(a,b) ((a-b)&MP_LONGSEQ_MAXBIT)
1521#define MP_LE(a,b) !((b-a)&MP_LONGSEQ_MAXBIT)
1522#define MP_GT(a,b) ((b-a)&MP_LONGSEQ_MAXBIT)
1523#define MP_GE(a,b) !((a-b)&MP_LONGSEQ_MAXBIT)
1524
1525#define MP_SEQ(f) ((*(u32*)(f->data+1)))
1526#define MP_FLAGS(f) (f->data[0])
1527
1528static int isdn_ppp_mp_bundle_array_init(void)
1529{
1530 int i;
1531 int sz = ISDN_MAX_CHANNELS*sizeof(ippp_bundle);
Burman Yan41f96932006-12-08 02:39:35 -08001532 if( (isdn_ppp_bundle_arr = kzalloc(sz, GFP_KERNEL)) == NULL )
Linus Torvalds1da177e2005-04-16 15:20:36 -07001533 return -ENOMEM;
David S. Millere29d4362009-11-15 22:23:47 -08001534 for( i = 0; i < ISDN_MAX_CHANNELS; i++ )
Linus Torvalds1da177e2005-04-16 15:20:36 -07001535 spin_lock_init(&isdn_ppp_bundle_arr[i].lock);
1536 return 0;
1537}
1538
1539static ippp_bundle * isdn_ppp_mp_bundle_alloc(void)
1540{
1541 int i;
1542 for( i = 0; i < ISDN_MAX_CHANNELS; i++ )
1543 if (isdn_ppp_bundle_arr[i].ref_ct <= 0)
1544 return (isdn_ppp_bundle_arr + i);
1545 return NULL;
1546}
1547
1548static int isdn_ppp_mp_init( isdn_net_local * lp, ippp_bundle * add_to )
1549{
1550 struct ippp_struct * is;
1551
1552 if (lp->ppp_slot < 0) {
1553 printk(KERN_ERR "%s: lp->ppp_slot(%d) out of range\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -07001554 __func__, lp->ppp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001555 return(-EINVAL);
1556 }
1557
1558 is = ippp_table[lp->ppp_slot];
1559 if (add_to) {
1560 if( lp->netdev->pb )
1561 lp->netdev->pb->ref_ct--;
1562 lp->netdev->pb = add_to;
1563 } else { /* first link in a bundle */
1564 is->mp_seqno = 0;
1565 if ((lp->netdev->pb = isdn_ppp_mp_bundle_alloc()) == NULL)
1566 return -ENOMEM;
1567 lp->next = lp->last = lp; /* nobody else in a queue */
David S. Millere29d4362009-11-15 22:23:47 -08001568 lp->netdev->pb->frags = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001569 lp->netdev->pb->frames = 0;
1570 lp->netdev->pb->seq = UINT_MAX;
1571 }
1572 lp->netdev->pb->ref_ct++;
1573
1574 is->last_link_seqno = 0;
1575 return 0;
1576}
1577
1578static u32 isdn_ppp_mp_get_seq( int short_seq,
1579 struct sk_buff * skb, u32 last_seq );
David S. Millere29d4362009-11-15 22:23:47 -08001580static struct sk_buff * isdn_ppp_mp_discard( ippp_bundle * mp,
1581 struct sk_buff * from, struct sk_buff * to );
1582static void isdn_ppp_mp_reassembly( isdn_net_dev * net_dev, isdn_net_local * lp,
1583 struct sk_buff * from, struct sk_buff * to );
1584static void isdn_ppp_mp_free_skb( ippp_bundle * mp, struct sk_buff * skb );
Linus Torvalds1da177e2005-04-16 15:20:36 -07001585static void isdn_ppp_mp_print_recv_pkt( int slot, struct sk_buff * skb );
1586
1587static void isdn_ppp_mp_receive(isdn_net_dev * net_dev, isdn_net_local * lp,
David S. Millere29d4362009-11-15 22:23:47 -08001588 struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001589{
David S. Miller38783e62008-09-22 01:15:02 -07001590 struct ippp_struct *is;
David S. Millere29d4362009-11-15 22:23:47 -08001591 isdn_net_local * lpq;
1592 ippp_bundle * mp;
1593 isdn_mppp_stats * stats;
1594 struct sk_buff * newfrag, * frag, * start, *nextf;
1595 u32 newseq, minseq, thisseq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001596 unsigned long flags;
1597 int slot;
1598
1599 spin_lock_irqsave(&net_dev->pb->lock, flags);
David S. Millere29d4362009-11-15 22:23:47 -08001600 mp = net_dev->pb;
1601 stats = &mp->stats;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001602 slot = lp->ppp_slot;
Eric Sesterhenn052bb882006-04-11 17:29:17 -07001603 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001604 printk(KERN_ERR "%s: lp->ppp_slot(%d)\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -07001605 __func__, lp->ppp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001606 stats->frame_drops++;
1607 dev_kfree_skb(skb);
1608 spin_unlock_irqrestore(&mp->lock, flags);
1609 return;
1610 }
1611 is = ippp_table[slot];
David S. Millere29d4362009-11-15 22:23:47 -08001612 if( ++mp->frames > stats->max_queue_len )
Linus Torvalds1da177e2005-04-16 15:20:36 -07001613 stats->max_queue_len = mp->frames;
David S. Millere29d4362009-11-15 22:23:47 -08001614
Linus Torvalds1da177e2005-04-16 15:20:36 -07001615 if (is->debug & 0x8)
1616 isdn_ppp_mp_print_recv_pkt(lp->ppp_slot, skb);
1617
David S. Millere29d4362009-11-15 22:23:47 -08001618 newseq = isdn_ppp_mp_get_seq(is->mpppcfg & SC_IN_SHORT_SEQ,
1619 skb, is->last_link_seqno);
1620
Linus Torvalds1da177e2005-04-16 15:20:36 -07001621
1622 /* if this packet seq # is less than last already processed one,
1623 * toss it right away, but check for sequence start case first
1624 */
David S. Millere29d4362009-11-15 22:23:47 -08001625 if( mp->seq > MP_LONGSEQ_MAX && (newseq & MP_LONGSEQ_MAXBIT) ) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001626 mp->seq = newseq; /* the first packet: required for
1627 * rfc1990 non-compliant clients --
1628 * prevents constant packet toss */
1629 } else if( MP_LT(newseq, mp->seq) ) {
1630 stats->frame_drops++;
1631 isdn_ppp_mp_free_skb(mp, skb);
1632 spin_unlock_irqrestore(&mp->lock, flags);
1633 return;
1634 }
David S. Millere29d4362009-11-15 22:23:47 -08001635
Linus Torvalds1da177e2005-04-16 15:20:36 -07001636 /* find the minimum received sequence number over all links */
1637 is->last_link_seqno = minseq = newseq;
1638 for (lpq = net_dev->queue;;) {
1639 slot = lpq->ppp_slot;
Eric Sesterhenn052bb882006-04-11 17:29:17 -07001640 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001641 printk(KERN_ERR "%s: lpq->ppp_slot(%d)\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -07001642 __func__, lpq->ppp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001643 } else {
1644 u32 lls = ippp_table[slot]->last_link_seqno;
1645 if (MP_LT(lls, minseq))
1646 minseq = lls;
1647 }
1648 if ((lpq = lpq->next) == net_dev->queue)
1649 break;
1650 }
1651 if (MP_LT(minseq, mp->seq))
1652 minseq = mp->seq; /* can't go beyond already processed
1653 * packets */
1654 newfrag = skb;
1655
David S. Millere29d4362009-11-15 22:23:47 -08001656 /* if this new fragment is before the first one, then enqueue it now. */
1657 if ((frag = mp->frags) == NULL || MP_LT(newseq, MP_SEQ(frag))) {
1658 newfrag->next = frag;
1659 mp->frags = frag = newfrag;
1660 newfrag = NULL;
1661 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001662
David S. Millere29d4362009-11-15 22:23:47 -08001663 start = MP_FLAGS(frag) & MP_BEGIN_FRAG &&
1664 MP_SEQ(frag) == mp->seq ? frag : NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001665
David S. Millere29d4362009-11-15 22:23:47 -08001666 /*
1667 * main fragment traversing loop
Linus Torvalds1da177e2005-04-16 15:20:36 -07001668 *
1669 * try to accomplish several tasks:
David S. Millere29d4362009-11-15 22:23:47 -08001670 * - insert new fragment into the proper sequence slot (once that's done
1671 * newfrag will be set to NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001672 * - reassemble any complete fragment sequence (non-null 'start'
André Goddard Rosaaf901ca2009-11-14 13:09:05 -02001673 * indicates there is a contiguous sequence present)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001674 * - discard any incomplete sequences that are below minseq -- due
1675 * to the fact that sender always increment sequence number, if there
1676 * is an incomplete sequence below minseq, no new fragments would
1677 * come to complete such sequence and it should be discarded
1678 *
1679 * loop completes when we accomplished the following tasks:
David S. Millere29d4362009-11-15 22:23:47 -08001680 * - new fragment is inserted in the proper sequence ('newfrag' is
1681 * set to NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001682 * - we hit a gap in the sequence, so no reassembly/processing is
1683 * possible ('start' would be set to NULL)
1684 *
Robert P. J. Dayd08df602007-02-17 19:07:33 +01001685 * algorithm for this code is derived from code in the book
Linus Torvalds1da177e2005-04-16 15:20:36 -07001686 * 'PPP Design And Debugging' by James Carlson (Addison-Wesley)
1687 */
David S. Millere29d4362009-11-15 22:23:47 -08001688 while (start != NULL || newfrag != NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001689
David S. Millere29d4362009-11-15 22:23:47 -08001690 thisseq = MP_SEQ(frag);
1691 nextf = frag->next;
1692
1693 /* drop any duplicate fragments */
1694 if (newfrag != NULL && thisseq == newseq) {
1695 isdn_ppp_mp_free_skb(mp, newfrag);
1696 newfrag = NULL;
1697 }
1698
1699 /* insert new fragment before next element if possible. */
1700 if (newfrag != NULL && (nextf == NULL ||
1701 MP_LT(newseq, MP_SEQ(nextf)))) {
1702 newfrag->next = nextf;
1703 frag->next = nextf = newfrag;
1704 newfrag = NULL;
1705 }
1706
1707 if (start != NULL) {
1708 /* check for misplaced start */
1709 if (start != frag && (MP_FLAGS(frag) & MP_BEGIN_FRAG)) {
1710 printk(KERN_WARNING"isdn_mppp(seq %d): new "
1711 "BEGIN flag with no prior END", thisseq);
1712 stats->seqerrs++;
1713 stats->frame_drops++;
1714 start = isdn_ppp_mp_discard(mp, start,frag);
1715 nextf = frag->next;
1716 }
1717 } else if (MP_LE(thisseq, minseq)) {
1718 if (MP_FLAGS(frag) & MP_BEGIN_FRAG)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001719 start = frag;
David S. Millere29d4362009-11-15 22:23:47 -08001720 else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001721 if (MP_FLAGS(frag) & MP_END_FRAG)
David S. Millere29d4362009-11-15 22:23:47 -08001722 stats->frame_drops++;
1723 if( mp->frags == frag )
1724 mp->frags = nextf;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001725 isdn_ppp_mp_free_skb(mp, frag);
David S. Millere29d4362009-11-15 22:23:47 -08001726 frag = nextf;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001727 continue;
David S. Millere29d4362009-11-15 22:23:47 -08001728 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001729 }
David S. Millere29d4362009-11-15 22:23:47 -08001730
1731 /* if start is non-null and we have end fragment, then
1732 * we have full reassembly sequence -- reassemble
1733 * and process packet now
David S. Miller38783e62008-09-22 01:15:02 -07001734 */
David S. Millere29d4362009-11-15 22:23:47 -08001735 if (start != NULL && (MP_FLAGS(frag) & MP_END_FRAG)) {
1736 minseq = mp->seq = (thisseq+1) & MP_LONGSEQ_MASK;
1737 /* Reassemble the packet then dispatch it */
1738 isdn_ppp_mp_reassembly(net_dev, lp, start, nextf);
1739
1740 start = NULL;
1741 frag = NULL;
David S. Miller38783e62008-09-22 01:15:02 -07001742
David S. Millere29d4362009-11-15 22:23:47 -08001743 mp->frags = nextf;
1744 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001745
1746 /* check if need to update start pointer: if we just
1747 * reassembled the packet and sequence is contiguous
1748 * then next fragment should be the start of new reassembly
1749 * if sequence is contiguous, but we haven't reassembled yet,
1750 * keep going.
1751 * if sequence is not contiguous, either clear everyting
1752 * below low watermark and set start to the next frag or
1753 * clear start ptr.
1754 */
David S. Millere29d4362009-11-15 22:23:47 -08001755 if (nextf != NULL &&
Linus Torvalds1da177e2005-04-16 15:20:36 -07001756 ((thisseq+1) & MP_LONGSEQ_MASK) == MP_SEQ(nextf)) {
David S. Millere29d4362009-11-15 22:23:47 -08001757 /* if we just reassembled and the next one is here,
1758 * then start another reassembly. */
1759
1760 if (frag == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001761 if (MP_FLAGS(nextf) & MP_BEGIN_FRAG)
David S. Millere29d4362009-11-15 22:23:47 -08001762 start = nextf;
1763 else
1764 {
1765 printk(KERN_WARNING"isdn_mppp(seq %d):"
1766 " END flag with no following "
1767 "BEGIN", thisseq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001768 stats->seqerrs++;
1769 }
1770 }
David S. Millere29d4362009-11-15 22:23:47 -08001771
1772 } else {
1773 if ( nextf != NULL && frag != NULL &&
1774 MP_LT(thisseq, minseq)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001775 /* we've got a break in the sequence
1776 * and we not at the end yet
1777 * and we did not just reassembled
1778 *(if we did, there wouldn't be anything before)
1779 * and we below the low watermark
1780 * discard all the frames below low watermark
1781 * and start over */
1782 stats->frame_drops++;
David S. Millere29d4362009-11-15 22:23:47 -08001783 mp->frags = isdn_ppp_mp_discard(mp,start,nextf);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001784 }
1785 /* break in the sequence, no reassembly */
David S. Millere29d4362009-11-15 22:23:47 -08001786 start = NULL;
1787 }
1788
1789 frag = nextf;
1790 } /* while -- main loop */
1791
1792 if (mp->frags == NULL)
1793 mp->frags = frag;
1794
Linus Torvalds1da177e2005-04-16 15:20:36 -07001795 /* rather straighforward way to deal with (not very) possible
David S. Millere29d4362009-11-15 22:23:47 -08001796 * queue overflow */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001797 if (mp->frames > MP_MAX_QUEUE_LEN) {
1798 stats->overflows++;
David S. Millere29d4362009-11-15 22:23:47 -08001799 while (mp->frames > MP_MAX_QUEUE_LEN) {
1800 frag = mp->frags->next;
1801 isdn_ppp_mp_free_skb(mp, mp->frags);
1802 mp->frags = frag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001803 }
1804 }
1805 spin_unlock_irqrestore(&mp->lock, flags);
1806}
1807
David S. Millere29d4362009-11-15 22:23:47 -08001808static void isdn_ppp_mp_cleanup( isdn_net_local * lp )
Linus Torvalds1da177e2005-04-16 15:20:36 -07001809{
David S. Millere29d4362009-11-15 22:23:47 -08001810 struct sk_buff * frag = lp->netdev->pb->frags;
1811 struct sk_buff * nextfrag;
1812 while( frag ) {
1813 nextfrag = frag->next;
1814 isdn_ppp_mp_free_skb(lp->netdev->pb, frag);
1815 frag = nextfrag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001816 }
David S. Millere29d4362009-11-15 22:23:47 -08001817 lp->netdev->pb->frags = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001818}
1819
1820static u32 isdn_ppp_mp_get_seq( int short_seq,
1821 struct sk_buff * skb, u32 last_seq )
1822{
1823 u32 seq;
1824 int flags = skb->data[0] & (MP_BEGIN_FRAG | MP_END_FRAG);
1825
1826 if( !short_seq )
1827 {
Harvey Harrisonc19d0362008-11-20 04:10:51 -08001828 seq = ntohl(*(__be32 *)skb->data) & MP_LONGSEQ_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001829 skb_push(skb,1);
1830 }
1831 else
1832 {
1833 /* convert 12-bit short seq number to 24-bit long one
1834 */
Harvey Harrisonc19d0362008-11-20 04:10:51 -08001835 seq = ntohs(*(__be16 *)skb->data) & MP_SHORTSEQ_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001836
1837 /* check for seqence wrap */
1838 if( !(seq & MP_SHORTSEQ_MAXBIT) &&
1839 (last_seq & MP_SHORTSEQ_MAXBIT) &&
1840 (unsigned long)last_seq <= MP_LONGSEQ_MAX )
1841 seq |= (last_seq + MP_SHORTSEQ_MAX+1) &
1842 (~MP_SHORTSEQ_MASK & MP_LONGSEQ_MASK);
1843 else
1844 seq |= last_seq & (~MP_SHORTSEQ_MASK & MP_LONGSEQ_MASK);
1845
1846 skb_push(skb, 3); /* put converted seqence back in skb */
1847 }
1848 *(u32*)(skb->data+1) = seq; /* put seqence back in _host_ byte
1849 * order */
1850 skb->data[0] = flags; /* restore flags */
1851 return seq;
1852}
1853
David S. Millere29d4362009-11-15 22:23:47 -08001854struct sk_buff * isdn_ppp_mp_discard( ippp_bundle * mp,
1855 struct sk_buff * from, struct sk_buff * to )
Linus Torvalds1da177e2005-04-16 15:20:36 -07001856{
David S. Millere29d4362009-11-15 22:23:47 -08001857 if( from )
1858 while (from != to) {
1859 struct sk_buff * next = from->next;
1860 isdn_ppp_mp_free_skb(mp, from);
1861 from = next;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001862 }
David S. Millere29d4362009-11-15 22:23:47 -08001863 return from;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001864}
1865
David S. Millere29d4362009-11-15 22:23:47 -08001866void isdn_ppp_mp_reassembly( isdn_net_dev * net_dev, isdn_net_local * lp,
1867 struct sk_buff * from, struct sk_buff * to )
Linus Torvalds1da177e2005-04-16 15:20:36 -07001868{
David S. Millere29d4362009-11-15 22:23:47 -08001869 ippp_bundle * mp = net_dev->pb;
David S. Miller38783e62008-09-22 01:15:02 -07001870 int proto;
David S. Millere29d4362009-11-15 22:23:47 -08001871 struct sk_buff * skb;
1872 unsigned int tot_len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001873
1874 if (lp->ppp_slot < 0 || lp->ppp_slot >= ISDN_MAX_CHANNELS) {
1875 printk(KERN_ERR "%s: lp->ppp_slot(%d) out of range\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -07001876 __func__, lp->ppp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001877 return;
1878 }
David S. Millere29d4362009-11-15 22:23:47 -08001879 if( MP_FLAGS(from) == (MP_BEGIN_FRAG | MP_END_FRAG) ) {
1880 if( ippp_table[lp->ppp_slot]->debug & 0x40 )
Linus Torvalds1da177e2005-04-16 15:20:36 -07001881 printk(KERN_DEBUG "isdn_mppp: reassembly: frame %d, "
David S. Millere29d4362009-11-15 22:23:47 -08001882 "len %d\n", MP_SEQ(from), from->len );
Linus Torvalds1da177e2005-04-16 15:20:36 -07001883 skb = from;
1884 skb_pull(skb, MP_HEADER_LEN);
1885 mp->frames--;
1886 } else {
David S. Millere29d4362009-11-15 22:23:47 -08001887 struct sk_buff * frag;
1888 int n;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001889
David S. Millere29d4362009-11-15 22:23:47 -08001890 for(tot_len=n=0, frag=from; frag != to; frag=frag->next, n++)
1891 tot_len += frag->len - MP_HEADER_LEN;
1892
1893 if( ippp_table[lp->ppp_slot]->debug & 0x40 )
Linus Torvalds1da177e2005-04-16 15:20:36 -07001894 printk(KERN_DEBUG"isdn_mppp: reassembling frames %d "
David S. Millere29d4362009-11-15 22:23:47 -08001895 "to %d, len %d\n", MP_SEQ(from),
1896 (MP_SEQ(from)+n-1) & MP_LONGSEQ_MASK, tot_len );
1897 if( (skb = dev_alloc_skb(tot_len)) == NULL ) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001898 printk(KERN_ERR "isdn_mppp: cannot allocate sk buff "
David S. Millere29d4362009-11-15 22:23:47 -08001899 "of size %d\n", tot_len);
1900 isdn_ppp_mp_discard(mp, from, to);
1901 return;
1902 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001903
David S. Millere29d4362009-11-15 22:23:47 -08001904 while( from != to ) {
1905 unsigned int len = from->len - MP_HEADER_LEN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001906
David S. Millere29d4362009-11-15 22:23:47 -08001907 skb_copy_from_linear_data_offset(from, MP_HEADER_LEN,
1908 skb_put(skb,len),
1909 len);
1910 frag = from->next;
1911 isdn_ppp_mp_free_skb(mp, from);
1912 from = frag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001913 }
1914 }
1915 proto = isdn_ppp_strip_proto(skb);
1916 isdn_ppp_push_higher(net_dev, lp, skb, proto);
1917}
1918
David S. Millere29d4362009-11-15 22:23:47 -08001919static void isdn_ppp_mp_free_skb(ippp_bundle * mp, struct sk_buff * skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001920{
1921 dev_kfree_skb(skb);
1922 mp->frames--;
1923}
1924
1925static void isdn_ppp_mp_print_recv_pkt( int slot, struct sk_buff * skb )
1926{
1927 printk(KERN_DEBUG "mp_recv: %d/%d -> %02x %02x %02x %02x %02x %02x\n",
1928 slot, (int) skb->len,
1929 (int) skb->data[0], (int) skb->data[1], (int) skb->data[2],
1930 (int) skb->data[3], (int) skb->data[4], (int) skb->data[5]);
1931}
1932
1933static int
1934isdn_ppp_bundle(struct ippp_struct *is, int unit)
1935{
1936 char ifn[IFNAMSIZ + 1];
1937 isdn_net_dev *p;
1938 isdn_net_local *lp, *nlp;
1939 int rc;
1940 unsigned long flags;
1941
1942 sprintf(ifn, "ippp%d", unit);
1943 p = isdn_net_findif(ifn);
1944 if (!p) {
1945 printk(KERN_ERR "ippp_bundle: cannot find %s\n", ifn);
1946 return -EINVAL;
1947 }
1948
1949 spin_lock_irqsave(&p->pb->lock, flags);
1950
1951 nlp = is->lp;
1952 lp = p->queue;
1953 if( nlp->ppp_slot < 0 || nlp->ppp_slot >= ISDN_MAX_CHANNELS ||
1954 lp->ppp_slot < 0 || lp->ppp_slot >= ISDN_MAX_CHANNELS ) {
1955 printk(KERN_ERR "ippp_bundle: binding to invalid slot %d\n",
1956 nlp->ppp_slot < 0 || nlp->ppp_slot >= ISDN_MAX_CHANNELS ?
1957 nlp->ppp_slot : lp->ppp_slot );
1958 rc = -EINVAL;
1959 goto out;
1960 }
1961
1962 isdn_net_add_to_bundle(p, nlp);
1963
1964 ippp_table[nlp->ppp_slot]->unit = ippp_table[lp->ppp_slot]->unit;
1965
1966 /* maybe also SC_CCP stuff */
1967 ippp_table[nlp->ppp_slot]->pppcfg |= ippp_table[lp->ppp_slot]->pppcfg &
1968 (SC_ENABLE_IP | SC_NO_TCP_CCID | SC_REJ_COMP_TCP);
1969 ippp_table[nlp->ppp_slot]->mpppcfg |= ippp_table[lp->ppp_slot]->mpppcfg &
1970 (SC_MP_PROT | SC_REJ_MP_PROT | SC_OUT_SHORT_SEQ | SC_IN_SHORT_SEQ);
1971 rc = isdn_ppp_mp_init(nlp, p->pb);
1972out:
1973 spin_unlock_irqrestore(&p->pb->lock, flags);
1974 return rc;
1975}
1976
1977#endif /* CONFIG_ISDN_MPP */
1978
1979/*
1980 * network device ioctl handlers
1981 */
1982
1983static int
1984isdn_ppp_dev_ioctl_stats(int slot, struct ifreq *ifr, struct net_device *dev)
1985{
1986 struct ppp_stats __user *res = ifr->ifr_data;
1987 struct ppp_stats t;
Wang Chen838361f2008-12-03 15:49:46 -08001988 isdn_net_local *lp = (isdn_net_local *) netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001989
1990 if (!access_ok(VERIFY_WRITE, res, sizeof(struct ppp_stats)))
1991 return -EFAULT;
1992
1993 /* build a temporary stat struct and copy it to user space */
1994
1995 memset(&t, 0, sizeof(struct ppp_stats));
1996 if (dev->flags & IFF_UP) {
1997 t.p.ppp_ipackets = lp->stats.rx_packets;
1998 t.p.ppp_ibytes = lp->stats.rx_bytes;
1999 t.p.ppp_ierrors = lp->stats.rx_errors;
2000 t.p.ppp_opackets = lp->stats.tx_packets;
2001 t.p.ppp_obytes = lp->stats.tx_bytes;
2002 t.p.ppp_oerrors = lp->stats.tx_errors;
2003#ifdef CONFIG_ISDN_PPP_VJ
2004 if (slot >= 0 && ippp_table[slot]->slcomp) {
2005 struct slcompress *slcomp = ippp_table[slot]->slcomp;
2006 t.vj.vjs_packets = slcomp->sls_o_compressed + slcomp->sls_o_uncompressed;
2007 t.vj.vjs_compressed = slcomp->sls_o_compressed;
2008 t.vj.vjs_searches = slcomp->sls_o_searches;
2009 t.vj.vjs_misses = slcomp->sls_o_misses;
2010 t.vj.vjs_errorin = slcomp->sls_i_error;
2011 t.vj.vjs_tossed = slcomp->sls_i_tossed;
2012 t.vj.vjs_uncompressedin = slcomp->sls_i_uncompressed;
2013 t.vj.vjs_compressedin = slcomp->sls_i_compressed;
2014 }
2015#endif
2016 }
2017 if (copy_to_user(res, &t, sizeof(struct ppp_stats)))
2018 return -EFAULT;
2019 return 0;
2020}
2021
2022int
2023isdn_ppp_dev_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
2024{
2025 int error=0;
2026 int len;
Wang Chen838361f2008-12-03 15:49:46 -08002027 isdn_net_local *lp = (isdn_net_local *) netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002028
2029
2030 if (lp->p_encap != ISDN_NET_ENCAP_SYNCPPP)
2031 return -EINVAL;
2032
2033 switch (cmd) {
2034#define PPP_VERSION "2.3.7"
2035 case SIOCGPPPVER:
2036 len = strlen(PPP_VERSION) + 1;
2037 if (copy_to_user(ifr->ifr_data, PPP_VERSION, len))
2038 error = -EFAULT;
2039 break;
2040
2041 case SIOCGPPPSTATS:
2042 error = isdn_ppp_dev_ioctl_stats(lp->ppp_slot, ifr, dev);
2043 break;
2044 default:
2045 error = -EINVAL;
2046 break;
2047 }
2048 return error;
2049}
2050
2051static int
2052isdn_ppp_if_get_unit(char *name)
2053{
2054 int len,
2055 i,
2056 unit = 0,
2057 deci;
2058
2059 len = strlen(name);
2060
2061 if (strncmp("ippp", name, 4) || len > 8)
2062 return -1;
2063
2064 for (i = 0, deci = 1; i < len; i++, deci *= 10) {
2065 char a = name[len - i - 1];
2066 if (a >= '0' && a <= '9')
2067 unit += (a - '0') * deci;
2068 else
2069 break;
2070 }
2071 if (!i || len - i != 4)
2072 unit = -1;
2073
2074 return unit;
2075}
2076
2077
2078int
2079isdn_ppp_dial_slave(char *name)
2080{
2081#ifdef CONFIG_ISDN_MPP
2082 isdn_net_dev *ndev;
2083 isdn_net_local *lp;
2084 struct net_device *sdev;
2085
2086 if (!(ndev = isdn_net_findif(name)))
2087 return 1;
2088 lp = ndev->local;
2089 if (!(lp->flags & ISDN_NET_CONNECTED))
2090 return 5;
2091
2092 sdev = lp->slave;
2093 while (sdev) {
Wang Chen838361f2008-12-03 15:49:46 -08002094 isdn_net_local *mlp = (isdn_net_local *) netdev_priv(sdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002095 if (!(mlp->flags & ISDN_NET_CONNECTED))
2096 break;
2097 sdev = mlp->slave;
2098 }
2099 if (!sdev)
2100 return 2;
2101
Wang Chen838361f2008-12-03 15:49:46 -08002102 isdn_net_dial_req((isdn_net_local *) netdev_priv(sdev));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002103 return 0;
2104#else
2105 return -1;
2106#endif
2107}
2108
2109int
2110isdn_ppp_hangup_slave(char *name)
2111{
2112#ifdef CONFIG_ISDN_MPP
2113 isdn_net_dev *ndev;
2114 isdn_net_local *lp;
2115 struct net_device *sdev;
2116
2117 if (!(ndev = isdn_net_findif(name)))
2118 return 1;
2119 lp = ndev->local;
2120 if (!(lp->flags & ISDN_NET_CONNECTED))
2121 return 5;
2122
2123 sdev = lp->slave;
2124 while (sdev) {
Wang Chen838361f2008-12-03 15:49:46 -08002125 isdn_net_local *mlp = (isdn_net_local *) netdev_priv(sdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002126
2127 if (mlp->slave) { /* find last connected link in chain */
Wang Chen838361f2008-12-03 15:49:46 -08002128 isdn_net_local *nlp = ISDN_SLAVE_PRIV(mlp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002129
2130 if (!(nlp->flags & ISDN_NET_CONNECTED))
2131 break;
2132 } else if (mlp->flags & ISDN_NET_CONNECTED)
2133 break;
2134
2135 sdev = mlp->slave;
2136 }
2137 if (!sdev)
2138 return 2;
2139
2140 isdn_net_hangup(sdev);
2141 return 0;
2142#else
2143 return -1;
2144#endif
2145}
2146
2147/*
2148 * PPP compression stuff
2149 */
2150
2151
2152/* Push an empty CCP Data Frame up to the daemon to wake it up and let it
2153 generate a CCP Reset-Request or tear down CCP altogether */
2154
2155static void isdn_ppp_ccp_kickup(struct ippp_struct *is)
2156{
2157 isdn_ppp_fill_rq(NULL, 0, PPP_COMP, is->lp->ppp_slot);
2158}
2159
2160/* In-kernel handling of CCP Reset-Request and Reset-Ack is necessary,
2161 but absolutely nontrivial. The most abstruse problem we are facing is
2162 that the generation, reception and all the handling of timeouts and
2163 resends including proper request id management should be entirely left
2164 to the (de)compressor, but indeed is not covered by the current API to
2165 the (de)compressor. The API is a prototype version from PPP where only
2166 some (de)compressors have yet been implemented and all of them are
2167 rather simple in their reset handling. Especially, their is only one
2168 outstanding ResetAck at a time with all of them and ResetReq/-Acks do
2169 not have parameters. For this very special case it was sufficient to
2170 just return an error code from the decompressor and have a single
2171 reset() entry to communicate all the necessary information between
2172 the framework and the (de)compressor. Bad enough, LZS is different
2173 (and any other compressor may be different, too). It has multiple
2174 histories (eventually) and needs to Reset each of them independently
2175 and thus uses multiple outstanding Acks and history numbers as an
2176 additional parameter to Reqs/Acks.
2177 All that makes it harder to port the reset state engine into the
2178 kernel because it is not just the same simple one as in (i)pppd but
2179 it must be able to pass additional parameters and have multiple out-
2180 standing Acks. We are trying to achieve the impossible by handling
2181 reset transactions independent by their id. The id MUST change when
2182 the data portion changes, thus any (de)compressor who uses more than
2183 one resettable state must provide and recognize individual ids for
2184 each individual reset transaction. The framework itself does _only_
2185 differentiate them by id, because it has no other semantics like the
2186 (de)compressor might.
2187 This looks like a major redesign of the interface would be nice,
2188 but I don't have an idea how to do it better. */
2189
2190/* Send a CCP Reset-Request or Reset-Ack directly from the kernel. This is
2191 getting that lengthy because there is no simple "send-this-frame-out"
2192 function above but every wrapper does a bit different. Hope I guess
2193 correct in this hack... */
2194
2195static void isdn_ppp_ccp_xmit_reset(struct ippp_struct *is, int proto,
2196 unsigned char code, unsigned char id,
2197 unsigned char *data, int len)
2198{
2199 struct sk_buff *skb;
2200 unsigned char *p;
2201 int hl;
2202 int cnt = 0;
2203 isdn_net_local *lp = is->lp;
2204
2205 /* Alloc large enough skb */
2206 hl = dev->drv[lp->isdn_device]->interface->hl_hdrlen;
2207 skb = alloc_skb(len + hl + 16,GFP_ATOMIC);
2208 if(!skb) {
2209 printk(KERN_WARNING
2210 "ippp: CCP cannot send reset - out of memory\n");
2211 return;
2212 }
2213 skb_reserve(skb, hl);
2214
2215 /* We may need to stuff an address and control field first */
2216 if(!(is->pppcfg & SC_COMP_AC)) {
2217 p = skb_put(skb, 2);
2218 *p++ = 0xff;
2219 *p++ = 0x03;
2220 }
2221
2222 /* Stuff proto, code, id and length */
2223 p = skb_put(skb, 6);
2224 *p++ = (proto >> 8);
2225 *p++ = (proto & 0xff);
2226 *p++ = code;
2227 *p++ = id;
2228 cnt = 4 + len;
2229 *p++ = (cnt >> 8);
2230 *p++ = (cnt & 0xff);
2231
2232 /* Now stuff remaining bytes */
2233 if(len) {
2234 p = skb_put(skb, len);
2235 memcpy(p, data, len);
2236 }
2237
2238 /* skb is now ready for xmit */
2239 printk(KERN_DEBUG "Sending CCP Frame:\n");
2240 isdn_ppp_frame_log("ccp-xmit", skb->data, skb->len, 32, is->unit,lp->ppp_slot);
2241
2242 isdn_net_write_super(lp, skb);
2243}
2244
2245/* Allocate the reset state vector */
2246static struct ippp_ccp_reset *isdn_ppp_ccp_reset_alloc(struct ippp_struct *is)
2247{
2248 struct ippp_ccp_reset *r;
Burman Yan41f96932006-12-08 02:39:35 -08002249 r = kzalloc(sizeof(struct ippp_ccp_reset), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002250 if(!r) {
2251 printk(KERN_ERR "ippp_ccp: failed to allocate reset data"
2252 " structure - no mem\n");
2253 return NULL;
2254 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002255 printk(KERN_DEBUG "ippp_ccp: allocated reset data structure %p\n", r);
2256 is->reset = r;
2257 return r;
2258}
2259
2260/* Destroy the reset state vector. Kill all pending timers first. */
2261static void isdn_ppp_ccp_reset_free(struct ippp_struct *is)
2262{
2263 unsigned int id;
2264
2265 printk(KERN_DEBUG "ippp_ccp: freeing reset data structure %p\n",
2266 is->reset);
2267 for(id = 0; id < 256; id++) {
2268 if(is->reset->rs[id]) {
2269 isdn_ppp_ccp_reset_free_state(is, (unsigned char)id);
2270 }
2271 }
2272 kfree(is->reset);
2273 is->reset = NULL;
2274}
2275
2276/* Free a given state and clear everything up for later reallocation */
2277static void isdn_ppp_ccp_reset_free_state(struct ippp_struct *is,
2278 unsigned char id)
2279{
2280 struct ippp_ccp_reset_state *rs;
2281
2282 if(is->reset->rs[id]) {
2283 printk(KERN_DEBUG "ippp_ccp: freeing state for id %d\n", id);
2284 rs = is->reset->rs[id];
2285 /* Make sure the kernel will not call back later */
2286 if(rs->ta)
2287 del_timer(&rs->timer);
2288 is->reset->rs[id] = NULL;
2289 kfree(rs);
2290 } else {
2291 printk(KERN_WARNING "ippp_ccp: id %d is not allocated\n", id);
2292 }
2293}
2294
2295/* The timer callback function which is called when a ResetReq has timed out,
2296 aka has never been answered by a ResetAck */
2297static void isdn_ppp_ccp_timer_callback(unsigned long closure)
2298{
2299 struct ippp_ccp_reset_state *rs =
2300 (struct ippp_ccp_reset_state *)closure;
2301
2302 if(!rs) {
2303 printk(KERN_ERR "ippp_ccp: timer cb with zero closure.\n");
2304 return;
2305 }
2306 if(rs->ta && rs->state == CCPResetSentReq) {
2307 /* We are correct here */
2308 if(!rs->expra) {
2309 /* Hmm, there is no Ack really expected. We can clean
2310 up the state now, it will be reallocated if the
2311 decompressor insists on another reset */
2312 rs->ta = 0;
2313 isdn_ppp_ccp_reset_free_state(rs->is, rs->id);
2314 return;
2315 }
2316 printk(KERN_DEBUG "ippp_ccp: CCP Reset timed out for id %d\n",
2317 rs->id);
2318 /* Push it again */
2319 isdn_ppp_ccp_xmit_reset(rs->is, PPP_CCP, CCP_RESETREQ, rs->id,
2320 rs->data, rs->dlen);
2321 /* Restart timer */
2322 rs->timer.expires = jiffies + HZ*5;
2323 add_timer(&rs->timer);
2324 } else {
2325 printk(KERN_WARNING "ippp_ccp: timer cb in wrong state %d\n",
2326 rs->state);
2327 }
2328}
2329
2330/* Allocate a new reset transaction state */
2331static struct ippp_ccp_reset_state *isdn_ppp_ccp_reset_alloc_state(struct ippp_struct *is,
2332 unsigned char id)
2333{
2334 struct ippp_ccp_reset_state *rs;
2335 if(is->reset->rs[id]) {
2336 printk(KERN_WARNING "ippp_ccp: old state exists for id %d\n",
2337 id);
2338 return NULL;
2339 } else {
Burman Yan41f96932006-12-08 02:39:35 -08002340 rs = kzalloc(sizeof(struct ippp_ccp_reset_state), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002341 if(!rs)
2342 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002343 rs->state = CCPResetIdle;
2344 rs->is = is;
2345 rs->id = id;
Marcel Holtmanndab6df62006-12-21 23:06:24 +01002346 init_timer(&rs->timer);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002347 rs->timer.data = (unsigned long)rs;
2348 rs->timer.function = isdn_ppp_ccp_timer_callback;
2349 is->reset->rs[id] = rs;
2350 }
2351 return rs;
2352}
2353
2354
2355/* A decompressor wants a reset with a set of parameters - do what is
2356 necessary to fulfill it */
2357static void isdn_ppp_ccp_reset_trans(struct ippp_struct *is,
2358 struct isdn_ppp_resetparams *rp)
2359{
2360 struct ippp_ccp_reset_state *rs;
2361
2362 if(rp->valid) {
2363 /* The decompressor defines parameters by itself */
2364 if(rp->rsend) {
2365 /* And he wants us to send a request */
2366 if(!(rp->idval)) {
2367 printk(KERN_ERR "ippp_ccp: decompressor must"
2368 " specify reset id\n");
2369 return;
2370 }
2371 if(is->reset->rs[rp->id]) {
2372 /* There is already a transaction in existence
2373 for this id. May be still waiting for a
2374 Ack or may be wrong. */
2375 rs = is->reset->rs[rp->id];
2376 if(rs->state == CCPResetSentReq && rs->ta) {
2377 printk(KERN_DEBUG "ippp_ccp: reset"
2378 " trans still in progress"
2379 " for id %d\n", rp->id);
2380 } else {
2381 printk(KERN_WARNING "ippp_ccp: reset"
2382 " trans in wrong state %d for"
2383 " id %d\n", rs->state, rp->id);
2384 }
2385 } else {
2386 /* Ok, this is a new transaction */
2387 printk(KERN_DEBUG "ippp_ccp: new trans for id"
2388 " %d to be started\n", rp->id);
2389 rs = isdn_ppp_ccp_reset_alloc_state(is, rp->id);
2390 if(!rs) {
2391 printk(KERN_ERR "ippp_ccp: out of mem"
2392 " allocing ccp trans\n");
2393 return;
2394 }
2395 rs->state = CCPResetSentReq;
2396 rs->expra = rp->expra;
2397 if(rp->dtval) {
2398 rs->dlen = rp->dlen;
2399 memcpy(rs->data, rp->data, rp->dlen);
2400 }
2401 /* HACK TODO - add link comp here */
2402 isdn_ppp_ccp_xmit_reset(is, PPP_CCP,
2403 CCP_RESETREQ, rs->id,
2404 rs->data, rs->dlen);
2405 /* Start the timer */
2406 rs->timer.expires = jiffies + 5*HZ;
2407 add_timer(&rs->timer);
2408 rs->ta = 1;
2409 }
2410 } else {
2411 printk(KERN_DEBUG "ippp_ccp: no reset sent\n");
2412 }
2413 } else {
2414 /* The reset params are invalid. The decompressor does not
2415 care about them, so we just send the minimal requests
2416 and increase ids only when an Ack is received for a
2417 given id */
2418 if(is->reset->rs[is->reset->lastid]) {
2419 /* There is already a transaction in existence
2420 for this id. May be still waiting for a
2421 Ack or may be wrong. */
2422 rs = is->reset->rs[is->reset->lastid];
2423 if(rs->state == CCPResetSentReq && rs->ta) {
2424 printk(KERN_DEBUG "ippp_ccp: reset"
2425 " trans still in progress"
2426 " for id %d\n", rp->id);
2427 } else {
2428 printk(KERN_WARNING "ippp_ccp: reset"
2429 " trans in wrong state %d for"
2430 " id %d\n", rs->state, rp->id);
2431 }
2432 } else {
2433 printk(KERN_DEBUG "ippp_ccp: new trans for id"
2434 " %d to be started\n", is->reset->lastid);
2435 rs = isdn_ppp_ccp_reset_alloc_state(is,
2436 is->reset->lastid);
2437 if(!rs) {
2438 printk(KERN_ERR "ippp_ccp: out of mem"
2439 " allocing ccp trans\n");
2440 return;
2441 }
2442 rs->state = CCPResetSentReq;
2443 /* We always expect an Ack if the decompressor doesn't
2444 know better */
2445 rs->expra = 1;
2446 rs->dlen = 0;
2447 /* HACK TODO - add link comp here */
2448 isdn_ppp_ccp_xmit_reset(is, PPP_CCP, CCP_RESETREQ,
2449 rs->id, NULL, 0);
2450 /* Start the timer */
2451 rs->timer.expires = jiffies + 5*HZ;
2452 add_timer(&rs->timer);
2453 rs->ta = 1;
2454 }
2455 }
2456}
2457
2458/* An Ack was received for this id. This means we stop the timer and clean
2459 up the state prior to calling the decompressors reset routine. */
2460static void isdn_ppp_ccp_reset_ack_rcvd(struct ippp_struct *is,
2461 unsigned char id)
2462{
2463 struct ippp_ccp_reset_state *rs = is->reset->rs[id];
2464
2465 if(rs) {
2466 if(rs->ta && rs->state == CCPResetSentReq) {
2467 /* Great, we are correct */
2468 if(!rs->expra)
2469 printk(KERN_DEBUG "ippp_ccp: ResetAck received"
2470 " for id %d but not expected\n", id);
2471 } else {
2472 printk(KERN_INFO "ippp_ccp: ResetAck received out of"
2473 "sync for id %d\n", id);
2474 }
2475 if(rs->ta) {
2476 rs->ta = 0;
2477 del_timer(&rs->timer);
2478 }
2479 isdn_ppp_ccp_reset_free_state(is, id);
2480 } else {
2481 printk(KERN_INFO "ippp_ccp: ResetAck received for unknown id"
2482 " %d\n", id);
2483 }
2484 /* Make sure the simple reset stuff uses a new id next time */
2485 is->reset->lastid++;
2486}
2487
2488/*
2489 * decompress packet
2490 *
2491 * if master = 0, we're trying to uncompress an per-link compressed packet,
2492 * as opposed to an compressed reconstructed-from-MPPP packet.
2493 * proto is updated to protocol field of uncompressed packet.
2494 *
2495 * retval: decompressed packet,
2496 * same packet if uncompressed,
2497 * NULL if decompression error
2498 */
2499
2500static struct sk_buff *isdn_ppp_decompress(struct sk_buff *skb,struct ippp_struct *is,struct ippp_struct *master,
2501 int *proto)
2502{
2503 void *stat = NULL;
2504 struct isdn_ppp_compressor *ipc = NULL;
2505 struct sk_buff *skb_out;
2506 int len;
2507 struct ippp_struct *ri;
2508 struct isdn_ppp_resetparams rsparm;
2509 unsigned char rsdata[IPPP_RESET_MAXDATABYTES];
2510
2511 if(!master) {
2512 // per-link decompression
2513 stat = is->link_decomp_stat;
2514 ipc = is->link_decompressor;
2515 ri = is;
2516 } else {
2517 stat = master->decomp_stat;
2518 ipc = master->decompressor;
2519 ri = master;
2520 }
2521
2522 if (!ipc) {
2523 // no decompressor -> we can't decompress.
2524 printk(KERN_DEBUG "ippp: no decompressor defined!\n");
2525 return skb;
2526 }
Eric Sesterhenn6dd44a72006-03-26 18:19:26 +02002527 BUG_ON(!stat); // if we have a compressor, stat has been set as well
Linus Torvalds1da177e2005-04-16 15:20:36 -07002528
2529 if((master && *proto == PPP_COMP) || (!master && *proto == PPP_COMPFRAG) ) {
2530 // compressed packets are compressed by their protocol type
2531
2532 // Set up reset params for the decompressor
2533 memset(&rsparm, 0, sizeof(rsparm));
2534 rsparm.data = rsdata;
2535 rsparm.maxdlen = IPPP_RESET_MAXDATABYTES;
2536
2537 skb_out = dev_alloc_skb(is->mru + PPP_HDRLEN);
Jesper Juhlf6e2cdc2006-12-08 02:39:34 -08002538 if (!skb_out) {
2539 kfree_skb(skb);
2540 printk(KERN_ERR "ippp: decomp memory allocation failure\n");
2541 return NULL;
2542 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002543 len = ipc->decompress(stat, skb, skb_out, &rsparm);
2544 kfree_skb(skb);
2545 if (len <= 0) {
2546 switch(len) {
2547 case DECOMP_ERROR:
2548 printk(KERN_INFO "ippp: decomp wants reset %s params\n",
2549 rsparm.valid ? "with" : "without");
2550
2551 isdn_ppp_ccp_reset_trans(ri, &rsparm);
2552 break;
2553 case DECOMP_FATALERROR:
2554 ri->pppcfg |= SC_DC_FERROR;
2555 /* Kick ipppd to recognize the error */
2556 isdn_ppp_ccp_kickup(ri);
2557 break;
2558 }
2559 kfree_skb(skb_out);
2560 return NULL;
2561 }
2562 *proto = isdn_ppp_strip_proto(skb_out);
2563 if (*proto < 0) {
2564 kfree_skb(skb_out);
2565 return NULL;
2566 }
2567 return skb_out;
2568 } else {
2569 // uncompressed packets are fed through the decompressor to
2570 // update the decompressor state
2571 ipc->incomp(stat, skb, *proto);
2572 return skb;
2573 }
2574}
2575
2576/*
2577 * compress a frame
2578 * type=0: normal/bundle compression
2579 * =1: link compression
2580 * returns original skb if we haven't compressed the frame
2581 * and a new skb pointer if we've done it
2582 */
2583static struct sk_buff *isdn_ppp_compress(struct sk_buff *skb_in,int *proto,
2584 struct ippp_struct *is,struct ippp_struct *master,int type)
2585{
2586 int ret;
2587 int new_proto;
2588 struct isdn_ppp_compressor *compressor;
2589 void *stat;
2590 struct sk_buff *skb_out;
2591
2592 /* we do not compress control protocols */
2593 if(*proto < 0 || *proto > 0x3fff) {
2594 return skb_in;
2595 }
2596
2597 if(type) { /* type=1 => Link compression */
2598 return skb_in;
2599 }
2600 else {
2601 if(!master) {
2602 compressor = is->compressor;
2603 stat = is->comp_stat;
2604 }
2605 else {
2606 compressor = master->compressor;
2607 stat = master->comp_stat;
2608 }
2609 new_proto = PPP_COMP;
2610 }
2611
2612 if(!compressor) {
2613 printk(KERN_ERR "isdn_ppp: No compressor set!\n");
2614 return skb_in;
2615 }
2616 if(!stat) {
2617 printk(KERN_ERR "isdn_ppp: Compressor not initialized?\n");
2618 return skb_in;
2619 }
2620
2621 /* Allow for at least 150 % expansion (for now) */
2622 skb_out = alloc_skb(skb_in->len + skb_in->len/2 + 32 +
2623 skb_headroom(skb_in), GFP_ATOMIC);
2624 if(!skb_out)
2625 return skb_in;
2626 skb_reserve(skb_out, skb_headroom(skb_in));
2627
2628 ret = (compressor->compress)(stat,skb_in,skb_out,*proto);
2629 if(!ret) {
2630 dev_kfree_skb(skb_out);
2631 return skb_in;
2632 }
2633
2634 dev_kfree_skb(skb_in);
2635 *proto = new_proto;
2636 return skb_out;
2637}
2638
2639/*
2640 * we received a CCP frame ..
2641 * not a clean solution, but we MUST handle a few cases in the kernel
2642 */
2643static void isdn_ppp_receive_ccp(isdn_net_dev *net_dev, isdn_net_local *lp,
2644 struct sk_buff *skb,int proto)
2645{
2646 struct ippp_struct *is;
2647 struct ippp_struct *mis;
2648 int len;
2649 struct isdn_ppp_resetparams rsparm;
2650 unsigned char rsdata[IPPP_RESET_MAXDATABYTES];
2651
2652 printk(KERN_DEBUG "Received CCP frame from peer slot(%d)\n",
2653 lp->ppp_slot);
Eric Sesterhenn052bb882006-04-11 17:29:17 -07002654 if (lp->ppp_slot < 0 || lp->ppp_slot >= ISDN_MAX_CHANNELS) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002655 printk(KERN_ERR "%s: lp->ppp_slot(%d) out of range\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -07002656 __func__, lp->ppp_slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002657 return;
2658 }
2659 is = ippp_table[lp->ppp_slot];
2660 isdn_ppp_frame_log("ccp-rcv", skb->data, skb->len, 32, is->unit,lp->ppp_slot);
2661
2662 if(lp->master) {
Wang Chen838361f2008-12-03 15:49:46 -08002663 int slot = ISDN_MASTER_PRIV(lp)->ppp_slot;
Eric Sesterhenn052bb882006-04-11 17:29:17 -07002664 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002665 printk(KERN_ERR "%s: slot(%d) out of range\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -07002666 __func__, slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002667 return;
2668 }
2669 mis = ippp_table[slot];
2670 } else
2671 mis = is;
2672
2673 switch(skb->data[0]) {
2674 case CCP_CONFREQ:
2675 if(is->debug & 0x10)
2676 printk(KERN_DEBUG "Disable compression here!\n");
2677 if(proto == PPP_CCP)
2678 mis->compflags &= ~SC_COMP_ON;
2679 else
2680 is->compflags &= ~SC_LINK_COMP_ON;
2681 break;
2682 case CCP_TERMREQ:
2683 case CCP_TERMACK:
2684 if(is->debug & 0x10)
2685 printk(KERN_DEBUG "Disable (de)compression here!\n");
2686 if(proto == PPP_CCP)
2687 mis->compflags &= ~(SC_DECOMP_ON|SC_COMP_ON);
2688 else
2689 is->compflags &= ~(SC_LINK_DECOMP_ON|SC_LINK_COMP_ON);
2690 break;
2691 case CCP_CONFACK:
2692 /* if we RECEIVE an ackowledge we enable the decompressor */
2693 if(is->debug & 0x10)
2694 printk(KERN_DEBUG "Enable decompression here!\n");
2695 if(proto == PPP_CCP) {
2696 if (!mis->decompressor)
2697 break;
2698 mis->compflags |= SC_DECOMP_ON;
2699 } else {
2700 if (!is->decompressor)
2701 break;
2702 is->compflags |= SC_LINK_DECOMP_ON;
2703 }
2704 break;
2705
2706 case CCP_RESETACK:
2707 printk(KERN_DEBUG "Received ResetAck from peer\n");
2708 len = (skb->data[2] << 8) | skb->data[3];
2709 len -= 4;
2710
2711 if(proto == PPP_CCP) {
2712 /* If a reset Ack was outstanding for this id, then
2713 clean up the state engine */
2714 isdn_ppp_ccp_reset_ack_rcvd(mis, skb->data[1]);
2715 if(mis->decompressor && mis->decomp_stat)
2716 mis->decompressor->
2717 reset(mis->decomp_stat,
2718 skb->data[0],
2719 skb->data[1],
2720 len ? &skb->data[4] : NULL,
2721 len, NULL);
2722 /* TODO: This is not easy to decide here */
2723 mis->compflags &= ~SC_DECOMP_DISCARD;
2724 }
2725 else {
2726 isdn_ppp_ccp_reset_ack_rcvd(is, skb->data[1]);
2727 if(is->link_decompressor && is->link_decomp_stat)
2728 is->link_decompressor->
2729 reset(is->link_decomp_stat,
2730 skb->data[0],
2731 skb->data[1],
2732 len ? &skb->data[4] : NULL,
2733 len, NULL);
2734 /* TODO: neither here */
2735 is->compflags &= ~SC_LINK_DECOMP_DISCARD;
2736 }
2737 break;
2738
2739 case CCP_RESETREQ:
2740 printk(KERN_DEBUG "Received ResetReq from peer\n");
2741 /* Receiving a ResetReq means we must reset our compressor */
2742 /* Set up reset params for the reset entry */
2743 memset(&rsparm, 0, sizeof(rsparm));
2744 rsparm.data = rsdata;
2745 rsparm.maxdlen = IPPP_RESET_MAXDATABYTES;
2746 /* Isolate data length */
2747 len = (skb->data[2] << 8) | skb->data[3];
2748 len -= 4;
2749 if(proto == PPP_CCP) {
2750 if(mis->compressor && mis->comp_stat)
2751 mis->compressor->
2752 reset(mis->comp_stat,
2753 skb->data[0],
2754 skb->data[1],
2755 len ? &skb->data[4] : NULL,
2756 len, &rsparm);
2757 }
2758 else {
2759 if(is->link_compressor && is->link_comp_stat)
2760 is->link_compressor->
2761 reset(is->link_comp_stat,
2762 skb->data[0],
2763 skb->data[1],
2764 len ? &skb->data[4] : NULL,
2765 len, &rsparm);
2766 }
2767 /* Ack the Req as specified by rsparm */
2768 if(rsparm.valid) {
2769 /* Compressor reset handler decided how to answer */
2770 if(rsparm.rsend) {
2771 /* We should send a Frame */
2772 isdn_ppp_ccp_xmit_reset(is, proto, CCP_RESETACK,
2773 rsparm.idval ? rsparm.id
2774 : skb->data[1],
2775 rsparm.dtval ?
2776 rsparm.data : NULL,
2777 rsparm.dtval ?
2778 rsparm.dlen : 0);
2779 } else {
2780 printk(KERN_DEBUG "ResetAck suppressed\n");
2781 }
2782 } else {
2783 /* We answer with a straight reflected Ack */
2784 isdn_ppp_ccp_xmit_reset(is, proto, CCP_RESETACK,
2785 skb->data[1],
2786 len ? &skb->data[4] : NULL,
2787 len);
2788 }
2789 break;
2790 }
2791}
2792
2793
2794/*
2795 * Daemon sends a CCP frame ...
2796 */
2797
2798/* TODO: Clean this up with new Reset semantics */
2799
2800/* I believe the CCP handling as-is is done wrong. Compressed frames
2801 * should only be sent/received after CCP reaches UP state, which means
2802 * both sides have sent CONF_ACK. Currently, we handle both directions
2803 * independently, which means we may accept compressed frames too early
2804 * (supposedly not a problem), but may also mean we send compressed frames
2805 * too early, which may turn out to be a problem.
2806 * This part of state machine should actually be handled by (i)pppd, but
2807 * that's too big of a change now. --kai
2808 */
2809
2810/* Actually, we might turn this into an advantage: deal with the RFC in
2811 * the old tradition of beeing generous on what we accept, but beeing
2812 * strict on what we send. Thus we should just
2813 * - accept compressed frames as soon as decompression is negotiated
2814 * - send compressed frames only when decomp *and* comp are negotiated
2815 * - drop rx compressed frames if we cannot decomp (instead of pushing them
2816 * up to ipppd)
2817 * and I tried to modify this file according to that. --abp
2818 */
2819
2820static void isdn_ppp_send_ccp(isdn_net_dev *net_dev, isdn_net_local *lp, struct sk_buff *skb)
2821{
2822 struct ippp_struct *mis,*is;
2823 int proto, slot = lp->ppp_slot;
2824 unsigned char *data;
2825
2826 if(!skb || skb->len < 3)
2827 return;
2828 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
2829 printk(KERN_ERR "%s: lp->ppp_slot(%d) out of range\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -07002830 __func__, slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002831 return;
2832 }
2833 is = ippp_table[slot];
2834 /* Daemon may send with or without address and control field comp */
2835 data = skb->data;
2836 if(!(is->pppcfg & SC_COMP_AC) && data[0] == 0xff && data[1] == 0x03) {
2837 data += 2;
2838 if(skb->len < 5)
2839 return;
2840 }
2841
2842 proto = ((int)data[0]<<8)+data[1];
2843 if(proto != PPP_CCP && proto != PPP_CCPFRAG)
2844 return;
2845
2846 printk(KERN_DEBUG "Received CCP frame from daemon:\n");
2847 isdn_ppp_frame_log("ccp-xmit", skb->data, skb->len, 32, is->unit,lp->ppp_slot);
2848
2849 if (lp->master) {
Wang Chen838361f2008-12-03 15:49:46 -08002850 slot = ISDN_MASTER_PRIV(lp)->ppp_slot;
Eric Sesterhenn052bb882006-04-11 17:29:17 -07002851 if (slot < 0 || slot >= ISDN_MAX_CHANNELS) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002852 printk(KERN_ERR "%s: slot(%d) out of range\n",
Harvey Harrison156f1ed2008-04-28 02:14:40 -07002853 __func__, slot);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002854 return;
2855 }
2856 mis = ippp_table[slot];
2857 } else
2858 mis = is;
2859 if (mis != is)
2860 printk(KERN_DEBUG "isdn_ppp: Ouch! Master CCP sends on slave slot!\n");
2861
2862 switch(data[2]) {
2863 case CCP_CONFREQ:
2864 if(is->debug & 0x10)
2865 printk(KERN_DEBUG "Disable decompression here!\n");
2866 if(proto == PPP_CCP)
2867 is->compflags &= ~SC_DECOMP_ON;
2868 else
2869 is->compflags &= ~SC_LINK_DECOMP_ON;
2870 break;
2871 case CCP_TERMREQ:
2872 case CCP_TERMACK:
2873 if(is->debug & 0x10)
2874 printk(KERN_DEBUG "Disable (de)compression here!\n");
2875 if(proto == PPP_CCP)
2876 is->compflags &= ~(SC_DECOMP_ON|SC_COMP_ON);
2877 else
2878 is->compflags &= ~(SC_LINK_DECOMP_ON|SC_LINK_COMP_ON);
2879 break;
2880 case CCP_CONFACK:
2881 /* if we SEND an ackowledge we can/must enable the compressor */
2882 if(is->debug & 0x10)
2883 printk(KERN_DEBUG "Enable compression here!\n");
2884 if(proto == PPP_CCP) {
2885 if (!is->compressor)
2886 break;
2887 is->compflags |= SC_COMP_ON;
2888 } else {
2889 if (!is->compressor)
2890 break;
2891 is->compflags |= SC_LINK_COMP_ON;
2892 }
2893 break;
2894 case CCP_RESETACK:
2895 /* If we send a ACK we should reset our compressor */
2896 if(is->debug & 0x10)
2897 printk(KERN_DEBUG "Reset decompression state here!\n");
2898 printk(KERN_DEBUG "ResetAck from daemon passed by\n");
2899 if(proto == PPP_CCP) {
2900 /* link to master? */
2901 if(is->compressor && is->comp_stat)
2902 is->compressor->reset(is->comp_stat, 0, 0,
2903 NULL, 0, NULL);
2904 is->compflags &= ~SC_COMP_DISCARD;
2905 }
2906 else {
2907 if(is->link_compressor && is->link_comp_stat)
2908 is->link_compressor->reset(is->link_comp_stat,
2909 0, 0, NULL, 0, NULL);
2910 is->compflags &= ~SC_LINK_COMP_DISCARD;
2911 }
2912 break;
2913 case CCP_RESETREQ:
2914 /* Just let it pass by */
2915 printk(KERN_DEBUG "ResetReq from daemon passed by\n");
2916 break;
2917 }
2918}
2919
2920int isdn_ppp_register_compressor(struct isdn_ppp_compressor *ipc)
2921{
2922 ipc->next = ipc_head;
2923 ipc->prev = NULL;
2924 if(ipc_head) {
2925 ipc_head->prev = ipc;
2926 }
2927 ipc_head = ipc;
2928 return 0;
2929}
2930
2931int isdn_ppp_unregister_compressor(struct isdn_ppp_compressor *ipc)
2932{
2933 if(ipc->prev)
2934 ipc->prev->next = ipc->next;
2935 else
2936 ipc_head = ipc->next;
2937 if(ipc->next)
2938 ipc->next->prev = ipc->prev;
2939 ipc->prev = ipc->next = NULL;
2940 return 0;
2941}
2942
2943static int isdn_ppp_set_compressor(struct ippp_struct *is, struct isdn_ppp_comp_data *data)
2944{
2945 struct isdn_ppp_compressor *ipc = ipc_head;
2946 int ret;
2947 void *stat;
2948 int num = data->num;
2949
2950 if(is->debug & 0x10)
2951 printk(KERN_DEBUG "[%d] Set %s type %d\n",is->unit,
2952 (data->flags&IPPP_COMP_FLAG_XMIT)?"compressor":"decompressor",num);
2953
2954 /* If is has no valid reset state vector, we cannot allocate a
2955 decompressor. The decompressor would cause reset transactions
2956 sooner or later, and they need that vector. */
2957
2958 if(!(data->flags & IPPP_COMP_FLAG_XMIT) && !is->reset) {
2959 printk(KERN_ERR "ippp_ccp: no reset data structure - can't"
2960 " allow decompression.\n");
2961 return -ENOMEM;
2962 }
2963
2964 while(ipc) {
2965 if(ipc->num == num) {
2966 stat = ipc->alloc(data);
2967 if(stat) {
2968 ret = ipc->init(stat,data,is->unit,0);
2969 if(!ret) {
2970 printk(KERN_ERR "Can't init (de)compression!\n");
2971 ipc->free(stat);
2972 stat = NULL;
2973 break;
2974 }
2975 }
2976 else {
2977 printk(KERN_ERR "Can't alloc (de)compression!\n");
2978 break;
2979 }
2980
2981 if(data->flags & IPPP_COMP_FLAG_XMIT) {
2982 if(data->flags & IPPP_COMP_FLAG_LINK) {
2983 if(is->link_comp_stat)
2984 is->link_compressor->free(is->link_comp_stat);
2985 is->link_comp_stat = stat;
2986 is->link_compressor = ipc;
2987 }
2988 else {
2989 if(is->comp_stat)
2990 is->compressor->free(is->comp_stat);
2991 is->comp_stat = stat;
2992 is->compressor = ipc;
2993 }
2994 }
2995 else {
2996 if(data->flags & IPPP_COMP_FLAG_LINK) {
2997 if(is->link_decomp_stat)
2998 is->link_decompressor->free(is->link_decomp_stat);
2999 is->link_decomp_stat = stat;
3000 is->link_decompressor = ipc;
3001 }
3002 else {
3003 if(is->decomp_stat)
3004 is->decompressor->free(is->decomp_stat);
3005 is->decomp_stat = stat;
3006 is->decompressor = ipc;
3007 }
3008 }
3009 return 0;
3010 }
3011 ipc = ipc->next;
3012 }
3013 return -EINVAL;
3014}