18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * PPP async serial channel driver for Linux. 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Copyright 1999 Paul Mackerras. 68c2ecf20Sopenharmony_ci * 78c2ecf20Sopenharmony_ci * This driver provides the encapsulation and framing for sending 88c2ecf20Sopenharmony_ci * and receiving PPP frames over async serial lines. It relies on 98c2ecf20Sopenharmony_ci * the generic PPP layer to give it frames to send and to process 108c2ecf20Sopenharmony_ci * received frames. It implements the PPP line discipline. 118c2ecf20Sopenharmony_ci * 128c2ecf20Sopenharmony_ci * Part of the code in this driver was inspired by the old async-only 138c2ecf20Sopenharmony_ci * PPP driver, written by Michael Callahan and Al Longyear, and 148c2ecf20Sopenharmony_ci * subsequently hacked by Paul Mackerras. 158c2ecf20Sopenharmony_ci */ 168c2ecf20Sopenharmony_ci 178c2ecf20Sopenharmony_ci#include <linux/module.h> 188c2ecf20Sopenharmony_ci#include <linux/kernel.h> 198c2ecf20Sopenharmony_ci#include <linux/skbuff.h> 208c2ecf20Sopenharmony_ci#include <linux/tty.h> 218c2ecf20Sopenharmony_ci#include <linux/netdevice.h> 228c2ecf20Sopenharmony_ci#include <linux/poll.h> 238c2ecf20Sopenharmony_ci#include <linux/crc-ccitt.h> 248c2ecf20Sopenharmony_ci#include <linux/ppp_defs.h> 258c2ecf20Sopenharmony_ci#include <linux/ppp-ioctl.h> 268c2ecf20Sopenharmony_ci#include <linux/ppp_channel.h> 278c2ecf20Sopenharmony_ci#include <linux/spinlock.h> 288c2ecf20Sopenharmony_ci#include <linux/init.h> 298c2ecf20Sopenharmony_ci#include <linux/interrupt.h> 308c2ecf20Sopenharmony_ci#include <linux/jiffies.h> 318c2ecf20Sopenharmony_ci#include <linux/slab.h> 328c2ecf20Sopenharmony_ci#include <asm/unaligned.h> 338c2ecf20Sopenharmony_ci#include <linux/uaccess.h> 348c2ecf20Sopenharmony_ci#include <asm/string.h> 358c2ecf20Sopenharmony_ci 368c2ecf20Sopenharmony_ci#define PPP_VERSION "2.4.2" 378c2ecf20Sopenharmony_ci 388c2ecf20Sopenharmony_ci#define OBUFSIZE 4096 398c2ecf20Sopenharmony_ci 408c2ecf20Sopenharmony_ci/* Structure for storing local state. */ 418c2ecf20Sopenharmony_cistruct asyncppp { 428c2ecf20Sopenharmony_ci struct tty_struct *tty; 438c2ecf20Sopenharmony_ci unsigned int flags; 448c2ecf20Sopenharmony_ci unsigned int state; 458c2ecf20Sopenharmony_ci unsigned int rbits; 468c2ecf20Sopenharmony_ci int mru; 478c2ecf20Sopenharmony_ci spinlock_t xmit_lock; 488c2ecf20Sopenharmony_ci spinlock_t recv_lock; 498c2ecf20Sopenharmony_ci unsigned long xmit_flags; 508c2ecf20Sopenharmony_ci u32 xaccm[8]; 518c2ecf20Sopenharmony_ci u32 raccm; 528c2ecf20Sopenharmony_ci unsigned int bytes_sent; 538c2ecf20Sopenharmony_ci unsigned int bytes_rcvd; 548c2ecf20Sopenharmony_ci 558c2ecf20Sopenharmony_ci struct sk_buff *tpkt; 568c2ecf20Sopenharmony_ci int tpkt_pos; 578c2ecf20Sopenharmony_ci u16 tfcs; 588c2ecf20Sopenharmony_ci unsigned char *optr; 598c2ecf20Sopenharmony_ci unsigned char *olim; 608c2ecf20Sopenharmony_ci unsigned long last_xmit; 618c2ecf20Sopenharmony_ci 628c2ecf20Sopenharmony_ci struct sk_buff *rpkt; 638c2ecf20Sopenharmony_ci int lcp_fcs; 648c2ecf20Sopenharmony_ci struct sk_buff_head rqueue; 658c2ecf20Sopenharmony_ci 668c2ecf20Sopenharmony_ci struct tasklet_struct tsk; 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_ci refcount_t refcnt; 698c2ecf20Sopenharmony_ci struct completion dead; 708c2ecf20Sopenharmony_ci struct ppp_channel chan; /* interface to generic ppp layer */ 718c2ecf20Sopenharmony_ci unsigned char obuf[OBUFSIZE]; 728c2ecf20Sopenharmony_ci}; 738c2ecf20Sopenharmony_ci 748c2ecf20Sopenharmony_ci/* Bit numbers in xmit_flags */ 758c2ecf20Sopenharmony_ci#define XMIT_WAKEUP 0 768c2ecf20Sopenharmony_ci#define XMIT_FULL 1 778c2ecf20Sopenharmony_ci#define XMIT_BUSY 2 788c2ecf20Sopenharmony_ci 798c2ecf20Sopenharmony_ci/* State bits */ 808c2ecf20Sopenharmony_ci#define SC_TOSS 1 818c2ecf20Sopenharmony_ci#define SC_ESCAPE 2 828c2ecf20Sopenharmony_ci#define SC_PREV_ERROR 4 838c2ecf20Sopenharmony_ci 848c2ecf20Sopenharmony_ci/* Bits in rbits */ 858c2ecf20Sopenharmony_ci#define SC_RCV_BITS (SC_RCV_B7_1|SC_RCV_B7_0|SC_RCV_ODDP|SC_RCV_EVNP) 868c2ecf20Sopenharmony_ci 878c2ecf20Sopenharmony_cistatic int flag_time = HZ; 888c2ecf20Sopenharmony_cimodule_param(flag_time, int, 0); 898c2ecf20Sopenharmony_ciMODULE_PARM_DESC(flag_time, "ppp_async: interval between flagged packets (in clock ticks)"); 908c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL"); 918c2ecf20Sopenharmony_ciMODULE_ALIAS_LDISC(N_PPP); 928c2ecf20Sopenharmony_ci 938c2ecf20Sopenharmony_ci/* 948c2ecf20Sopenharmony_ci * Prototypes. 958c2ecf20Sopenharmony_ci */ 968c2ecf20Sopenharmony_cistatic int ppp_async_encode(struct asyncppp *ap); 978c2ecf20Sopenharmony_cistatic int ppp_async_send(struct ppp_channel *chan, struct sk_buff *skb); 988c2ecf20Sopenharmony_cistatic int ppp_async_push(struct asyncppp *ap); 998c2ecf20Sopenharmony_cistatic void ppp_async_flush_output(struct asyncppp *ap); 1008c2ecf20Sopenharmony_cistatic void ppp_async_input(struct asyncppp *ap, const unsigned char *buf, 1018c2ecf20Sopenharmony_ci char *flags, int count); 1028c2ecf20Sopenharmony_cistatic int ppp_async_ioctl(struct ppp_channel *chan, unsigned int cmd, 1038c2ecf20Sopenharmony_ci unsigned long arg); 1048c2ecf20Sopenharmony_cistatic void ppp_async_process(unsigned long arg); 1058c2ecf20Sopenharmony_ci 1068c2ecf20Sopenharmony_cistatic void async_lcp_peek(struct asyncppp *ap, unsigned char *data, 1078c2ecf20Sopenharmony_ci int len, int inbound); 1088c2ecf20Sopenharmony_ci 1098c2ecf20Sopenharmony_cistatic const struct ppp_channel_ops async_ops = { 1108c2ecf20Sopenharmony_ci .start_xmit = ppp_async_send, 1118c2ecf20Sopenharmony_ci .ioctl = ppp_async_ioctl, 1128c2ecf20Sopenharmony_ci}; 1138c2ecf20Sopenharmony_ci 1148c2ecf20Sopenharmony_ci/* 1158c2ecf20Sopenharmony_ci * Routines implementing the PPP line discipline. 1168c2ecf20Sopenharmony_ci */ 1178c2ecf20Sopenharmony_ci 1188c2ecf20Sopenharmony_ci/* 1198c2ecf20Sopenharmony_ci * We have a potential race on dereferencing tty->disc_data, 1208c2ecf20Sopenharmony_ci * because the tty layer provides no locking at all - thus one 1218c2ecf20Sopenharmony_ci * cpu could be running ppp_asynctty_receive while another 1228c2ecf20Sopenharmony_ci * calls ppp_asynctty_close, which zeroes tty->disc_data and 1238c2ecf20Sopenharmony_ci * frees the memory that ppp_asynctty_receive is using. The best 1248c2ecf20Sopenharmony_ci * way to fix this is to use a rwlock in the tty struct, but for now 1258c2ecf20Sopenharmony_ci * we use a single global rwlock for all ttys in ppp line discipline. 1268c2ecf20Sopenharmony_ci * 1278c2ecf20Sopenharmony_ci * FIXME: this is no longer true. The _close path for the ldisc is 1288c2ecf20Sopenharmony_ci * now guaranteed to be sane. 1298c2ecf20Sopenharmony_ci */ 1308c2ecf20Sopenharmony_cistatic DEFINE_RWLOCK(disc_data_lock); 1318c2ecf20Sopenharmony_ci 1328c2ecf20Sopenharmony_cistatic struct asyncppp *ap_get(struct tty_struct *tty) 1338c2ecf20Sopenharmony_ci{ 1348c2ecf20Sopenharmony_ci struct asyncppp *ap; 1358c2ecf20Sopenharmony_ci 1368c2ecf20Sopenharmony_ci read_lock(&disc_data_lock); 1378c2ecf20Sopenharmony_ci ap = tty->disc_data; 1388c2ecf20Sopenharmony_ci if (ap != NULL) 1398c2ecf20Sopenharmony_ci refcount_inc(&ap->refcnt); 1408c2ecf20Sopenharmony_ci read_unlock(&disc_data_lock); 1418c2ecf20Sopenharmony_ci return ap; 1428c2ecf20Sopenharmony_ci} 1438c2ecf20Sopenharmony_ci 1448c2ecf20Sopenharmony_cistatic void ap_put(struct asyncppp *ap) 1458c2ecf20Sopenharmony_ci{ 1468c2ecf20Sopenharmony_ci if (refcount_dec_and_test(&ap->refcnt)) 1478c2ecf20Sopenharmony_ci complete(&ap->dead); 1488c2ecf20Sopenharmony_ci} 1498c2ecf20Sopenharmony_ci 1508c2ecf20Sopenharmony_ci/* 1518c2ecf20Sopenharmony_ci * Called when a tty is put into PPP line discipline. Called in process 1528c2ecf20Sopenharmony_ci * context. 1538c2ecf20Sopenharmony_ci */ 1548c2ecf20Sopenharmony_cistatic int 1558c2ecf20Sopenharmony_cippp_asynctty_open(struct tty_struct *tty) 1568c2ecf20Sopenharmony_ci{ 1578c2ecf20Sopenharmony_ci struct asyncppp *ap; 1588c2ecf20Sopenharmony_ci int err; 1598c2ecf20Sopenharmony_ci int speed; 1608c2ecf20Sopenharmony_ci 1618c2ecf20Sopenharmony_ci if (tty->ops->write == NULL) 1628c2ecf20Sopenharmony_ci return -EOPNOTSUPP; 1638c2ecf20Sopenharmony_ci 1648c2ecf20Sopenharmony_ci err = -ENOMEM; 1658c2ecf20Sopenharmony_ci ap = kzalloc(sizeof(*ap), GFP_KERNEL); 1668c2ecf20Sopenharmony_ci if (!ap) 1678c2ecf20Sopenharmony_ci goto out; 1688c2ecf20Sopenharmony_ci 1698c2ecf20Sopenharmony_ci /* initialize the asyncppp structure */ 1708c2ecf20Sopenharmony_ci ap->tty = tty; 1718c2ecf20Sopenharmony_ci ap->mru = PPP_MRU; 1728c2ecf20Sopenharmony_ci spin_lock_init(&ap->xmit_lock); 1738c2ecf20Sopenharmony_ci spin_lock_init(&ap->recv_lock); 1748c2ecf20Sopenharmony_ci ap->xaccm[0] = ~0U; 1758c2ecf20Sopenharmony_ci ap->xaccm[3] = 0x60000000U; 1768c2ecf20Sopenharmony_ci ap->raccm = ~0U; 1778c2ecf20Sopenharmony_ci ap->optr = ap->obuf; 1788c2ecf20Sopenharmony_ci ap->olim = ap->obuf; 1798c2ecf20Sopenharmony_ci ap->lcp_fcs = -1; 1808c2ecf20Sopenharmony_ci 1818c2ecf20Sopenharmony_ci skb_queue_head_init(&ap->rqueue); 1828c2ecf20Sopenharmony_ci tasklet_init(&ap->tsk, ppp_async_process, (unsigned long) ap); 1838c2ecf20Sopenharmony_ci 1848c2ecf20Sopenharmony_ci refcount_set(&ap->refcnt, 1); 1858c2ecf20Sopenharmony_ci init_completion(&ap->dead); 1868c2ecf20Sopenharmony_ci 1878c2ecf20Sopenharmony_ci ap->chan.private = ap; 1888c2ecf20Sopenharmony_ci ap->chan.ops = &async_ops; 1898c2ecf20Sopenharmony_ci ap->chan.mtu = PPP_MRU; 1908c2ecf20Sopenharmony_ci speed = tty_get_baud_rate(tty); 1918c2ecf20Sopenharmony_ci ap->chan.speed = speed; 1928c2ecf20Sopenharmony_ci err = ppp_register_channel(&ap->chan); 1938c2ecf20Sopenharmony_ci if (err) 1948c2ecf20Sopenharmony_ci goto out_free; 1958c2ecf20Sopenharmony_ci 1968c2ecf20Sopenharmony_ci tty->disc_data = ap; 1978c2ecf20Sopenharmony_ci tty->receive_room = 65536; 1988c2ecf20Sopenharmony_ci return 0; 1998c2ecf20Sopenharmony_ci 2008c2ecf20Sopenharmony_ci out_free: 2018c2ecf20Sopenharmony_ci kfree(ap); 2028c2ecf20Sopenharmony_ci out: 2038c2ecf20Sopenharmony_ci return err; 2048c2ecf20Sopenharmony_ci} 2058c2ecf20Sopenharmony_ci 2068c2ecf20Sopenharmony_ci/* 2078c2ecf20Sopenharmony_ci * Called when the tty is put into another line discipline 2088c2ecf20Sopenharmony_ci * or it hangs up. We have to wait for any cpu currently 2098c2ecf20Sopenharmony_ci * executing in any of the other ppp_asynctty_* routines to 2108c2ecf20Sopenharmony_ci * finish before we can call ppp_unregister_channel and free 2118c2ecf20Sopenharmony_ci * the asyncppp struct. This routine must be called from 2128c2ecf20Sopenharmony_ci * process context, not interrupt or softirq context. 2138c2ecf20Sopenharmony_ci */ 2148c2ecf20Sopenharmony_cistatic void 2158c2ecf20Sopenharmony_cippp_asynctty_close(struct tty_struct *tty) 2168c2ecf20Sopenharmony_ci{ 2178c2ecf20Sopenharmony_ci struct asyncppp *ap; 2188c2ecf20Sopenharmony_ci 2198c2ecf20Sopenharmony_ci write_lock_irq(&disc_data_lock); 2208c2ecf20Sopenharmony_ci ap = tty->disc_data; 2218c2ecf20Sopenharmony_ci tty->disc_data = NULL; 2228c2ecf20Sopenharmony_ci write_unlock_irq(&disc_data_lock); 2238c2ecf20Sopenharmony_ci if (!ap) 2248c2ecf20Sopenharmony_ci return; 2258c2ecf20Sopenharmony_ci 2268c2ecf20Sopenharmony_ci /* 2278c2ecf20Sopenharmony_ci * We have now ensured that nobody can start using ap from now 2288c2ecf20Sopenharmony_ci * on, but we have to wait for all existing users to finish. 2298c2ecf20Sopenharmony_ci * Note that ppp_unregister_channel ensures that no calls to 2308c2ecf20Sopenharmony_ci * our channel ops (i.e. ppp_async_send/ioctl) are in progress 2318c2ecf20Sopenharmony_ci * by the time it returns. 2328c2ecf20Sopenharmony_ci */ 2338c2ecf20Sopenharmony_ci if (!refcount_dec_and_test(&ap->refcnt)) 2348c2ecf20Sopenharmony_ci wait_for_completion(&ap->dead); 2358c2ecf20Sopenharmony_ci tasklet_kill(&ap->tsk); 2368c2ecf20Sopenharmony_ci 2378c2ecf20Sopenharmony_ci ppp_unregister_channel(&ap->chan); 2388c2ecf20Sopenharmony_ci kfree_skb(ap->rpkt); 2398c2ecf20Sopenharmony_ci skb_queue_purge(&ap->rqueue); 2408c2ecf20Sopenharmony_ci kfree_skb(ap->tpkt); 2418c2ecf20Sopenharmony_ci kfree(ap); 2428c2ecf20Sopenharmony_ci} 2438c2ecf20Sopenharmony_ci 2448c2ecf20Sopenharmony_ci/* 2458c2ecf20Sopenharmony_ci * Called on tty hangup in process context. 2468c2ecf20Sopenharmony_ci * 2478c2ecf20Sopenharmony_ci * Wait for I/O to driver to complete and unregister PPP channel. 2488c2ecf20Sopenharmony_ci * This is already done by the close routine, so just call that. 2498c2ecf20Sopenharmony_ci */ 2508c2ecf20Sopenharmony_cistatic int ppp_asynctty_hangup(struct tty_struct *tty) 2518c2ecf20Sopenharmony_ci{ 2528c2ecf20Sopenharmony_ci ppp_asynctty_close(tty); 2538c2ecf20Sopenharmony_ci return 0; 2548c2ecf20Sopenharmony_ci} 2558c2ecf20Sopenharmony_ci 2568c2ecf20Sopenharmony_ci/* 2578c2ecf20Sopenharmony_ci * Read does nothing - no data is ever available this way. 2588c2ecf20Sopenharmony_ci * Pppd reads and writes packets via /dev/ppp instead. 2598c2ecf20Sopenharmony_ci */ 2608c2ecf20Sopenharmony_cistatic ssize_t 2618c2ecf20Sopenharmony_cippp_asynctty_read(struct tty_struct *tty, struct file *file, 2628c2ecf20Sopenharmony_ci unsigned char *buf, size_t count, 2638c2ecf20Sopenharmony_ci void **cookie, unsigned long offset) 2648c2ecf20Sopenharmony_ci{ 2658c2ecf20Sopenharmony_ci return -EAGAIN; 2668c2ecf20Sopenharmony_ci} 2678c2ecf20Sopenharmony_ci 2688c2ecf20Sopenharmony_ci/* 2698c2ecf20Sopenharmony_ci * Write on the tty does nothing, the packets all come in 2708c2ecf20Sopenharmony_ci * from the ppp generic stuff. 2718c2ecf20Sopenharmony_ci */ 2728c2ecf20Sopenharmony_cistatic ssize_t 2738c2ecf20Sopenharmony_cippp_asynctty_write(struct tty_struct *tty, struct file *file, 2748c2ecf20Sopenharmony_ci const unsigned char *buf, size_t count) 2758c2ecf20Sopenharmony_ci{ 2768c2ecf20Sopenharmony_ci return -EAGAIN; 2778c2ecf20Sopenharmony_ci} 2788c2ecf20Sopenharmony_ci 2798c2ecf20Sopenharmony_ci/* 2808c2ecf20Sopenharmony_ci * Called in process context only. May be re-entered by multiple 2818c2ecf20Sopenharmony_ci * ioctl calling threads. 2828c2ecf20Sopenharmony_ci */ 2838c2ecf20Sopenharmony_ci 2848c2ecf20Sopenharmony_cistatic int 2858c2ecf20Sopenharmony_cippp_asynctty_ioctl(struct tty_struct *tty, struct file *file, 2868c2ecf20Sopenharmony_ci unsigned int cmd, unsigned long arg) 2878c2ecf20Sopenharmony_ci{ 2888c2ecf20Sopenharmony_ci struct asyncppp *ap = ap_get(tty); 2898c2ecf20Sopenharmony_ci int err, val; 2908c2ecf20Sopenharmony_ci int __user *p = (int __user *)arg; 2918c2ecf20Sopenharmony_ci 2928c2ecf20Sopenharmony_ci if (!ap) 2938c2ecf20Sopenharmony_ci return -ENXIO; 2948c2ecf20Sopenharmony_ci err = -EFAULT; 2958c2ecf20Sopenharmony_ci switch (cmd) { 2968c2ecf20Sopenharmony_ci case PPPIOCGCHAN: 2978c2ecf20Sopenharmony_ci err = -EFAULT; 2988c2ecf20Sopenharmony_ci if (put_user(ppp_channel_index(&ap->chan), p)) 2998c2ecf20Sopenharmony_ci break; 3008c2ecf20Sopenharmony_ci err = 0; 3018c2ecf20Sopenharmony_ci break; 3028c2ecf20Sopenharmony_ci 3038c2ecf20Sopenharmony_ci case PPPIOCGUNIT: 3048c2ecf20Sopenharmony_ci err = -EFAULT; 3058c2ecf20Sopenharmony_ci if (put_user(ppp_unit_number(&ap->chan), p)) 3068c2ecf20Sopenharmony_ci break; 3078c2ecf20Sopenharmony_ci err = 0; 3088c2ecf20Sopenharmony_ci break; 3098c2ecf20Sopenharmony_ci 3108c2ecf20Sopenharmony_ci case TCFLSH: 3118c2ecf20Sopenharmony_ci /* flush our buffers and the serial port's buffer */ 3128c2ecf20Sopenharmony_ci if (arg == TCIOFLUSH || arg == TCOFLUSH) 3138c2ecf20Sopenharmony_ci ppp_async_flush_output(ap); 3148c2ecf20Sopenharmony_ci err = n_tty_ioctl_helper(tty, file, cmd, arg); 3158c2ecf20Sopenharmony_ci break; 3168c2ecf20Sopenharmony_ci 3178c2ecf20Sopenharmony_ci case FIONREAD: 3188c2ecf20Sopenharmony_ci val = 0; 3198c2ecf20Sopenharmony_ci if (put_user(val, p)) 3208c2ecf20Sopenharmony_ci break; 3218c2ecf20Sopenharmony_ci err = 0; 3228c2ecf20Sopenharmony_ci break; 3238c2ecf20Sopenharmony_ci 3248c2ecf20Sopenharmony_ci default: 3258c2ecf20Sopenharmony_ci /* Try the various mode ioctls */ 3268c2ecf20Sopenharmony_ci err = tty_mode_ioctl(tty, file, cmd, arg); 3278c2ecf20Sopenharmony_ci } 3288c2ecf20Sopenharmony_ci 3298c2ecf20Sopenharmony_ci ap_put(ap); 3308c2ecf20Sopenharmony_ci return err; 3318c2ecf20Sopenharmony_ci} 3328c2ecf20Sopenharmony_ci 3338c2ecf20Sopenharmony_ci/* No kernel lock - fine */ 3348c2ecf20Sopenharmony_cistatic __poll_t 3358c2ecf20Sopenharmony_cippp_asynctty_poll(struct tty_struct *tty, struct file *file, poll_table *wait) 3368c2ecf20Sopenharmony_ci{ 3378c2ecf20Sopenharmony_ci return 0; 3388c2ecf20Sopenharmony_ci} 3398c2ecf20Sopenharmony_ci 3408c2ecf20Sopenharmony_ci/* May sleep, don't call from interrupt level or with interrupts disabled */ 3418c2ecf20Sopenharmony_cistatic void 3428c2ecf20Sopenharmony_cippp_asynctty_receive(struct tty_struct *tty, const unsigned char *buf, 3438c2ecf20Sopenharmony_ci char *cflags, int count) 3448c2ecf20Sopenharmony_ci{ 3458c2ecf20Sopenharmony_ci struct asyncppp *ap = ap_get(tty); 3468c2ecf20Sopenharmony_ci unsigned long flags; 3478c2ecf20Sopenharmony_ci 3488c2ecf20Sopenharmony_ci if (!ap) 3498c2ecf20Sopenharmony_ci return; 3508c2ecf20Sopenharmony_ci spin_lock_irqsave(&ap->recv_lock, flags); 3518c2ecf20Sopenharmony_ci ppp_async_input(ap, buf, cflags, count); 3528c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&ap->recv_lock, flags); 3538c2ecf20Sopenharmony_ci if (!skb_queue_empty(&ap->rqueue)) 3548c2ecf20Sopenharmony_ci tasklet_schedule(&ap->tsk); 3558c2ecf20Sopenharmony_ci ap_put(ap); 3568c2ecf20Sopenharmony_ci tty_unthrottle(tty); 3578c2ecf20Sopenharmony_ci} 3588c2ecf20Sopenharmony_ci 3598c2ecf20Sopenharmony_cistatic void 3608c2ecf20Sopenharmony_cippp_asynctty_wakeup(struct tty_struct *tty) 3618c2ecf20Sopenharmony_ci{ 3628c2ecf20Sopenharmony_ci struct asyncppp *ap = ap_get(tty); 3638c2ecf20Sopenharmony_ci 3648c2ecf20Sopenharmony_ci clear_bit(TTY_DO_WRITE_WAKEUP, &tty->flags); 3658c2ecf20Sopenharmony_ci if (!ap) 3668c2ecf20Sopenharmony_ci return; 3678c2ecf20Sopenharmony_ci set_bit(XMIT_WAKEUP, &ap->xmit_flags); 3688c2ecf20Sopenharmony_ci tasklet_schedule(&ap->tsk); 3698c2ecf20Sopenharmony_ci ap_put(ap); 3708c2ecf20Sopenharmony_ci} 3718c2ecf20Sopenharmony_ci 3728c2ecf20Sopenharmony_ci 3738c2ecf20Sopenharmony_cistatic struct tty_ldisc_ops ppp_ldisc = { 3748c2ecf20Sopenharmony_ci .owner = THIS_MODULE, 3758c2ecf20Sopenharmony_ci .magic = TTY_LDISC_MAGIC, 3768c2ecf20Sopenharmony_ci .name = "ppp", 3778c2ecf20Sopenharmony_ci .open = ppp_asynctty_open, 3788c2ecf20Sopenharmony_ci .close = ppp_asynctty_close, 3798c2ecf20Sopenharmony_ci .hangup = ppp_asynctty_hangup, 3808c2ecf20Sopenharmony_ci .read = ppp_asynctty_read, 3818c2ecf20Sopenharmony_ci .write = ppp_asynctty_write, 3828c2ecf20Sopenharmony_ci .ioctl = ppp_asynctty_ioctl, 3838c2ecf20Sopenharmony_ci .poll = ppp_asynctty_poll, 3848c2ecf20Sopenharmony_ci .receive_buf = ppp_asynctty_receive, 3858c2ecf20Sopenharmony_ci .write_wakeup = ppp_asynctty_wakeup, 3868c2ecf20Sopenharmony_ci}; 3878c2ecf20Sopenharmony_ci 3888c2ecf20Sopenharmony_cistatic int __init 3898c2ecf20Sopenharmony_cippp_async_init(void) 3908c2ecf20Sopenharmony_ci{ 3918c2ecf20Sopenharmony_ci int err; 3928c2ecf20Sopenharmony_ci 3938c2ecf20Sopenharmony_ci err = tty_register_ldisc(N_PPP, &ppp_ldisc); 3948c2ecf20Sopenharmony_ci if (err != 0) 3958c2ecf20Sopenharmony_ci printk(KERN_ERR "PPP_async: error %d registering line disc.\n", 3968c2ecf20Sopenharmony_ci err); 3978c2ecf20Sopenharmony_ci return err; 3988c2ecf20Sopenharmony_ci} 3998c2ecf20Sopenharmony_ci 4008c2ecf20Sopenharmony_ci/* 4018c2ecf20Sopenharmony_ci * The following routines provide the PPP channel interface. 4028c2ecf20Sopenharmony_ci */ 4038c2ecf20Sopenharmony_cistatic int 4048c2ecf20Sopenharmony_cippp_async_ioctl(struct ppp_channel *chan, unsigned int cmd, unsigned long arg) 4058c2ecf20Sopenharmony_ci{ 4068c2ecf20Sopenharmony_ci struct asyncppp *ap = chan->private; 4078c2ecf20Sopenharmony_ci void __user *argp = (void __user *)arg; 4088c2ecf20Sopenharmony_ci int __user *p = argp; 4098c2ecf20Sopenharmony_ci int err, val; 4108c2ecf20Sopenharmony_ci u32 accm[8]; 4118c2ecf20Sopenharmony_ci 4128c2ecf20Sopenharmony_ci err = -EFAULT; 4138c2ecf20Sopenharmony_ci switch (cmd) { 4148c2ecf20Sopenharmony_ci case PPPIOCGFLAGS: 4158c2ecf20Sopenharmony_ci val = ap->flags | ap->rbits; 4168c2ecf20Sopenharmony_ci if (put_user(val, p)) 4178c2ecf20Sopenharmony_ci break; 4188c2ecf20Sopenharmony_ci err = 0; 4198c2ecf20Sopenharmony_ci break; 4208c2ecf20Sopenharmony_ci case PPPIOCSFLAGS: 4218c2ecf20Sopenharmony_ci if (get_user(val, p)) 4228c2ecf20Sopenharmony_ci break; 4238c2ecf20Sopenharmony_ci ap->flags = val & ~SC_RCV_BITS; 4248c2ecf20Sopenharmony_ci spin_lock_irq(&ap->recv_lock); 4258c2ecf20Sopenharmony_ci ap->rbits = val & SC_RCV_BITS; 4268c2ecf20Sopenharmony_ci spin_unlock_irq(&ap->recv_lock); 4278c2ecf20Sopenharmony_ci err = 0; 4288c2ecf20Sopenharmony_ci break; 4298c2ecf20Sopenharmony_ci 4308c2ecf20Sopenharmony_ci case PPPIOCGASYNCMAP: 4318c2ecf20Sopenharmony_ci if (put_user(ap->xaccm[0], (u32 __user *)argp)) 4328c2ecf20Sopenharmony_ci break; 4338c2ecf20Sopenharmony_ci err = 0; 4348c2ecf20Sopenharmony_ci break; 4358c2ecf20Sopenharmony_ci case PPPIOCSASYNCMAP: 4368c2ecf20Sopenharmony_ci if (get_user(ap->xaccm[0], (u32 __user *)argp)) 4378c2ecf20Sopenharmony_ci break; 4388c2ecf20Sopenharmony_ci err = 0; 4398c2ecf20Sopenharmony_ci break; 4408c2ecf20Sopenharmony_ci 4418c2ecf20Sopenharmony_ci case PPPIOCGRASYNCMAP: 4428c2ecf20Sopenharmony_ci if (put_user(ap->raccm, (u32 __user *)argp)) 4438c2ecf20Sopenharmony_ci break; 4448c2ecf20Sopenharmony_ci err = 0; 4458c2ecf20Sopenharmony_ci break; 4468c2ecf20Sopenharmony_ci case PPPIOCSRASYNCMAP: 4478c2ecf20Sopenharmony_ci if (get_user(ap->raccm, (u32 __user *)argp)) 4488c2ecf20Sopenharmony_ci break; 4498c2ecf20Sopenharmony_ci err = 0; 4508c2ecf20Sopenharmony_ci break; 4518c2ecf20Sopenharmony_ci 4528c2ecf20Sopenharmony_ci case PPPIOCGXASYNCMAP: 4538c2ecf20Sopenharmony_ci if (copy_to_user(argp, ap->xaccm, sizeof(ap->xaccm))) 4548c2ecf20Sopenharmony_ci break; 4558c2ecf20Sopenharmony_ci err = 0; 4568c2ecf20Sopenharmony_ci break; 4578c2ecf20Sopenharmony_ci case PPPIOCSXASYNCMAP: 4588c2ecf20Sopenharmony_ci if (copy_from_user(accm, argp, sizeof(accm))) 4598c2ecf20Sopenharmony_ci break; 4608c2ecf20Sopenharmony_ci accm[2] &= ~0x40000000U; /* can't escape 0x5e */ 4618c2ecf20Sopenharmony_ci accm[3] |= 0x60000000U; /* must escape 0x7d, 0x7e */ 4628c2ecf20Sopenharmony_ci memcpy(ap->xaccm, accm, sizeof(ap->xaccm)); 4638c2ecf20Sopenharmony_ci err = 0; 4648c2ecf20Sopenharmony_ci break; 4658c2ecf20Sopenharmony_ci 4668c2ecf20Sopenharmony_ci case PPPIOCGMRU: 4678c2ecf20Sopenharmony_ci if (put_user(ap->mru, p)) 4688c2ecf20Sopenharmony_ci break; 4698c2ecf20Sopenharmony_ci err = 0; 4708c2ecf20Sopenharmony_ci break; 4718c2ecf20Sopenharmony_ci case PPPIOCSMRU: 4728c2ecf20Sopenharmony_ci if (get_user(val, p)) 4738c2ecf20Sopenharmony_ci break; 4748c2ecf20Sopenharmony_ci if (val > U16_MAX) { 4758c2ecf20Sopenharmony_ci err = -EINVAL; 4768c2ecf20Sopenharmony_ci break; 4778c2ecf20Sopenharmony_ci } 4788c2ecf20Sopenharmony_ci if (val < PPP_MRU) 4798c2ecf20Sopenharmony_ci val = PPP_MRU; 4808c2ecf20Sopenharmony_ci ap->mru = val; 4818c2ecf20Sopenharmony_ci err = 0; 4828c2ecf20Sopenharmony_ci break; 4838c2ecf20Sopenharmony_ci 4848c2ecf20Sopenharmony_ci default: 4858c2ecf20Sopenharmony_ci err = -ENOTTY; 4868c2ecf20Sopenharmony_ci } 4878c2ecf20Sopenharmony_ci 4888c2ecf20Sopenharmony_ci return err; 4898c2ecf20Sopenharmony_ci} 4908c2ecf20Sopenharmony_ci 4918c2ecf20Sopenharmony_ci/* 4928c2ecf20Sopenharmony_ci * This is called at softirq level to deliver received packets 4938c2ecf20Sopenharmony_ci * to the ppp_generic code, and to tell the ppp_generic code 4948c2ecf20Sopenharmony_ci * if we can accept more output now. 4958c2ecf20Sopenharmony_ci */ 4968c2ecf20Sopenharmony_cistatic void ppp_async_process(unsigned long arg) 4978c2ecf20Sopenharmony_ci{ 4988c2ecf20Sopenharmony_ci struct asyncppp *ap = (struct asyncppp *) arg; 4998c2ecf20Sopenharmony_ci struct sk_buff *skb; 5008c2ecf20Sopenharmony_ci 5018c2ecf20Sopenharmony_ci /* process received packets */ 5028c2ecf20Sopenharmony_ci while ((skb = skb_dequeue(&ap->rqueue)) != NULL) { 5038c2ecf20Sopenharmony_ci if (skb->cb[0]) 5048c2ecf20Sopenharmony_ci ppp_input_error(&ap->chan, 0); 5058c2ecf20Sopenharmony_ci ppp_input(&ap->chan, skb); 5068c2ecf20Sopenharmony_ci } 5078c2ecf20Sopenharmony_ci 5088c2ecf20Sopenharmony_ci /* try to push more stuff out */ 5098c2ecf20Sopenharmony_ci if (test_bit(XMIT_WAKEUP, &ap->xmit_flags) && ppp_async_push(ap)) 5108c2ecf20Sopenharmony_ci ppp_output_wakeup(&ap->chan); 5118c2ecf20Sopenharmony_ci} 5128c2ecf20Sopenharmony_ci 5138c2ecf20Sopenharmony_ci/* 5148c2ecf20Sopenharmony_ci * Procedures for encapsulation and framing. 5158c2ecf20Sopenharmony_ci */ 5168c2ecf20Sopenharmony_ci 5178c2ecf20Sopenharmony_ci/* 5188c2ecf20Sopenharmony_ci * Procedure to encode the data for async serial transmission. 5198c2ecf20Sopenharmony_ci * Does octet stuffing (escaping), puts the address/control bytes 5208c2ecf20Sopenharmony_ci * on if A/C compression is disabled, and does protocol compression. 5218c2ecf20Sopenharmony_ci * Assumes ap->tpkt != 0 on entry. 5228c2ecf20Sopenharmony_ci * Returns 1 if we finished the current frame, 0 otherwise. 5238c2ecf20Sopenharmony_ci */ 5248c2ecf20Sopenharmony_ci 5258c2ecf20Sopenharmony_ci#define PUT_BYTE(ap, buf, c, islcp) do { \ 5268c2ecf20Sopenharmony_ci if ((islcp && c < 0x20) || (ap->xaccm[c >> 5] & (1 << (c & 0x1f)))) {\ 5278c2ecf20Sopenharmony_ci *buf++ = PPP_ESCAPE; \ 5288c2ecf20Sopenharmony_ci *buf++ = c ^ PPP_TRANS; \ 5298c2ecf20Sopenharmony_ci } else \ 5308c2ecf20Sopenharmony_ci *buf++ = c; \ 5318c2ecf20Sopenharmony_ci} while (0) 5328c2ecf20Sopenharmony_ci 5338c2ecf20Sopenharmony_cistatic int 5348c2ecf20Sopenharmony_cippp_async_encode(struct asyncppp *ap) 5358c2ecf20Sopenharmony_ci{ 5368c2ecf20Sopenharmony_ci int fcs, i, count, c, proto; 5378c2ecf20Sopenharmony_ci unsigned char *buf, *buflim; 5388c2ecf20Sopenharmony_ci unsigned char *data; 5398c2ecf20Sopenharmony_ci int islcp; 5408c2ecf20Sopenharmony_ci 5418c2ecf20Sopenharmony_ci buf = ap->obuf; 5428c2ecf20Sopenharmony_ci ap->olim = buf; 5438c2ecf20Sopenharmony_ci ap->optr = buf; 5448c2ecf20Sopenharmony_ci i = ap->tpkt_pos; 5458c2ecf20Sopenharmony_ci data = ap->tpkt->data; 5468c2ecf20Sopenharmony_ci count = ap->tpkt->len; 5478c2ecf20Sopenharmony_ci fcs = ap->tfcs; 5488c2ecf20Sopenharmony_ci proto = get_unaligned_be16(data); 5498c2ecf20Sopenharmony_ci 5508c2ecf20Sopenharmony_ci /* 5518c2ecf20Sopenharmony_ci * LCP packets with code values between 1 (configure-reqest) 5528c2ecf20Sopenharmony_ci * and 7 (code-reject) must be sent as though no options 5538c2ecf20Sopenharmony_ci * had been negotiated. 5548c2ecf20Sopenharmony_ci */ 5558c2ecf20Sopenharmony_ci islcp = proto == PPP_LCP && 1 <= data[2] && data[2] <= 7; 5568c2ecf20Sopenharmony_ci 5578c2ecf20Sopenharmony_ci if (i == 0) { 5588c2ecf20Sopenharmony_ci if (islcp) 5598c2ecf20Sopenharmony_ci async_lcp_peek(ap, data, count, 0); 5608c2ecf20Sopenharmony_ci 5618c2ecf20Sopenharmony_ci /* 5628c2ecf20Sopenharmony_ci * Start of a new packet - insert the leading FLAG 5638c2ecf20Sopenharmony_ci * character if necessary. 5648c2ecf20Sopenharmony_ci */ 5658c2ecf20Sopenharmony_ci if (islcp || flag_time == 0 || 5668c2ecf20Sopenharmony_ci time_after_eq(jiffies, ap->last_xmit + flag_time)) 5678c2ecf20Sopenharmony_ci *buf++ = PPP_FLAG; 5688c2ecf20Sopenharmony_ci ap->last_xmit = jiffies; 5698c2ecf20Sopenharmony_ci fcs = PPP_INITFCS; 5708c2ecf20Sopenharmony_ci 5718c2ecf20Sopenharmony_ci /* 5728c2ecf20Sopenharmony_ci * Put in the address/control bytes if necessary 5738c2ecf20Sopenharmony_ci */ 5748c2ecf20Sopenharmony_ci if ((ap->flags & SC_COMP_AC) == 0 || islcp) { 5758c2ecf20Sopenharmony_ci PUT_BYTE(ap, buf, 0xff, islcp); 5768c2ecf20Sopenharmony_ci fcs = PPP_FCS(fcs, 0xff); 5778c2ecf20Sopenharmony_ci PUT_BYTE(ap, buf, 0x03, islcp); 5788c2ecf20Sopenharmony_ci fcs = PPP_FCS(fcs, 0x03); 5798c2ecf20Sopenharmony_ci } 5808c2ecf20Sopenharmony_ci } 5818c2ecf20Sopenharmony_ci 5828c2ecf20Sopenharmony_ci /* 5838c2ecf20Sopenharmony_ci * Once we put in the last byte, we need to put in the FCS 5848c2ecf20Sopenharmony_ci * and closing flag, so make sure there is at least 7 bytes 5858c2ecf20Sopenharmony_ci * of free space in the output buffer. 5868c2ecf20Sopenharmony_ci */ 5878c2ecf20Sopenharmony_ci buflim = ap->obuf + OBUFSIZE - 6; 5888c2ecf20Sopenharmony_ci while (i < count && buf < buflim) { 5898c2ecf20Sopenharmony_ci c = data[i++]; 5908c2ecf20Sopenharmony_ci if (i == 1 && c == 0 && (ap->flags & SC_COMP_PROT)) 5918c2ecf20Sopenharmony_ci continue; /* compress protocol field */ 5928c2ecf20Sopenharmony_ci fcs = PPP_FCS(fcs, c); 5938c2ecf20Sopenharmony_ci PUT_BYTE(ap, buf, c, islcp); 5948c2ecf20Sopenharmony_ci } 5958c2ecf20Sopenharmony_ci 5968c2ecf20Sopenharmony_ci if (i < count) { 5978c2ecf20Sopenharmony_ci /* 5988c2ecf20Sopenharmony_ci * Remember where we are up to in this packet. 5998c2ecf20Sopenharmony_ci */ 6008c2ecf20Sopenharmony_ci ap->olim = buf; 6018c2ecf20Sopenharmony_ci ap->tpkt_pos = i; 6028c2ecf20Sopenharmony_ci ap->tfcs = fcs; 6038c2ecf20Sopenharmony_ci return 0; 6048c2ecf20Sopenharmony_ci } 6058c2ecf20Sopenharmony_ci 6068c2ecf20Sopenharmony_ci /* 6078c2ecf20Sopenharmony_ci * We have finished the packet. Add the FCS and flag. 6088c2ecf20Sopenharmony_ci */ 6098c2ecf20Sopenharmony_ci fcs = ~fcs; 6108c2ecf20Sopenharmony_ci c = fcs & 0xff; 6118c2ecf20Sopenharmony_ci PUT_BYTE(ap, buf, c, islcp); 6128c2ecf20Sopenharmony_ci c = (fcs >> 8) & 0xff; 6138c2ecf20Sopenharmony_ci PUT_BYTE(ap, buf, c, islcp); 6148c2ecf20Sopenharmony_ci *buf++ = PPP_FLAG; 6158c2ecf20Sopenharmony_ci ap->olim = buf; 6168c2ecf20Sopenharmony_ci 6178c2ecf20Sopenharmony_ci consume_skb(ap->tpkt); 6188c2ecf20Sopenharmony_ci ap->tpkt = NULL; 6198c2ecf20Sopenharmony_ci return 1; 6208c2ecf20Sopenharmony_ci} 6218c2ecf20Sopenharmony_ci 6228c2ecf20Sopenharmony_ci/* 6238c2ecf20Sopenharmony_ci * Transmit-side routines. 6248c2ecf20Sopenharmony_ci */ 6258c2ecf20Sopenharmony_ci 6268c2ecf20Sopenharmony_ci/* 6278c2ecf20Sopenharmony_ci * Send a packet to the peer over an async tty line. 6288c2ecf20Sopenharmony_ci * Returns 1 iff the packet was accepted. 6298c2ecf20Sopenharmony_ci * If the packet was not accepted, we will call ppp_output_wakeup 6308c2ecf20Sopenharmony_ci * at some later time. 6318c2ecf20Sopenharmony_ci */ 6328c2ecf20Sopenharmony_cistatic int 6338c2ecf20Sopenharmony_cippp_async_send(struct ppp_channel *chan, struct sk_buff *skb) 6348c2ecf20Sopenharmony_ci{ 6358c2ecf20Sopenharmony_ci struct asyncppp *ap = chan->private; 6368c2ecf20Sopenharmony_ci 6378c2ecf20Sopenharmony_ci ppp_async_push(ap); 6388c2ecf20Sopenharmony_ci 6398c2ecf20Sopenharmony_ci if (test_and_set_bit(XMIT_FULL, &ap->xmit_flags)) 6408c2ecf20Sopenharmony_ci return 0; /* already full */ 6418c2ecf20Sopenharmony_ci ap->tpkt = skb; 6428c2ecf20Sopenharmony_ci ap->tpkt_pos = 0; 6438c2ecf20Sopenharmony_ci 6448c2ecf20Sopenharmony_ci ppp_async_push(ap); 6458c2ecf20Sopenharmony_ci return 1; 6468c2ecf20Sopenharmony_ci} 6478c2ecf20Sopenharmony_ci 6488c2ecf20Sopenharmony_ci/* 6498c2ecf20Sopenharmony_ci * Push as much data as possible out to the tty. 6508c2ecf20Sopenharmony_ci */ 6518c2ecf20Sopenharmony_cistatic int 6528c2ecf20Sopenharmony_cippp_async_push(struct asyncppp *ap) 6538c2ecf20Sopenharmony_ci{ 6548c2ecf20Sopenharmony_ci int avail, sent, done = 0; 6558c2ecf20Sopenharmony_ci struct tty_struct *tty = ap->tty; 6568c2ecf20Sopenharmony_ci int tty_stuffed = 0; 6578c2ecf20Sopenharmony_ci 6588c2ecf20Sopenharmony_ci /* 6598c2ecf20Sopenharmony_ci * We can get called recursively here if the tty write 6608c2ecf20Sopenharmony_ci * function calls our wakeup function. This can happen 6618c2ecf20Sopenharmony_ci * for example on a pty with both the master and slave 6628c2ecf20Sopenharmony_ci * set to PPP line discipline. 6638c2ecf20Sopenharmony_ci * We use the XMIT_BUSY bit to detect this and get out, 6648c2ecf20Sopenharmony_ci * leaving the XMIT_WAKEUP bit set to tell the other 6658c2ecf20Sopenharmony_ci * instance that it may now be able to write more now. 6668c2ecf20Sopenharmony_ci */ 6678c2ecf20Sopenharmony_ci if (test_and_set_bit(XMIT_BUSY, &ap->xmit_flags)) 6688c2ecf20Sopenharmony_ci return 0; 6698c2ecf20Sopenharmony_ci spin_lock_bh(&ap->xmit_lock); 6708c2ecf20Sopenharmony_ci for (;;) { 6718c2ecf20Sopenharmony_ci if (test_and_clear_bit(XMIT_WAKEUP, &ap->xmit_flags)) 6728c2ecf20Sopenharmony_ci tty_stuffed = 0; 6738c2ecf20Sopenharmony_ci if (!tty_stuffed && ap->optr < ap->olim) { 6748c2ecf20Sopenharmony_ci avail = ap->olim - ap->optr; 6758c2ecf20Sopenharmony_ci set_bit(TTY_DO_WRITE_WAKEUP, &tty->flags); 6768c2ecf20Sopenharmony_ci sent = tty->ops->write(tty, ap->optr, avail); 6778c2ecf20Sopenharmony_ci if (sent < 0) 6788c2ecf20Sopenharmony_ci goto flush; /* error, e.g. loss of CD */ 6798c2ecf20Sopenharmony_ci ap->optr += sent; 6808c2ecf20Sopenharmony_ci if (sent < avail) 6818c2ecf20Sopenharmony_ci tty_stuffed = 1; 6828c2ecf20Sopenharmony_ci continue; 6838c2ecf20Sopenharmony_ci } 6848c2ecf20Sopenharmony_ci if (ap->optr >= ap->olim && ap->tpkt) { 6858c2ecf20Sopenharmony_ci if (ppp_async_encode(ap)) { 6868c2ecf20Sopenharmony_ci /* finished processing ap->tpkt */ 6878c2ecf20Sopenharmony_ci clear_bit(XMIT_FULL, &ap->xmit_flags); 6888c2ecf20Sopenharmony_ci done = 1; 6898c2ecf20Sopenharmony_ci } 6908c2ecf20Sopenharmony_ci continue; 6918c2ecf20Sopenharmony_ci } 6928c2ecf20Sopenharmony_ci /* 6938c2ecf20Sopenharmony_ci * We haven't made any progress this time around. 6948c2ecf20Sopenharmony_ci * Clear XMIT_BUSY to let other callers in, but 6958c2ecf20Sopenharmony_ci * after doing so we have to check if anyone set 6968c2ecf20Sopenharmony_ci * XMIT_WAKEUP since we last checked it. If they 6978c2ecf20Sopenharmony_ci * did, we should try again to set XMIT_BUSY and go 6988c2ecf20Sopenharmony_ci * around again in case XMIT_BUSY was still set when 6998c2ecf20Sopenharmony_ci * the other caller tried. 7008c2ecf20Sopenharmony_ci */ 7018c2ecf20Sopenharmony_ci clear_bit(XMIT_BUSY, &ap->xmit_flags); 7028c2ecf20Sopenharmony_ci /* any more work to do? if not, exit the loop */ 7038c2ecf20Sopenharmony_ci if (!(test_bit(XMIT_WAKEUP, &ap->xmit_flags) || 7048c2ecf20Sopenharmony_ci (!tty_stuffed && ap->tpkt))) 7058c2ecf20Sopenharmony_ci break; 7068c2ecf20Sopenharmony_ci /* more work to do, see if we can do it now */ 7078c2ecf20Sopenharmony_ci if (test_and_set_bit(XMIT_BUSY, &ap->xmit_flags)) 7088c2ecf20Sopenharmony_ci break; 7098c2ecf20Sopenharmony_ci } 7108c2ecf20Sopenharmony_ci spin_unlock_bh(&ap->xmit_lock); 7118c2ecf20Sopenharmony_ci return done; 7128c2ecf20Sopenharmony_ci 7138c2ecf20Sopenharmony_ciflush: 7148c2ecf20Sopenharmony_ci clear_bit(XMIT_BUSY, &ap->xmit_flags); 7158c2ecf20Sopenharmony_ci if (ap->tpkt) { 7168c2ecf20Sopenharmony_ci kfree_skb(ap->tpkt); 7178c2ecf20Sopenharmony_ci ap->tpkt = NULL; 7188c2ecf20Sopenharmony_ci clear_bit(XMIT_FULL, &ap->xmit_flags); 7198c2ecf20Sopenharmony_ci done = 1; 7208c2ecf20Sopenharmony_ci } 7218c2ecf20Sopenharmony_ci ap->optr = ap->olim; 7228c2ecf20Sopenharmony_ci spin_unlock_bh(&ap->xmit_lock); 7238c2ecf20Sopenharmony_ci return done; 7248c2ecf20Sopenharmony_ci} 7258c2ecf20Sopenharmony_ci 7268c2ecf20Sopenharmony_ci/* 7278c2ecf20Sopenharmony_ci * Flush output from our internal buffers. 7288c2ecf20Sopenharmony_ci * Called for the TCFLSH ioctl. Can be entered in parallel 7298c2ecf20Sopenharmony_ci * but this is covered by the xmit_lock. 7308c2ecf20Sopenharmony_ci */ 7318c2ecf20Sopenharmony_cistatic void 7328c2ecf20Sopenharmony_cippp_async_flush_output(struct asyncppp *ap) 7338c2ecf20Sopenharmony_ci{ 7348c2ecf20Sopenharmony_ci int done = 0; 7358c2ecf20Sopenharmony_ci 7368c2ecf20Sopenharmony_ci spin_lock_bh(&ap->xmit_lock); 7378c2ecf20Sopenharmony_ci ap->optr = ap->olim; 7388c2ecf20Sopenharmony_ci if (ap->tpkt != NULL) { 7398c2ecf20Sopenharmony_ci kfree_skb(ap->tpkt); 7408c2ecf20Sopenharmony_ci ap->tpkt = NULL; 7418c2ecf20Sopenharmony_ci clear_bit(XMIT_FULL, &ap->xmit_flags); 7428c2ecf20Sopenharmony_ci done = 1; 7438c2ecf20Sopenharmony_ci } 7448c2ecf20Sopenharmony_ci spin_unlock_bh(&ap->xmit_lock); 7458c2ecf20Sopenharmony_ci if (done) 7468c2ecf20Sopenharmony_ci ppp_output_wakeup(&ap->chan); 7478c2ecf20Sopenharmony_ci} 7488c2ecf20Sopenharmony_ci 7498c2ecf20Sopenharmony_ci/* 7508c2ecf20Sopenharmony_ci * Receive-side routines. 7518c2ecf20Sopenharmony_ci */ 7528c2ecf20Sopenharmony_ci 7538c2ecf20Sopenharmony_ci/* see how many ordinary chars there are at the start of buf */ 7548c2ecf20Sopenharmony_cistatic inline int 7558c2ecf20Sopenharmony_ciscan_ordinary(struct asyncppp *ap, const unsigned char *buf, int count) 7568c2ecf20Sopenharmony_ci{ 7578c2ecf20Sopenharmony_ci int i, c; 7588c2ecf20Sopenharmony_ci 7598c2ecf20Sopenharmony_ci for (i = 0; i < count; ++i) { 7608c2ecf20Sopenharmony_ci c = buf[i]; 7618c2ecf20Sopenharmony_ci if (c == PPP_ESCAPE || c == PPP_FLAG || 7628c2ecf20Sopenharmony_ci (c < 0x20 && (ap->raccm & (1 << c)) != 0)) 7638c2ecf20Sopenharmony_ci break; 7648c2ecf20Sopenharmony_ci } 7658c2ecf20Sopenharmony_ci return i; 7668c2ecf20Sopenharmony_ci} 7678c2ecf20Sopenharmony_ci 7688c2ecf20Sopenharmony_ci/* called when a flag is seen - do end-of-packet processing */ 7698c2ecf20Sopenharmony_cistatic void 7708c2ecf20Sopenharmony_ciprocess_input_packet(struct asyncppp *ap) 7718c2ecf20Sopenharmony_ci{ 7728c2ecf20Sopenharmony_ci struct sk_buff *skb; 7738c2ecf20Sopenharmony_ci unsigned char *p; 7748c2ecf20Sopenharmony_ci unsigned int len, fcs; 7758c2ecf20Sopenharmony_ci 7768c2ecf20Sopenharmony_ci skb = ap->rpkt; 7778c2ecf20Sopenharmony_ci if (ap->state & (SC_TOSS | SC_ESCAPE)) 7788c2ecf20Sopenharmony_ci goto err; 7798c2ecf20Sopenharmony_ci 7808c2ecf20Sopenharmony_ci if (skb == NULL) 7818c2ecf20Sopenharmony_ci return; /* 0-length packet */ 7828c2ecf20Sopenharmony_ci 7838c2ecf20Sopenharmony_ci /* check the FCS */ 7848c2ecf20Sopenharmony_ci p = skb->data; 7858c2ecf20Sopenharmony_ci len = skb->len; 7868c2ecf20Sopenharmony_ci if (len < 3) 7878c2ecf20Sopenharmony_ci goto err; /* too short */ 7888c2ecf20Sopenharmony_ci fcs = PPP_INITFCS; 7898c2ecf20Sopenharmony_ci for (; len > 0; --len) 7908c2ecf20Sopenharmony_ci fcs = PPP_FCS(fcs, *p++); 7918c2ecf20Sopenharmony_ci if (fcs != PPP_GOODFCS) 7928c2ecf20Sopenharmony_ci goto err; /* bad FCS */ 7938c2ecf20Sopenharmony_ci skb_trim(skb, skb->len - 2); 7948c2ecf20Sopenharmony_ci 7958c2ecf20Sopenharmony_ci /* check for address/control and protocol compression */ 7968c2ecf20Sopenharmony_ci p = skb->data; 7978c2ecf20Sopenharmony_ci if (p[0] == PPP_ALLSTATIONS) { 7988c2ecf20Sopenharmony_ci /* chop off address/control */ 7998c2ecf20Sopenharmony_ci if (p[1] != PPP_UI || skb->len < 3) 8008c2ecf20Sopenharmony_ci goto err; 8018c2ecf20Sopenharmony_ci p = skb_pull(skb, 2); 8028c2ecf20Sopenharmony_ci } 8038c2ecf20Sopenharmony_ci 8048c2ecf20Sopenharmony_ci /* If protocol field is not compressed, it can be LCP packet */ 8058c2ecf20Sopenharmony_ci if (!(p[0] & 0x01)) { 8068c2ecf20Sopenharmony_ci unsigned int proto; 8078c2ecf20Sopenharmony_ci 8088c2ecf20Sopenharmony_ci if (skb->len < 2) 8098c2ecf20Sopenharmony_ci goto err; 8108c2ecf20Sopenharmony_ci proto = (p[0] << 8) + p[1]; 8118c2ecf20Sopenharmony_ci if (proto == PPP_LCP) 8128c2ecf20Sopenharmony_ci async_lcp_peek(ap, p, skb->len, 1); 8138c2ecf20Sopenharmony_ci } 8148c2ecf20Sopenharmony_ci 8158c2ecf20Sopenharmony_ci /* queue the frame to be processed */ 8168c2ecf20Sopenharmony_ci skb->cb[0] = ap->state; 8178c2ecf20Sopenharmony_ci skb_queue_tail(&ap->rqueue, skb); 8188c2ecf20Sopenharmony_ci ap->rpkt = NULL; 8198c2ecf20Sopenharmony_ci ap->state = 0; 8208c2ecf20Sopenharmony_ci return; 8218c2ecf20Sopenharmony_ci 8228c2ecf20Sopenharmony_ci err: 8238c2ecf20Sopenharmony_ci /* frame had an error, remember that, reset SC_TOSS & SC_ESCAPE */ 8248c2ecf20Sopenharmony_ci ap->state = SC_PREV_ERROR; 8258c2ecf20Sopenharmony_ci if (skb) { 8268c2ecf20Sopenharmony_ci /* make skb appear as freshly allocated */ 8278c2ecf20Sopenharmony_ci skb_trim(skb, 0); 8288c2ecf20Sopenharmony_ci skb_reserve(skb, - skb_headroom(skb)); 8298c2ecf20Sopenharmony_ci } 8308c2ecf20Sopenharmony_ci} 8318c2ecf20Sopenharmony_ci 8328c2ecf20Sopenharmony_ci/* Called when the tty driver has data for us. Runs parallel with the 8338c2ecf20Sopenharmony_ci other ldisc functions but will not be re-entered */ 8348c2ecf20Sopenharmony_ci 8358c2ecf20Sopenharmony_cistatic void 8368c2ecf20Sopenharmony_cippp_async_input(struct asyncppp *ap, const unsigned char *buf, 8378c2ecf20Sopenharmony_ci char *flags, int count) 8388c2ecf20Sopenharmony_ci{ 8398c2ecf20Sopenharmony_ci struct sk_buff *skb; 8408c2ecf20Sopenharmony_ci int c, i, j, n, s, f; 8418c2ecf20Sopenharmony_ci unsigned char *sp; 8428c2ecf20Sopenharmony_ci 8438c2ecf20Sopenharmony_ci /* update bits used for 8-bit cleanness detection */ 8448c2ecf20Sopenharmony_ci if (~ap->rbits & SC_RCV_BITS) { 8458c2ecf20Sopenharmony_ci s = 0; 8468c2ecf20Sopenharmony_ci for (i = 0; i < count; ++i) { 8478c2ecf20Sopenharmony_ci c = buf[i]; 8488c2ecf20Sopenharmony_ci if (flags && flags[i] != 0) 8498c2ecf20Sopenharmony_ci continue; 8508c2ecf20Sopenharmony_ci s |= (c & 0x80)? SC_RCV_B7_1: SC_RCV_B7_0; 8518c2ecf20Sopenharmony_ci c = ((c >> 4) ^ c) & 0xf; 8528c2ecf20Sopenharmony_ci s |= (0x6996 & (1 << c))? SC_RCV_ODDP: SC_RCV_EVNP; 8538c2ecf20Sopenharmony_ci } 8548c2ecf20Sopenharmony_ci ap->rbits |= s; 8558c2ecf20Sopenharmony_ci } 8568c2ecf20Sopenharmony_ci 8578c2ecf20Sopenharmony_ci while (count > 0) { 8588c2ecf20Sopenharmony_ci /* scan through and see how many chars we can do in bulk */ 8598c2ecf20Sopenharmony_ci if ((ap->state & SC_ESCAPE) && buf[0] == PPP_ESCAPE) 8608c2ecf20Sopenharmony_ci n = 1; 8618c2ecf20Sopenharmony_ci else 8628c2ecf20Sopenharmony_ci n = scan_ordinary(ap, buf, count); 8638c2ecf20Sopenharmony_ci 8648c2ecf20Sopenharmony_ci f = 0; 8658c2ecf20Sopenharmony_ci if (flags && (ap->state & SC_TOSS) == 0) { 8668c2ecf20Sopenharmony_ci /* check the flags to see if any char had an error */ 8678c2ecf20Sopenharmony_ci for (j = 0; j < n; ++j) 8688c2ecf20Sopenharmony_ci if ((f = flags[j]) != 0) 8698c2ecf20Sopenharmony_ci break; 8708c2ecf20Sopenharmony_ci } 8718c2ecf20Sopenharmony_ci if (f != 0) { 8728c2ecf20Sopenharmony_ci /* start tossing */ 8738c2ecf20Sopenharmony_ci ap->state |= SC_TOSS; 8748c2ecf20Sopenharmony_ci 8758c2ecf20Sopenharmony_ci } else if (n > 0 && (ap->state & SC_TOSS) == 0) { 8768c2ecf20Sopenharmony_ci /* stuff the chars in the skb */ 8778c2ecf20Sopenharmony_ci skb = ap->rpkt; 8788c2ecf20Sopenharmony_ci if (!skb) { 8798c2ecf20Sopenharmony_ci skb = dev_alloc_skb(ap->mru + PPP_HDRLEN + 2); 8808c2ecf20Sopenharmony_ci if (!skb) 8818c2ecf20Sopenharmony_ci goto nomem; 8828c2ecf20Sopenharmony_ci ap->rpkt = skb; 8838c2ecf20Sopenharmony_ci } 8848c2ecf20Sopenharmony_ci if (skb->len == 0) { 8858c2ecf20Sopenharmony_ci /* Try to get the payload 4-byte aligned. 8868c2ecf20Sopenharmony_ci * This should match the 8878c2ecf20Sopenharmony_ci * PPP_ALLSTATIONS/PPP_UI/compressed tests in 8888c2ecf20Sopenharmony_ci * process_input_packet, but we do not have 8898c2ecf20Sopenharmony_ci * enough chars here to test buf[1] and buf[2]. 8908c2ecf20Sopenharmony_ci */ 8918c2ecf20Sopenharmony_ci if (buf[0] != PPP_ALLSTATIONS) 8928c2ecf20Sopenharmony_ci skb_reserve(skb, 2 + (buf[0] & 1)); 8938c2ecf20Sopenharmony_ci } 8948c2ecf20Sopenharmony_ci if (n > skb_tailroom(skb)) { 8958c2ecf20Sopenharmony_ci /* packet overflowed MRU */ 8968c2ecf20Sopenharmony_ci ap->state |= SC_TOSS; 8978c2ecf20Sopenharmony_ci } else { 8988c2ecf20Sopenharmony_ci sp = skb_put_data(skb, buf, n); 8998c2ecf20Sopenharmony_ci if (ap->state & SC_ESCAPE) { 9008c2ecf20Sopenharmony_ci sp[0] ^= PPP_TRANS; 9018c2ecf20Sopenharmony_ci ap->state &= ~SC_ESCAPE; 9028c2ecf20Sopenharmony_ci } 9038c2ecf20Sopenharmony_ci } 9048c2ecf20Sopenharmony_ci } 9058c2ecf20Sopenharmony_ci 9068c2ecf20Sopenharmony_ci if (n >= count) 9078c2ecf20Sopenharmony_ci break; 9088c2ecf20Sopenharmony_ci 9098c2ecf20Sopenharmony_ci c = buf[n]; 9108c2ecf20Sopenharmony_ci if (flags != NULL && flags[n] != 0) { 9118c2ecf20Sopenharmony_ci ap->state |= SC_TOSS; 9128c2ecf20Sopenharmony_ci } else if (c == PPP_FLAG) { 9138c2ecf20Sopenharmony_ci process_input_packet(ap); 9148c2ecf20Sopenharmony_ci } else if (c == PPP_ESCAPE) { 9158c2ecf20Sopenharmony_ci ap->state |= SC_ESCAPE; 9168c2ecf20Sopenharmony_ci } else if (I_IXON(ap->tty)) { 9178c2ecf20Sopenharmony_ci if (c == START_CHAR(ap->tty)) 9188c2ecf20Sopenharmony_ci start_tty(ap->tty); 9198c2ecf20Sopenharmony_ci else if (c == STOP_CHAR(ap->tty)) 9208c2ecf20Sopenharmony_ci stop_tty(ap->tty); 9218c2ecf20Sopenharmony_ci } 9228c2ecf20Sopenharmony_ci /* otherwise it's a char in the recv ACCM */ 9238c2ecf20Sopenharmony_ci ++n; 9248c2ecf20Sopenharmony_ci 9258c2ecf20Sopenharmony_ci buf += n; 9268c2ecf20Sopenharmony_ci if (flags) 9278c2ecf20Sopenharmony_ci flags += n; 9288c2ecf20Sopenharmony_ci count -= n; 9298c2ecf20Sopenharmony_ci } 9308c2ecf20Sopenharmony_ci return; 9318c2ecf20Sopenharmony_ci 9328c2ecf20Sopenharmony_ci nomem: 9338c2ecf20Sopenharmony_ci printk(KERN_ERR "PPPasync: no memory (input pkt)\n"); 9348c2ecf20Sopenharmony_ci ap->state |= SC_TOSS; 9358c2ecf20Sopenharmony_ci} 9368c2ecf20Sopenharmony_ci 9378c2ecf20Sopenharmony_ci/* 9388c2ecf20Sopenharmony_ci * We look at LCP frames going past so that we can notice 9398c2ecf20Sopenharmony_ci * and react to the LCP configure-ack from the peer. 9408c2ecf20Sopenharmony_ci * In the situation where the peer has been sent a configure-ack 9418c2ecf20Sopenharmony_ci * already, LCP is up once it has sent its configure-ack 9428c2ecf20Sopenharmony_ci * so the immediately following packet can be sent with the 9438c2ecf20Sopenharmony_ci * configured LCP options. This allows us to process the following 9448c2ecf20Sopenharmony_ci * packet correctly without pppd needing to respond quickly. 9458c2ecf20Sopenharmony_ci * 9468c2ecf20Sopenharmony_ci * We only respond to the received configure-ack if we have just 9478c2ecf20Sopenharmony_ci * sent a configure-request, and the configure-ack contains the 9488c2ecf20Sopenharmony_ci * same data (this is checked using a 16-bit crc of the data). 9498c2ecf20Sopenharmony_ci */ 9508c2ecf20Sopenharmony_ci#define CONFREQ 1 /* LCP code field values */ 9518c2ecf20Sopenharmony_ci#define CONFACK 2 9528c2ecf20Sopenharmony_ci#define LCP_MRU 1 /* LCP option numbers */ 9538c2ecf20Sopenharmony_ci#define LCP_ASYNCMAP 2 9548c2ecf20Sopenharmony_ci 9558c2ecf20Sopenharmony_cistatic void async_lcp_peek(struct asyncppp *ap, unsigned char *data, 9568c2ecf20Sopenharmony_ci int len, int inbound) 9578c2ecf20Sopenharmony_ci{ 9588c2ecf20Sopenharmony_ci int dlen, fcs, i, code; 9598c2ecf20Sopenharmony_ci u32 val; 9608c2ecf20Sopenharmony_ci 9618c2ecf20Sopenharmony_ci data += 2; /* skip protocol bytes */ 9628c2ecf20Sopenharmony_ci len -= 2; 9638c2ecf20Sopenharmony_ci if (len < 4) /* 4 = code, ID, length */ 9648c2ecf20Sopenharmony_ci return; 9658c2ecf20Sopenharmony_ci code = data[0]; 9668c2ecf20Sopenharmony_ci if (code != CONFACK && code != CONFREQ) 9678c2ecf20Sopenharmony_ci return; 9688c2ecf20Sopenharmony_ci dlen = get_unaligned_be16(data + 2); 9698c2ecf20Sopenharmony_ci if (len < dlen) 9708c2ecf20Sopenharmony_ci return; /* packet got truncated or length is bogus */ 9718c2ecf20Sopenharmony_ci 9728c2ecf20Sopenharmony_ci if (code == (inbound? CONFACK: CONFREQ)) { 9738c2ecf20Sopenharmony_ci /* 9748c2ecf20Sopenharmony_ci * sent confreq or received confack: 9758c2ecf20Sopenharmony_ci * calculate the crc of the data from the ID field on. 9768c2ecf20Sopenharmony_ci */ 9778c2ecf20Sopenharmony_ci fcs = PPP_INITFCS; 9788c2ecf20Sopenharmony_ci for (i = 1; i < dlen; ++i) 9798c2ecf20Sopenharmony_ci fcs = PPP_FCS(fcs, data[i]); 9808c2ecf20Sopenharmony_ci 9818c2ecf20Sopenharmony_ci if (!inbound) { 9828c2ecf20Sopenharmony_ci /* outbound confreq - remember the crc for later */ 9838c2ecf20Sopenharmony_ci ap->lcp_fcs = fcs; 9848c2ecf20Sopenharmony_ci return; 9858c2ecf20Sopenharmony_ci } 9868c2ecf20Sopenharmony_ci 9878c2ecf20Sopenharmony_ci /* received confack, check the crc */ 9888c2ecf20Sopenharmony_ci fcs ^= ap->lcp_fcs; 9898c2ecf20Sopenharmony_ci ap->lcp_fcs = -1; 9908c2ecf20Sopenharmony_ci if (fcs != 0) 9918c2ecf20Sopenharmony_ci return; 9928c2ecf20Sopenharmony_ci } else if (inbound) 9938c2ecf20Sopenharmony_ci return; /* not interested in received confreq */ 9948c2ecf20Sopenharmony_ci 9958c2ecf20Sopenharmony_ci /* process the options in the confack */ 9968c2ecf20Sopenharmony_ci data += 4; 9978c2ecf20Sopenharmony_ci dlen -= 4; 9988c2ecf20Sopenharmony_ci /* data[0] is code, data[1] is length */ 9998c2ecf20Sopenharmony_ci while (dlen >= 2 && dlen >= data[1] && data[1] >= 2) { 10008c2ecf20Sopenharmony_ci switch (data[0]) { 10018c2ecf20Sopenharmony_ci case LCP_MRU: 10028c2ecf20Sopenharmony_ci val = get_unaligned_be16(data + 2); 10038c2ecf20Sopenharmony_ci if (inbound) 10048c2ecf20Sopenharmony_ci ap->mru = val; 10058c2ecf20Sopenharmony_ci else 10068c2ecf20Sopenharmony_ci ap->chan.mtu = val; 10078c2ecf20Sopenharmony_ci break; 10088c2ecf20Sopenharmony_ci case LCP_ASYNCMAP: 10098c2ecf20Sopenharmony_ci val = get_unaligned_be32(data + 2); 10108c2ecf20Sopenharmony_ci if (inbound) 10118c2ecf20Sopenharmony_ci ap->raccm = val; 10128c2ecf20Sopenharmony_ci else 10138c2ecf20Sopenharmony_ci ap->xaccm[0] = val; 10148c2ecf20Sopenharmony_ci break; 10158c2ecf20Sopenharmony_ci } 10168c2ecf20Sopenharmony_ci dlen -= data[1]; 10178c2ecf20Sopenharmony_ci data += data[1]; 10188c2ecf20Sopenharmony_ci } 10198c2ecf20Sopenharmony_ci} 10208c2ecf20Sopenharmony_ci 10218c2ecf20Sopenharmony_cistatic void __exit ppp_async_cleanup(void) 10228c2ecf20Sopenharmony_ci{ 10238c2ecf20Sopenharmony_ci if (tty_unregister_ldisc(N_PPP) != 0) 10248c2ecf20Sopenharmony_ci printk(KERN_ERR "failed to unregister PPP line discipline\n"); 10258c2ecf20Sopenharmony_ci} 10268c2ecf20Sopenharmony_ci 10278c2ecf20Sopenharmony_cimodule_init(ppp_async_init); 10288c2ecf20Sopenharmony_cimodule_exit(ppp_async_cleanup); 1029