xref: /openbmc/linux/drivers/net/ppp/ppp_synctty.c (revision a8d9cd23)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * PPP synchronous tty channel driver for Linux.
4  *
5  * This is a ppp channel driver that can be used with tty device drivers
6  * that are frame oriented, such as synchronous HDLC devices.
7  *
8  * Complete PPP frames without encoding/decoding are exchanged between
9  * the channel driver and the device driver.
10  *
11  * The async map IOCTL codes are implemented to keep the user mode
12  * applications happy if they call them. Synchronous PPP does not use
13  * the async maps.
14  *
15  * Copyright 1999 Paul Mackerras.
16  *
17  * Also touched by the grubby hands of Paul Fulghum paulkf@microgate.com
18  *
19  * This driver provides the encapsulation and framing for sending
20  * and receiving PPP frames over sync serial lines.  It relies on
21  * the generic PPP layer to give it frames to send and to process
22  * received frames.  It implements the PPP line discipline.
23  *
24  * Part of the code in this driver was inspired by the old async-only
25  * PPP driver, written by Michael Callahan and Al Longyear, and
26  * subsequently hacked by Paul Mackerras.
27  *
28  * ==FILEVERSION 20040616==
29  */
30 
31 #include <linux/module.h>
32 #include <linux/kernel.h>
33 #include <linux/skbuff.h>
34 #include <linux/tty.h>
35 #include <linux/netdevice.h>
36 #include <linux/poll.h>
37 #include <linux/ppp_defs.h>
38 #include <linux/ppp-ioctl.h>
39 #include <linux/ppp_channel.h>
40 #include <linux/spinlock.h>
41 #include <linux/completion.h>
42 #include <linux/init.h>
43 #include <linux/interrupt.h>
44 #include <linux/slab.h>
45 #include <linux/refcount.h>
46 #include <asm/unaligned.h>
47 #include <linux/uaccess.h>
48 
49 #define PPP_VERSION	"2.4.2"
50 
51 /* Structure for storing local state. */
52 struct syncppp {
53 	struct tty_struct *tty;
54 	unsigned int	flags;
55 	unsigned int	rbits;
56 	int		mru;
57 	spinlock_t	xmit_lock;
58 	spinlock_t	recv_lock;
59 	unsigned long	xmit_flags;
60 	u32		xaccm[8];
61 	u32		raccm;
62 	unsigned int	bytes_sent;
63 	unsigned int	bytes_rcvd;
64 
65 	struct sk_buff	*tpkt;
66 	unsigned long	last_xmit;
67 
68 	struct sk_buff_head rqueue;
69 
70 	struct tasklet_struct tsk;
71 
72 	refcount_t	refcnt;
73 	struct completion dead_cmp;
74 	struct ppp_channel chan;	/* interface to generic ppp layer */
75 };
76 
77 /* Bit numbers in xmit_flags */
78 #define XMIT_WAKEUP	0
79 #define XMIT_FULL	1
80 
81 /* Bits in rbits */
82 #define SC_RCV_BITS	(SC_RCV_B7_1|SC_RCV_B7_0|SC_RCV_ODDP|SC_RCV_EVNP)
83 
84 #define PPPSYNC_MAX_RQLEN	32	/* arbitrary */
85 
86 /*
87  * Prototypes.
88  */
89 static struct sk_buff* ppp_sync_txmunge(struct syncppp *ap, struct sk_buff *);
90 static int ppp_sync_send(struct ppp_channel *chan, struct sk_buff *skb);
91 static int ppp_sync_ioctl(struct ppp_channel *chan, unsigned int cmd,
92 			  unsigned long arg);
93 static void ppp_sync_process(struct tasklet_struct *t);
94 static int ppp_sync_push(struct syncppp *ap);
95 static void ppp_sync_flush_output(struct syncppp *ap);
96 static void ppp_sync_input(struct syncppp *ap, const u8 *buf, const char *flags,
97 			   int count);
98 
99 static const struct ppp_channel_ops sync_ops = {
100 	.start_xmit = ppp_sync_send,
101 	.ioctl      = ppp_sync_ioctl,
102 };
103 
104 /*
105  * Utility procedure to print a buffer in hex/ascii
106  */
107 static void
108 ppp_print_buffer (const char *name, const __u8 *buf, int count)
109 {
110 	if (name != NULL)
111 		printk(KERN_DEBUG "ppp_synctty: %s, count = %d\n", name, count);
112 
113 	print_hex_dump_bytes("", DUMP_PREFIX_NONE, buf, count);
114 }
115 
116 
117 /*
118  * Routines implementing the synchronous PPP line discipline.
119  */
120 
121 /*
122  * We have a potential race on dereferencing tty->disc_data,
123  * because the tty layer provides no locking at all - thus one
124  * cpu could be running ppp_synctty_receive while another
125  * calls ppp_synctty_close, which zeroes tty->disc_data and
126  * frees the memory that ppp_synctty_receive is using.  The best
127  * way to fix this is to use a rwlock in the tty struct, but for now
128  * we use a single global rwlock for all ttys in ppp line discipline.
129  *
130  * FIXME: Fixed in tty_io nowadays.
131  */
132 static DEFINE_RWLOCK(disc_data_lock);
133 
134 static struct syncppp *sp_get(struct tty_struct *tty)
135 {
136 	struct syncppp *ap;
137 
138 	read_lock(&disc_data_lock);
139 	ap = tty->disc_data;
140 	if (ap != NULL)
141 		refcount_inc(&ap->refcnt);
142 	read_unlock(&disc_data_lock);
143 	return ap;
144 }
145 
146 static void sp_put(struct syncppp *ap)
147 {
148 	if (refcount_dec_and_test(&ap->refcnt))
149 		complete(&ap->dead_cmp);
150 }
151 
152 /*
153  * Called when a tty is put into sync-PPP line discipline.
154  */
155 static int
156 ppp_sync_open(struct tty_struct *tty)
157 {
158 	struct syncppp *ap;
159 	int err;
160 	int speed;
161 
162 	if (tty->ops->write == NULL)
163 		return -EOPNOTSUPP;
164 
165 	ap = kzalloc(sizeof(*ap), GFP_KERNEL);
166 	err = -ENOMEM;
167 	if (!ap)
168 		goto out;
169 
170 	/* initialize the syncppp structure */
171 	ap->tty = tty;
172 	ap->mru = PPP_MRU;
173 	spin_lock_init(&ap->xmit_lock);
174 	spin_lock_init(&ap->recv_lock);
175 	ap->xaccm[0] = ~0U;
176 	ap->xaccm[3] = 0x60000000U;
177 	ap->raccm = ~0U;
178 
179 	skb_queue_head_init(&ap->rqueue);
180 	tasklet_setup(&ap->tsk, ppp_sync_process);
181 
182 	refcount_set(&ap->refcnt, 1);
183 	init_completion(&ap->dead_cmp);
184 
185 	ap->chan.private = ap;
186 	ap->chan.ops = &sync_ops;
187 	ap->chan.mtu = PPP_MRU;
188 	ap->chan.hdrlen = 2;	/* for A/C bytes */
189 	speed = tty_get_baud_rate(tty);
190 	ap->chan.speed = speed;
191 	err = ppp_register_channel(&ap->chan);
192 	if (err)
193 		goto out_free;
194 
195 	tty->disc_data = ap;
196 	tty->receive_room = 65536;
197 	return 0;
198 
199  out_free:
200 	kfree(ap);
201  out:
202 	return err;
203 }
204 
205 /*
206  * Called when the tty is put into another line discipline
207  * or it hangs up.  We have to wait for any cpu currently
208  * executing in any of the other ppp_synctty_* routines to
209  * finish before we can call ppp_unregister_channel and free
210  * the syncppp struct.  This routine must be called from
211  * process context, not interrupt or softirq context.
212  */
213 static void
214 ppp_sync_close(struct tty_struct *tty)
215 {
216 	struct syncppp *ap;
217 
218 	write_lock_irq(&disc_data_lock);
219 	ap = tty->disc_data;
220 	tty->disc_data = NULL;
221 	write_unlock_irq(&disc_data_lock);
222 	if (!ap)
223 		return;
224 
225 	/*
226 	 * We have now ensured that nobody can start using ap from now
227 	 * on, but we have to wait for all existing users to finish.
228 	 * Note that ppp_unregister_channel ensures that no calls to
229 	 * our channel ops (i.e. ppp_sync_send/ioctl) are in progress
230 	 * by the time it returns.
231 	 */
232 	if (!refcount_dec_and_test(&ap->refcnt))
233 		wait_for_completion(&ap->dead_cmp);
234 	tasklet_kill(&ap->tsk);
235 
236 	ppp_unregister_channel(&ap->chan);
237 	skb_queue_purge(&ap->rqueue);
238 	kfree_skb(ap->tpkt);
239 	kfree(ap);
240 }
241 
242 /*
243  * Called on tty hangup in process context.
244  *
245  * Wait for I/O to driver to complete and unregister PPP channel.
246  * This is already done by the close routine, so just call that.
247  */
248 static void ppp_sync_hangup(struct tty_struct *tty)
249 {
250 	ppp_sync_close(tty);
251 }
252 
253 /*
254  * Read does nothing - no data is ever available this way.
255  * Pppd reads and writes packets via /dev/ppp instead.
256  */
257 static ssize_t
258 ppp_sync_read(struct tty_struct *tty, struct file *file,
259 	      unsigned char *buf, size_t count,
260 	      void **cookie, unsigned long offset)
261 {
262 	return -EAGAIN;
263 }
264 
265 /*
266  * Write on the tty does nothing, the packets all come in
267  * from the ppp generic stuff.
268  */
269 static ssize_t
270 ppp_sync_write(struct tty_struct *tty, struct file *file,
271 		const unsigned char *buf, size_t count)
272 {
273 	return -EAGAIN;
274 }
275 
276 static int
277 ppp_synctty_ioctl(struct tty_struct *tty, unsigned int cmd, unsigned long arg)
278 {
279 	struct syncppp *ap = sp_get(tty);
280 	int __user *p = (int __user *)arg;
281 	int err, val;
282 
283 	if (!ap)
284 		return -ENXIO;
285 	err = -EFAULT;
286 	switch (cmd) {
287 	case PPPIOCGCHAN:
288 		err = -EFAULT;
289 		if (put_user(ppp_channel_index(&ap->chan), p))
290 			break;
291 		err = 0;
292 		break;
293 
294 	case PPPIOCGUNIT:
295 		err = -EFAULT;
296 		if (put_user(ppp_unit_number(&ap->chan), p))
297 			break;
298 		err = 0;
299 		break;
300 
301 	case TCFLSH:
302 		/* flush our buffers and the serial port's buffer */
303 		if (arg == TCIOFLUSH || arg == TCOFLUSH)
304 			ppp_sync_flush_output(ap);
305 		err = n_tty_ioctl_helper(tty, cmd, arg);
306 		break;
307 
308 	case FIONREAD:
309 		val = 0;
310 		if (put_user(val, p))
311 			break;
312 		err = 0;
313 		break;
314 
315 	default:
316 		err = tty_mode_ioctl(tty, cmd, arg);
317 		break;
318 	}
319 
320 	sp_put(ap);
321 	return err;
322 }
323 
324 /* May sleep, don't call from interrupt level or with interrupts disabled */
325 static void
326 ppp_sync_receive(struct tty_struct *tty, const u8 *buf, const char *cflags,
327 		 size_t count)
328 {
329 	struct syncppp *ap = sp_get(tty);
330 	unsigned long flags;
331 
332 	if (!ap)
333 		return;
334 	spin_lock_irqsave(&ap->recv_lock, flags);
335 	ppp_sync_input(ap, buf, cflags, count);
336 	spin_unlock_irqrestore(&ap->recv_lock, flags);
337 	if (!skb_queue_empty(&ap->rqueue))
338 		tasklet_schedule(&ap->tsk);
339 	sp_put(ap);
340 	tty_unthrottle(tty);
341 }
342 
343 static void
344 ppp_sync_wakeup(struct tty_struct *tty)
345 {
346 	struct syncppp *ap = sp_get(tty);
347 
348 	clear_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
349 	if (!ap)
350 		return;
351 	set_bit(XMIT_WAKEUP, &ap->xmit_flags);
352 	tasklet_schedule(&ap->tsk);
353 	sp_put(ap);
354 }
355 
356 
357 static struct tty_ldisc_ops ppp_sync_ldisc = {
358 	.owner	= THIS_MODULE,
359 	.num	= N_SYNC_PPP,
360 	.name	= "pppsync",
361 	.open	= ppp_sync_open,
362 	.close	= ppp_sync_close,
363 	.hangup	= ppp_sync_hangup,
364 	.read	= ppp_sync_read,
365 	.write	= ppp_sync_write,
366 	.ioctl	= ppp_synctty_ioctl,
367 	.receive_buf = ppp_sync_receive,
368 	.write_wakeup = ppp_sync_wakeup,
369 };
370 
371 static int __init
372 ppp_sync_init(void)
373 {
374 	int err;
375 
376 	err = tty_register_ldisc(&ppp_sync_ldisc);
377 	if (err != 0)
378 		printk(KERN_ERR "PPP_sync: error %d registering line disc.\n",
379 		       err);
380 	return err;
381 }
382 
383 /*
384  * The following routines provide the PPP channel interface.
385  */
386 static int
387 ppp_sync_ioctl(struct ppp_channel *chan, unsigned int cmd, unsigned long arg)
388 {
389 	struct syncppp *ap = chan->private;
390 	int err, val;
391 	u32 accm[8];
392 	void __user *argp = (void __user *)arg;
393 	u32 __user *p = argp;
394 
395 	err = -EFAULT;
396 	switch (cmd) {
397 	case PPPIOCGFLAGS:
398 		val = ap->flags | ap->rbits;
399 		if (put_user(val, (int __user *) argp))
400 			break;
401 		err = 0;
402 		break;
403 	case PPPIOCSFLAGS:
404 		if (get_user(val, (int __user *) argp))
405 			break;
406 		ap->flags = val & ~SC_RCV_BITS;
407 		spin_lock_irq(&ap->recv_lock);
408 		ap->rbits = val & SC_RCV_BITS;
409 		spin_unlock_irq(&ap->recv_lock);
410 		err = 0;
411 		break;
412 
413 	case PPPIOCGASYNCMAP:
414 		if (put_user(ap->xaccm[0], p))
415 			break;
416 		err = 0;
417 		break;
418 	case PPPIOCSASYNCMAP:
419 		if (get_user(ap->xaccm[0], p))
420 			break;
421 		err = 0;
422 		break;
423 
424 	case PPPIOCGRASYNCMAP:
425 		if (put_user(ap->raccm, p))
426 			break;
427 		err = 0;
428 		break;
429 	case PPPIOCSRASYNCMAP:
430 		if (get_user(ap->raccm, p))
431 			break;
432 		err = 0;
433 		break;
434 
435 	case PPPIOCGXASYNCMAP:
436 		if (copy_to_user(argp, ap->xaccm, sizeof(ap->xaccm)))
437 			break;
438 		err = 0;
439 		break;
440 	case PPPIOCSXASYNCMAP:
441 		if (copy_from_user(accm, argp, sizeof(accm)))
442 			break;
443 		accm[2] &= ~0x40000000U;	/* can't escape 0x5e */
444 		accm[3] |= 0x60000000U;		/* must escape 0x7d, 0x7e */
445 		memcpy(ap->xaccm, accm, sizeof(ap->xaccm));
446 		err = 0;
447 		break;
448 
449 	case PPPIOCGMRU:
450 		if (put_user(ap->mru, (int __user *) argp))
451 			break;
452 		err = 0;
453 		break;
454 	case PPPIOCSMRU:
455 		if (get_user(val, (int __user *) argp))
456 			break;
457 		if (val < PPP_MRU)
458 			val = PPP_MRU;
459 		ap->mru = val;
460 		err = 0;
461 		break;
462 
463 	default:
464 		err = -ENOTTY;
465 	}
466 	return err;
467 }
468 
469 /*
470  * This is called at softirq level to deliver received packets
471  * to the ppp_generic code, and to tell the ppp_generic code
472  * if we can accept more output now.
473  */
474 static void ppp_sync_process(struct tasklet_struct *t)
475 {
476 	struct syncppp *ap = from_tasklet(ap, t, tsk);
477 	struct sk_buff *skb;
478 
479 	/* process received packets */
480 	while ((skb = skb_dequeue(&ap->rqueue)) != NULL) {
481 		if (skb->len == 0) {
482 			/* zero length buffers indicate error */
483 			ppp_input_error(&ap->chan, 0);
484 			kfree_skb(skb);
485 		}
486 		else
487 			ppp_input(&ap->chan, skb);
488 	}
489 
490 	/* try to push more stuff out */
491 	if (test_bit(XMIT_WAKEUP, &ap->xmit_flags) && ppp_sync_push(ap))
492 		ppp_output_wakeup(&ap->chan);
493 }
494 
495 /*
496  * Procedures for encapsulation and framing.
497  */
498 
499 static struct sk_buff*
500 ppp_sync_txmunge(struct syncppp *ap, struct sk_buff *skb)
501 {
502 	int proto;
503 	unsigned char *data;
504 	int islcp;
505 
506 	data  = skb->data;
507 	proto = get_unaligned_be16(data);
508 
509 	/* LCP packets with codes between 1 (configure-request)
510 	 * and 7 (code-reject) must be sent as though no options
511 	 * have been negotiated.
512 	 */
513 	islcp = proto == PPP_LCP && 1 <= data[2] && data[2] <= 7;
514 
515 	/* compress protocol field if option enabled */
516 	if (data[0] == 0 && (ap->flags & SC_COMP_PROT) && !islcp)
517 		skb_pull(skb,1);
518 
519 	/* prepend address/control fields if necessary */
520 	if ((ap->flags & SC_COMP_AC) == 0 || islcp) {
521 		if (skb_headroom(skb) < 2) {
522 			struct sk_buff *npkt = dev_alloc_skb(skb->len + 2);
523 			if (npkt == NULL) {
524 				kfree_skb(skb);
525 				return NULL;
526 			}
527 			skb_reserve(npkt,2);
528 			skb_copy_from_linear_data(skb,
529 				      skb_put(npkt, skb->len), skb->len);
530 			consume_skb(skb);
531 			skb = npkt;
532 		}
533 		skb_push(skb,2);
534 		skb->data[0] = PPP_ALLSTATIONS;
535 		skb->data[1] = PPP_UI;
536 	}
537 
538 	ap->last_xmit = jiffies;
539 
540 	if (skb && ap->flags & SC_LOG_OUTPKT)
541 		ppp_print_buffer ("send buffer", skb->data, skb->len);
542 
543 	return skb;
544 }
545 
546 /*
547  * Transmit-side routines.
548  */
549 
550 /*
551  * Send a packet to the peer over an sync tty line.
552  * Returns 1 iff the packet was accepted.
553  * If the packet was not accepted, we will call ppp_output_wakeup
554  * at some later time.
555  */
556 static int
557 ppp_sync_send(struct ppp_channel *chan, struct sk_buff *skb)
558 {
559 	struct syncppp *ap = chan->private;
560 
561 	ppp_sync_push(ap);
562 
563 	if (test_and_set_bit(XMIT_FULL, &ap->xmit_flags))
564 		return 0;	/* already full */
565 	skb = ppp_sync_txmunge(ap, skb);
566 	if (skb != NULL)
567 		ap->tpkt = skb;
568 	else
569 		clear_bit(XMIT_FULL, &ap->xmit_flags);
570 
571 	ppp_sync_push(ap);
572 	return 1;
573 }
574 
575 /*
576  * Push as much data as possible out to the tty.
577  */
578 static int
579 ppp_sync_push(struct syncppp *ap)
580 {
581 	int sent, done = 0;
582 	struct tty_struct *tty = ap->tty;
583 	int tty_stuffed = 0;
584 
585 	if (!spin_trylock_bh(&ap->xmit_lock))
586 		return 0;
587 	for (;;) {
588 		if (test_and_clear_bit(XMIT_WAKEUP, &ap->xmit_flags))
589 			tty_stuffed = 0;
590 		if (!tty_stuffed && ap->tpkt) {
591 			set_bit(TTY_DO_WRITE_WAKEUP, &tty->flags);
592 			sent = tty->ops->write(tty, ap->tpkt->data, ap->tpkt->len);
593 			if (sent < 0)
594 				goto flush;	/* error, e.g. loss of CD */
595 			if (sent < ap->tpkt->len) {
596 				tty_stuffed = 1;
597 			} else {
598 				consume_skb(ap->tpkt);
599 				ap->tpkt = NULL;
600 				clear_bit(XMIT_FULL, &ap->xmit_flags);
601 				done = 1;
602 			}
603 			continue;
604 		}
605 		/* haven't made any progress */
606 		spin_unlock_bh(&ap->xmit_lock);
607 		if (!(test_bit(XMIT_WAKEUP, &ap->xmit_flags) ||
608 		      (!tty_stuffed && ap->tpkt)))
609 			break;
610 		if (!spin_trylock_bh(&ap->xmit_lock))
611 			break;
612 	}
613 	return done;
614 
615 flush:
616 	if (ap->tpkt) {
617 		kfree_skb(ap->tpkt);
618 		ap->tpkt = NULL;
619 		clear_bit(XMIT_FULL, &ap->xmit_flags);
620 		done = 1;
621 	}
622 	spin_unlock_bh(&ap->xmit_lock);
623 	return done;
624 }
625 
626 /*
627  * Flush output from our internal buffers.
628  * Called for the TCFLSH ioctl.
629  */
630 static void
631 ppp_sync_flush_output(struct syncppp *ap)
632 {
633 	int done = 0;
634 
635 	spin_lock_bh(&ap->xmit_lock);
636 	if (ap->tpkt != NULL) {
637 		kfree_skb(ap->tpkt);
638 		ap->tpkt = NULL;
639 		clear_bit(XMIT_FULL, &ap->xmit_flags);
640 		done = 1;
641 	}
642 	spin_unlock_bh(&ap->xmit_lock);
643 	if (done)
644 		ppp_output_wakeup(&ap->chan);
645 }
646 
647 /*
648  * Receive-side routines.
649  */
650 
651 /* called when the tty driver has data for us.
652  *
653  * Data is frame oriented: each call to ppp_sync_input is considered
654  * a whole frame. If the 1st flag byte is non-zero then the whole
655  * frame is considered to be in error and is tossed.
656  */
657 static void
658 ppp_sync_input(struct syncppp *ap, const u8 *buf, const char *flags, int count)
659 {
660 	struct sk_buff *skb;
661 	unsigned char *p;
662 
663 	if (count == 0)
664 		return;
665 
666 	if (ap->flags & SC_LOG_INPKT)
667 		ppp_print_buffer ("receive buffer", buf, count);
668 
669 	/* stuff the chars in the skb */
670 	skb = dev_alloc_skb(ap->mru + PPP_HDRLEN + 2);
671 	if (!skb) {
672 		printk(KERN_ERR "PPPsync: no memory (input pkt)\n");
673 		goto err;
674 	}
675 	/* Try to get the payload 4-byte aligned */
676 	if (buf[0] != PPP_ALLSTATIONS)
677 		skb_reserve(skb, 2 + (buf[0] & 1));
678 
679 	if (flags && *flags) {
680 		/* error flag set, ignore frame */
681 		goto err;
682 	} else if (count > skb_tailroom(skb)) {
683 		/* packet overflowed MRU */
684 		goto err;
685 	}
686 
687 	skb_put_data(skb, buf, count);
688 
689 	/* strip address/control field if present */
690 	p = skb->data;
691 	if (p[0] == PPP_ALLSTATIONS && p[1] == PPP_UI) {
692 		/* chop off address/control */
693 		if (skb->len < 3)
694 			goto err;
695 		p = skb_pull(skb, 2);
696 	}
697 
698 	/* PPP packet length should be >= 2 bytes when protocol field is not
699 	 * compressed.
700 	 */
701 	if (!(p[0] & 0x01) && skb->len < 2)
702 		goto err;
703 
704 	/* queue the frame to be processed */
705 	skb_queue_tail(&ap->rqueue, skb);
706 	return;
707 
708 err:
709 	/* queue zero length packet as error indication */
710 	if (skb || (skb = dev_alloc_skb(0))) {
711 		skb_trim(skb, 0);
712 		skb_queue_tail(&ap->rqueue, skb);
713 	}
714 }
715 
716 static void __exit
717 ppp_sync_cleanup(void)
718 {
719 	tty_unregister_ldisc(&ppp_sync_ldisc);
720 }
721 
722 module_init(ppp_sync_init);
723 module_exit(ppp_sync_cleanup);
724 MODULE_LICENSE("GPL");
725 MODULE_ALIAS_LDISC(N_SYNC_PPP);
726