提交 b1c43f82 编写于 作者: F Felipe Balbi 提交者: Greg Kroah-Hartman

tty: make receive_buf() return the amout of bytes received

it makes it simpler to keep track of the amount of
bytes received and simplifies how flush_to_ldisc counts
the remaining bytes. It also fixes a bug of lost bytes
on n_tty when flushing too many bytes via the USB
serial gadget driver.
Tested-by: NStefan Bigler <stefan.bigler@keymile.com>
Tested-by: NToby Gray <toby.gray@realvnc.com>
Signed-off-by: NFelipe Balbi <balbi@ti.com>
Signed-off-by: NGreg Kroah-Hartman <gregkh@suse.de>
上级 e9a470f4
...@@ -357,22 +357,26 @@ static void hci_uart_tty_wakeup(struct tty_struct *tty) ...@@ -357,22 +357,26 @@ static void hci_uart_tty_wakeup(struct tty_struct *tty)
* *
* Return Value: None * Return Value: None
*/ */
static void hci_uart_tty_receive(struct tty_struct *tty, const u8 *data, char *flags, int count) static unsigned int hci_uart_tty_receive(struct tty_struct *tty,
const u8 *data, char *flags, int count)
{ {
struct hci_uart *hu = (void *)tty->disc_data; struct hci_uart *hu = (void *)tty->disc_data;
int received;
if (!hu || tty != hu->tty) if (!hu || tty != hu->tty)
return; return -ENODEV;
if (!test_bit(HCI_UART_PROTO_SET, &hu->flags)) if (!test_bit(HCI_UART_PROTO_SET, &hu->flags))
return; return -EINVAL;
spin_lock(&hu->rx_lock); spin_lock(&hu->rx_lock);
hu->proto->recv(hu, (void *) data, count); received = hu->proto->recv(hu, (void *) data, count);
hu->hdev->stat.byte_rx += count; hu->hdev->stat.byte_rx += count;
spin_unlock(&hu->rx_lock); spin_unlock(&hu->rx_lock);
tty_unthrottle(tty); tty_unthrottle(tty);
return received;
} }
static int hci_uart_register_dev(struct hci_uart *hu) static int hci_uart_register_dev(struct hci_uart *hu)
......
...@@ -120,17 +120,21 @@ static void serport_ldisc_close(struct tty_struct *tty) ...@@ -120,17 +120,21 @@ static void serport_ldisc_close(struct tty_struct *tty)
* 'interrupt' routine. * 'interrupt' routine.
*/ */
static void serport_ldisc_receive(struct tty_struct *tty, const unsigned char *cp, char *fp, int count) static unsigned int serport_ldisc_receive(struct tty_struct *tty,
const unsigned char *cp, char *fp, int count)
{ {
struct serport *serport = (struct serport*) tty->disc_data; struct serport *serport = (struct serport*) tty->disc_data;
unsigned long flags; unsigned long flags;
unsigned int ch_flags; unsigned int ch_flags;
int ret = 0;
int i; int i;
spin_lock_irqsave(&serport->lock, flags); spin_lock_irqsave(&serport->lock, flags);
if (!test_bit(SERPORT_ACTIVE, &serport->flags)) if (!test_bit(SERPORT_ACTIVE, &serport->flags)) {
ret = -EINVAL;
goto out; goto out;
}
for (i = 0; i < count; i++) { for (i = 0; i < count; i++) {
switch (fp[i]) { switch (fp[i]) {
...@@ -152,6 +156,8 @@ static void serport_ldisc_receive(struct tty_struct *tty, const unsigned char *c ...@@ -152,6 +156,8 @@ static void serport_ldisc_receive(struct tty_struct *tty, const unsigned char *c
out: out:
spin_unlock_irqrestore(&serport->lock, flags); spin_unlock_irqrestore(&serport->lock, flags);
return ret == 0 ? count : ret;
} }
/* /*
......
...@@ -674,7 +674,7 @@ gigaset_tty_ioctl(struct tty_struct *tty, struct file *file, ...@@ -674,7 +674,7 @@ gigaset_tty_ioctl(struct tty_struct *tty, struct file *file,
* cflags buffer containing error flags for received characters (ignored) * cflags buffer containing error flags for received characters (ignored)
* count number of received characters * count number of received characters
*/ */
static void static unsigned int
gigaset_tty_receive(struct tty_struct *tty, const unsigned char *buf, gigaset_tty_receive(struct tty_struct *tty, const unsigned char *buf,
char *cflags, int count) char *cflags, int count)
{ {
...@@ -683,12 +683,12 @@ gigaset_tty_receive(struct tty_struct *tty, const unsigned char *buf, ...@@ -683,12 +683,12 @@ gigaset_tty_receive(struct tty_struct *tty, const unsigned char *buf,
struct inbuf_t *inbuf; struct inbuf_t *inbuf;
if (!cs) if (!cs)
return; return -ENODEV;
inbuf = cs->inbuf; inbuf = cs->inbuf;
if (!inbuf) { if (!inbuf) {
dev_err(cs->dev, "%s: no inbuf\n", __func__); dev_err(cs->dev, "%s: no inbuf\n", __func__);
cs_put(cs); cs_put(cs);
return; return -EINVAL;
} }
tail = inbuf->tail; tail = inbuf->tail;
...@@ -725,6 +725,8 @@ gigaset_tty_receive(struct tty_struct *tty, const unsigned char *buf, ...@@ -725,6 +725,8 @@ gigaset_tty_receive(struct tty_struct *tty, const unsigned char *buf,
gig_dbg(DEBUG_INTR, "%s-->BH", __func__); gig_dbg(DEBUG_INTR, "%s-->BH", __func__);
gigaset_schedule_event(cs); gigaset_schedule_event(cs);
cs_put(cs); cs_put(cs);
return count;
} }
/* /*
......
...@@ -744,8 +744,8 @@ static void st_tty_close(struct tty_struct *tty) ...@@ -744,8 +744,8 @@ static void st_tty_close(struct tty_struct *tty)
pr_debug("%s: done ", __func__); pr_debug("%s: done ", __func__);
} }
static void st_tty_receive(struct tty_struct *tty, const unsigned char *data, static unsigned int st_tty_receive(struct tty_struct *tty,
char *tty_flags, int count) const unsigned char *data, char *tty_flags, int count)
{ {
#ifdef VERBOSE #ifdef VERBOSE
print_hex_dump(KERN_DEBUG, ">in>", DUMP_PREFIX_NONE, print_hex_dump(KERN_DEBUG, ">in>", DUMP_PREFIX_NONE,
...@@ -758,6 +758,8 @@ static void st_tty_receive(struct tty_struct *tty, const unsigned char *data, ...@@ -758,6 +758,8 @@ static void st_tty_receive(struct tty_struct *tty, const unsigned char *data,
*/ */
st_recv(tty->disc_data, data, count); st_recv(tty->disc_data, data, count);
pr_debug("done %s", __func__); pr_debug("done %s", __func__);
return count;
} }
/* wake-up function called in from the TTY layer /* wake-up function called in from the TTY layer
......
...@@ -167,8 +167,8 @@ static inline void debugfs_tx(struct ser_device *ser, const u8 *data, int size) ...@@ -167,8 +167,8 @@ static inline void debugfs_tx(struct ser_device *ser, const u8 *data, int size)
#endif #endif
static void ldisc_receive(struct tty_struct *tty, const u8 *data, static unsigned int ldisc_receive(struct tty_struct *tty,
char *flags, int count) const u8 *data, char *flags, int count)
{ {
struct sk_buff *skb = NULL; struct sk_buff *skb = NULL;
struct ser_device *ser; struct ser_device *ser;
...@@ -215,6 +215,8 @@ static void ldisc_receive(struct tty_struct *tty, const u8 *data, ...@@ -215,6 +215,8 @@ static void ldisc_receive(struct tty_struct *tty, const u8 *data,
} else } else
++ser->dev->stats.rx_dropped; ++ser->dev->stats.rx_dropped;
update_tty_status(ser); update_tty_status(ser);
return count;
} }
static int handle_tx(struct ser_device *ser) static int handle_tx(struct ser_device *ser)
......
...@@ -425,16 +425,17 @@ static void slc_setup(struct net_device *dev) ...@@ -425,16 +425,17 @@ static void slc_setup(struct net_device *dev)
* in parallel * in parallel
*/ */
static void slcan_receive_buf(struct tty_struct *tty, static unsigned int slcan_receive_buf(struct tty_struct *tty,
const unsigned char *cp, char *fp, int count) const unsigned char *cp, char *fp, int count)
{ {
struct slcan *sl = (struct slcan *) tty->disc_data; struct slcan *sl = (struct slcan *) tty->disc_data;
int bytes = count;
if (!sl || sl->magic != SLCAN_MAGIC || !netif_running(sl->dev)) if (!sl || sl->magic != SLCAN_MAGIC || !netif_running(sl->dev))
return; return -ENODEV;
/* Read the characters out of the buffer */ /* Read the characters out of the buffer */
while (count--) { while (bytes--) {
if (fp && *fp++) { if (fp && *fp++) {
if (!test_and_set_bit(SLF_ERROR, &sl->flags)) if (!test_and_set_bit(SLF_ERROR, &sl->flags))
sl->dev->stats.rx_errors++; sl->dev->stats.rx_errors++;
...@@ -443,6 +444,8 @@ static void slcan_receive_buf(struct tty_struct *tty, ...@@ -443,6 +444,8 @@ static void slcan_receive_buf(struct tty_struct *tty,
} }
slcan_unesc(sl, *cp++); slcan_unesc(sl, *cp++);
} }
return count;
} }
/************************************ /************************************
......
...@@ -456,7 +456,7 @@ static void sixpack_write_wakeup(struct tty_struct *tty) ...@@ -456,7 +456,7 @@ static void sixpack_write_wakeup(struct tty_struct *tty)
* a block of 6pack data has been received, which can now be decapsulated * a block of 6pack data has been received, which can now be decapsulated
* and sent on to some IP layer for further processing. * and sent on to some IP layer for further processing.
*/ */
static void sixpack_receive_buf(struct tty_struct *tty, static unsigned int sixpack_receive_buf(struct tty_struct *tty,
const unsigned char *cp, char *fp, int count) const unsigned char *cp, char *fp, int count)
{ {
struct sixpack *sp; struct sixpack *sp;
...@@ -464,11 +464,11 @@ static void sixpack_receive_buf(struct tty_struct *tty, ...@@ -464,11 +464,11 @@ static void sixpack_receive_buf(struct tty_struct *tty,
int count1; int count1;
if (!count) if (!count)
return; return 0;
sp = sp_get(tty); sp = sp_get(tty);
if (!sp) if (!sp)
return; return -ENODEV;
memcpy(buf, cp, count < sizeof(buf) ? count : sizeof(buf)); memcpy(buf, cp, count < sizeof(buf) ? count : sizeof(buf));
...@@ -487,6 +487,8 @@ static void sixpack_receive_buf(struct tty_struct *tty, ...@@ -487,6 +487,8 @@ static void sixpack_receive_buf(struct tty_struct *tty,
sp_put(sp); sp_put(sp);
tty_unthrottle(tty); tty_unthrottle(tty);
return count1;
} }
/* /*
......
...@@ -923,13 +923,14 @@ static long mkiss_compat_ioctl(struct tty_struct *tty, struct file *file, ...@@ -923,13 +923,14 @@ static long mkiss_compat_ioctl(struct tty_struct *tty, struct file *file,
* a block of data has been received, which can now be decapsulated * a block of data has been received, which can now be decapsulated
* and sent on to the AX.25 layer for further processing. * and sent on to the AX.25 layer for further processing.
*/ */
static void mkiss_receive_buf(struct tty_struct *tty, const unsigned char *cp, static unsigned int mkiss_receive_buf(struct tty_struct *tty,
char *fp, int count) const unsigned char *cp, char *fp, int count)
{ {
struct mkiss *ax = mkiss_get(tty); struct mkiss *ax = mkiss_get(tty);
int bytes = count;
if (!ax) if (!ax)
return; return -ENODEV;
/* /*
* Argh! mtu change time! - costs us the packet part received * Argh! mtu change time! - costs us the packet part received
...@@ -939,7 +940,7 @@ static void mkiss_receive_buf(struct tty_struct *tty, const unsigned char *cp, ...@@ -939,7 +940,7 @@ static void mkiss_receive_buf(struct tty_struct *tty, const unsigned char *cp,
ax_changedmtu(ax); ax_changedmtu(ax);
/* Read the characters out of the buffer */ /* Read the characters out of the buffer */
while (count--) { while (bytes--) {
if (fp != NULL && *fp++) { if (fp != NULL && *fp++) {
if (!test_and_set_bit(AXF_ERROR, &ax->flags)) if (!test_and_set_bit(AXF_ERROR, &ax->flags))
ax->dev->stats.rx_errors++; ax->dev->stats.rx_errors++;
...@@ -952,6 +953,8 @@ static void mkiss_receive_buf(struct tty_struct *tty, const unsigned char *cp, ...@@ -952,6 +953,8 @@ static void mkiss_receive_buf(struct tty_struct *tty, const unsigned char *cp,
mkiss_put(ax); mkiss_put(ax);
tty_unthrottle(tty); tty_unthrottle(tty);
return count;
} }
/* /*
......
...@@ -216,23 +216,23 @@ static int irtty_do_write(struct sir_dev *dev, const unsigned char *ptr, size_t ...@@ -216,23 +216,23 @@ static int irtty_do_write(struct sir_dev *dev, const unsigned char *ptr, size_t
* usbserial: urb-complete-interrupt / softint * usbserial: urb-complete-interrupt / softint
*/ */
static void irtty_receive_buf(struct tty_struct *tty, const unsigned char *cp, static unsigned int irtty_receive_buf(struct tty_struct *tty,
char *fp, int count) const unsigned char *cp, char *fp, int count)
{ {
struct sir_dev *dev; struct sir_dev *dev;
struct sirtty_cb *priv = tty->disc_data; struct sirtty_cb *priv = tty->disc_data;
int i; int i;
IRDA_ASSERT(priv != NULL, return;); IRDA_ASSERT(priv != NULL, return -ENODEV;);
IRDA_ASSERT(priv->magic == IRTTY_MAGIC, return;); IRDA_ASSERT(priv->magic == IRTTY_MAGIC, return -EINVAL;);
if (unlikely(count==0)) /* yes, this happens */ if (unlikely(count==0)) /* yes, this happens */
return; return 0;
dev = priv->dev; dev = priv->dev;
if (!dev) { if (!dev) {
IRDA_WARNING("%s(), not ready yet!\n", __func__); IRDA_WARNING("%s(), not ready yet!\n", __func__);
return; return -ENODEV;
} }
for (i = 0; i < count; i++) { for (i = 0; i < count; i++) {
...@@ -242,11 +242,13 @@ static void irtty_receive_buf(struct tty_struct *tty, const unsigned char *cp, ...@@ -242,11 +242,13 @@ static void irtty_receive_buf(struct tty_struct *tty, const unsigned char *cp,
if (fp && *fp++) { if (fp && *fp++) {
IRDA_DEBUG(0, "Framing or parity error!\n"); IRDA_DEBUG(0, "Framing or parity error!\n");
sirdev_receive(dev, NULL, 0); /* notify sir_dev (updating stats) */ sirdev_receive(dev, NULL, 0); /* notify sir_dev (updating stats) */
return; return -EINVAL;
} }
} }
sirdev_receive(dev, cp, count); sirdev_receive(dev, cp, count);
return count;
} }
/* /*
......
...@@ -340,7 +340,7 @@ ppp_asynctty_poll(struct tty_struct *tty, struct file *file, poll_table *wait) ...@@ -340,7 +340,7 @@ ppp_asynctty_poll(struct tty_struct *tty, struct file *file, poll_table *wait)
} }
/* May sleep, don't call from interrupt level or with interrupts disabled */ /* May sleep, don't call from interrupt level or with interrupts disabled */
static void static unsigned int
ppp_asynctty_receive(struct tty_struct *tty, const unsigned char *buf, ppp_asynctty_receive(struct tty_struct *tty, const unsigned char *buf,
char *cflags, int count) char *cflags, int count)
{ {
...@@ -348,7 +348,7 @@ ppp_asynctty_receive(struct tty_struct *tty, const unsigned char *buf, ...@@ -348,7 +348,7 @@ ppp_asynctty_receive(struct tty_struct *tty, const unsigned char *buf,
unsigned long flags; unsigned long flags;
if (!ap) if (!ap)
return; return -ENODEV;
spin_lock_irqsave(&ap->recv_lock, flags); spin_lock_irqsave(&ap->recv_lock, flags);
ppp_async_input(ap, buf, cflags, count); ppp_async_input(ap, buf, cflags, count);
spin_unlock_irqrestore(&ap->recv_lock, flags); spin_unlock_irqrestore(&ap->recv_lock, flags);
...@@ -356,6 +356,8 @@ ppp_asynctty_receive(struct tty_struct *tty, const unsigned char *buf, ...@@ -356,6 +356,8 @@ ppp_asynctty_receive(struct tty_struct *tty, const unsigned char *buf,
tasklet_schedule(&ap->tsk); tasklet_schedule(&ap->tsk);
ap_put(ap); ap_put(ap);
tty_unthrottle(tty); tty_unthrottle(tty);
return count;
} }
static void static void
......
...@@ -381,7 +381,7 @@ ppp_sync_poll(struct tty_struct *tty, struct file *file, poll_table *wait) ...@@ -381,7 +381,7 @@ ppp_sync_poll(struct tty_struct *tty, struct file *file, poll_table *wait)
} }
/* May sleep, don't call from interrupt level or with interrupts disabled */ /* May sleep, don't call from interrupt level or with interrupts disabled */
static void static unsigned int
ppp_sync_receive(struct tty_struct *tty, const unsigned char *buf, ppp_sync_receive(struct tty_struct *tty, const unsigned char *buf,
char *cflags, int count) char *cflags, int count)
{ {
...@@ -389,7 +389,7 @@ ppp_sync_receive(struct tty_struct *tty, const unsigned char *buf, ...@@ -389,7 +389,7 @@ ppp_sync_receive(struct tty_struct *tty, const unsigned char *buf,
unsigned long flags; unsigned long flags;
if (!ap) if (!ap)
return; return -ENODEV;
spin_lock_irqsave(&ap->recv_lock, flags); spin_lock_irqsave(&ap->recv_lock, flags);
ppp_sync_input(ap, buf, cflags, count); ppp_sync_input(ap, buf, cflags, count);
spin_unlock_irqrestore(&ap->recv_lock, flags); spin_unlock_irqrestore(&ap->recv_lock, flags);
...@@ -397,6 +397,8 @@ ppp_sync_receive(struct tty_struct *tty, const unsigned char *buf, ...@@ -397,6 +397,8 @@ ppp_sync_receive(struct tty_struct *tty, const unsigned char *buf,
tasklet_schedule(&ap->tsk); tasklet_schedule(&ap->tsk);
sp_put(ap); sp_put(ap);
tty_unthrottle(tty); tty_unthrottle(tty);
return count;
} }
static void static void
......
...@@ -670,16 +670,17 @@ static void sl_setup(struct net_device *dev) ...@@ -670,16 +670,17 @@ static void sl_setup(struct net_device *dev)
* in parallel * in parallel
*/ */
static void slip_receive_buf(struct tty_struct *tty, const unsigned char *cp, static unsigned int slip_receive_buf(struct tty_struct *tty,
char *fp, int count) const unsigned char *cp, char *fp, int count)
{ {
struct slip *sl = tty->disc_data; struct slip *sl = tty->disc_data;
int bytes = count;
if (!sl || sl->magic != SLIP_MAGIC || !netif_running(sl->dev)) if (!sl || sl->magic != SLIP_MAGIC || !netif_running(sl->dev))
return; return -ENODEV;
/* Read the characters out of the buffer */ /* Read the characters out of the buffer */
while (count--) { while (bytes--) {
if (fp && *fp++) { if (fp && *fp++) {
if (!test_and_set_bit(SLF_ERROR, &sl->flags)) if (!test_and_set_bit(SLF_ERROR, &sl->flags))
sl->dev->stats.rx_errors++; sl->dev->stats.rx_errors++;
...@@ -693,6 +694,8 @@ static void slip_receive_buf(struct tty_struct *tty, const unsigned char *cp, ...@@ -693,6 +694,8 @@ static void slip_receive_buf(struct tty_struct *tty, const unsigned char *cp,
#endif #endif
slip_unesc(sl, *cp++); slip_unesc(sl, *cp++);
} }
return count;
} }
/************************************ /************************************
......
...@@ -517,17 +517,18 @@ static int x25_asy_close(struct net_device *dev) ...@@ -517,17 +517,18 @@ static int x25_asy_close(struct net_device *dev)
* and sent on to some IP layer for further processing. * and sent on to some IP layer for further processing.
*/ */
static void x25_asy_receive_buf(struct tty_struct *tty, static unsigned int x25_asy_receive_buf(struct tty_struct *tty,
const unsigned char *cp, char *fp, int count) const unsigned char *cp, char *fp, int count)
{ {
struct x25_asy *sl = tty->disc_data; struct x25_asy *sl = tty->disc_data;
int bytes = count;
if (!sl || sl->magic != X25_ASY_MAGIC || !netif_running(sl->dev)) if (!sl || sl->magic != X25_ASY_MAGIC || !netif_running(sl->dev))
return; return;
/* Read the characters out of the buffer */ /* Read the characters out of the buffer */
while (count--) { while (bytes--) {
if (fp && *fp++) { if (fp && *fp++) {
if (!test_and_set_bit(SLF_ERROR, &sl->flags)) if (!test_and_set_bit(SLF_ERROR, &sl->flags))
sl->dev->stats.rx_errors++; sl->dev->stats.rx_errors++;
...@@ -536,6 +537,8 @@ static void x25_asy_receive_buf(struct tty_struct *tty, ...@@ -536,6 +537,8 @@ static void x25_asy_receive_buf(struct tty_struct *tty,
} }
x25_asy_unesc(sl, *cp++); x25_asy_unesc(sl, *cp++);
} }
return count;
} }
/* /*
......
...@@ -2138,8 +2138,8 @@ static void gsmld_detach_gsm(struct tty_struct *tty, struct gsm_mux *gsm) ...@@ -2138,8 +2138,8 @@ static void gsmld_detach_gsm(struct tty_struct *tty, struct gsm_mux *gsm)
gsm->tty = NULL; gsm->tty = NULL;
} }
static void gsmld_receive_buf(struct tty_struct *tty, const unsigned char *cp, static unsigned int gsmld_receive_buf(struct tty_struct *tty,
char *fp, int count) const unsigned char *cp, char *fp, int count)
{ {
struct gsm_mux *gsm = tty->disc_data; struct gsm_mux *gsm = tty->disc_data;
const unsigned char *dp; const unsigned char *dp;
...@@ -2173,6 +2173,8 @@ static void gsmld_receive_buf(struct tty_struct *tty, const unsigned char *cp, ...@@ -2173,6 +2173,8 @@ static void gsmld_receive_buf(struct tty_struct *tty, const unsigned char *cp,
} }
/* FASYNC if needed ? */ /* FASYNC if needed ? */
/* If clogged call tty_throttle(tty); */ /* If clogged call tty_throttle(tty); */
return count;
} }
/** /**
......
...@@ -188,8 +188,8 @@ static unsigned int n_hdlc_tty_poll(struct tty_struct *tty, struct file *filp, ...@@ -188,8 +188,8 @@ static unsigned int n_hdlc_tty_poll(struct tty_struct *tty, struct file *filp,
poll_table *wait); poll_table *wait);
static int n_hdlc_tty_open(struct tty_struct *tty); static int n_hdlc_tty_open(struct tty_struct *tty);
static void n_hdlc_tty_close(struct tty_struct *tty); static void n_hdlc_tty_close(struct tty_struct *tty);
static void n_hdlc_tty_receive(struct tty_struct *tty, const __u8 *cp, static unsigned int n_hdlc_tty_receive(struct tty_struct *tty,
char *fp, int count); const __u8 *cp, char *fp, int count);
static void n_hdlc_tty_wakeup(struct tty_struct *tty); static void n_hdlc_tty_wakeup(struct tty_struct *tty);
#define bset(p,b) ((p)[(b) >> 5] |= (1 << ((b) & 0x1f))) #define bset(p,b) ((p)[(b) >> 5] |= (1 << ((b) & 0x1f)))
...@@ -509,8 +509,8 @@ static void n_hdlc_tty_wakeup(struct tty_struct *tty) ...@@ -509,8 +509,8 @@ static void n_hdlc_tty_wakeup(struct tty_struct *tty)
* Called by tty low level driver when receive data is available. Data is * Called by tty low level driver when receive data is available. Data is
* interpreted as one HDLC frame. * interpreted as one HDLC frame.
*/ */
static void n_hdlc_tty_receive(struct tty_struct *tty, const __u8 *data, static unsigned int n_hdlc_tty_receive(struct tty_struct *tty,
char *flags, int count) const __u8 *data, char *flags, int count)
{ {
register struct n_hdlc *n_hdlc = tty2n_hdlc (tty); register struct n_hdlc *n_hdlc = tty2n_hdlc (tty);
register struct n_hdlc_buf *buf; register struct n_hdlc_buf *buf;
...@@ -521,20 +521,20 @@ static void n_hdlc_tty_receive(struct tty_struct *tty, const __u8 *data, ...@@ -521,20 +521,20 @@ static void n_hdlc_tty_receive(struct tty_struct *tty, const __u8 *data,
/* This can happen if stuff comes in on the backup tty */ /* This can happen if stuff comes in on the backup tty */
if (!n_hdlc || tty != n_hdlc->tty) if (!n_hdlc || tty != n_hdlc->tty)
return; return -ENODEV;
/* verify line is using HDLC discipline */ /* verify line is using HDLC discipline */
if (n_hdlc->magic != HDLC_MAGIC) { if (n_hdlc->magic != HDLC_MAGIC) {
printk("%s(%d) line not using HDLC discipline\n", printk("%s(%d) line not using HDLC discipline\n",
__FILE__,__LINE__); __FILE__,__LINE__);
return; return -EINVAL;
} }
if ( count>maxframe ) { if ( count>maxframe ) {
if (debuglevel >= DEBUG_LEVEL_INFO) if (debuglevel >= DEBUG_LEVEL_INFO)
printk("%s(%d) rx count>maxframesize, data discarded\n", printk("%s(%d) rx count>maxframesize, data discarded\n",
__FILE__,__LINE__); __FILE__,__LINE__);
return; return -EINVAL;
} }
/* get a free HDLC buffer */ /* get a free HDLC buffer */
...@@ -550,7 +550,7 @@ static void n_hdlc_tty_receive(struct tty_struct *tty, const __u8 *data, ...@@ -550,7 +550,7 @@ static void n_hdlc_tty_receive(struct tty_struct *tty, const __u8 *data,
if (debuglevel >= DEBUG_LEVEL_INFO) if (debuglevel >= DEBUG_LEVEL_INFO)
printk("%s(%d) no more rx buffers, data discarded\n", printk("%s(%d) no more rx buffers, data discarded\n",
__FILE__,__LINE__); __FILE__,__LINE__);
return; return -EINVAL;
} }
/* copy received data to HDLC buffer */ /* copy received data to HDLC buffer */
...@@ -565,6 +565,8 @@ static void n_hdlc_tty_receive(struct tty_struct *tty, const __u8 *data, ...@@ -565,6 +565,8 @@ static void n_hdlc_tty_receive(struct tty_struct *tty, const __u8 *data,
if (n_hdlc->tty->fasync != NULL) if (n_hdlc->tty->fasync != NULL)
kill_fasync (&n_hdlc->tty->fasync, SIGIO, POLL_IN); kill_fasync (&n_hdlc->tty->fasync, SIGIO, POLL_IN);
return count;
} /* end of n_hdlc_tty_receive() */ } /* end of n_hdlc_tty_receive() */
/** /**
......
...@@ -139,8 +139,8 @@ static int r3964_ioctl(struct tty_struct *tty, struct file *file, ...@@ -139,8 +139,8 @@ static int r3964_ioctl(struct tty_struct *tty, struct file *file,
static void r3964_set_termios(struct tty_struct *tty, struct ktermios *old); static void r3964_set_termios(struct tty_struct *tty, struct ktermios *old);
static unsigned int r3964_poll(struct tty_struct *tty, struct file *file, static unsigned int r3964_poll(struct tty_struct *tty, struct file *file,
struct poll_table_struct *wait); struct poll_table_struct *wait);
static void r3964_receive_buf(struct tty_struct *tty, const unsigned char *cp, static unsigned int r3964_receive_buf(struct tty_struct *tty,
char *fp, int count); const unsigned char *cp, char *fp, int count);
static struct tty_ldisc_ops tty_ldisc_N_R3964 = { static struct tty_ldisc_ops tty_ldisc_N_R3964 = {
.owner = THIS_MODULE, .owner = THIS_MODULE,
...@@ -1239,8 +1239,8 @@ static unsigned int r3964_poll(struct tty_struct *tty, struct file *file, ...@@ -1239,8 +1239,8 @@ static unsigned int r3964_poll(struct tty_struct *tty, struct file *file,
return result; return result;
} }
static void r3964_receive_buf(struct tty_struct *tty, const unsigned char *cp, static unsigned int r3964_receive_buf(struct tty_struct *tty,
char *fp, int count) const unsigned char *cp, char *fp, int count)
{ {
struct r3964_info *pInfo = tty->disc_data; struct r3964_info *pInfo = tty->disc_data;
const unsigned char *p; const unsigned char *p;
...@@ -1257,6 +1257,8 @@ static void r3964_receive_buf(struct tty_struct *tty, const unsigned char *cp, ...@@ -1257,6 +1257,8 @@ static void r3964_receive_buf(struct tty_struct *tty, const unsigned char *cp,
} }
} }
return count;
} }
MODULE_LICENSE("GPL"); MODULE_LICENSE("GPL");
......
...@@ -81,38 +81,6 @@ static inline int tty_put_user(struct tty_struct *tty, unsigned char x, ...@@ -81,38 +81,6 @@ static inline int tty_put_user(struct tty_struct *tty, unsigned char x,
return put_user(x, ptr); return put_user(x, ptr);
} }
/**
* n_tty_set__room - receive space
* @tty: terminal
*
* Called by the driver to find out how much data it is
* permitted to feed to the line discipline without any being lost
* and thus to manage flow control. Not serialized. Answers for the
* "instant".
*/
static void n_tty_set_room(struct tty_struct *tty)
{
/* tty->read_cnt is not read locked ? */
int left = N_TTY_BUF_SIZE - tty->read_cnt - 1;
int old_left;
/*
* If we are doing input canonicalization, and there are no
* pending newlines, let characters through without limit, so
* that erase characters will be handled. Other excess
* characters will be beeped.
*/
if (left <= 0)
left = tty->icanon && !tty->canon_data;
old_left = tty->receive_room;
tty->receive_room = left;
/* Did this open up the receive buffer? We may need to flip */
if (left && !old_left)
schedule_work(&tty->buf.work);
}
static void put_tty_queue_nolock(unsigned char c, struct tty_struct *tty) static void put_tty_queue_nolock(unsigned char c, struct tty_struct *tty)
{ {
if (tty->read_cnt < N_TTY_BUF_SIZE) { if (tty->read_cnt < N_TTY_BUF_SIZE) {
...@@ -184,7 +152,6 @@ static void reset_buffer_flags(struct tty_struct *tty) ...@@ -184,7 +152,6 @@ static void reset_buffer_flags(struct tty_struct *tty)
tty->canon_head = tty->canon_data = tty->erasing = 0; tty->canon_head = tty->canon_data = tty->erasing = 0;
memset(&tty->read_flags, 0, sizeof tty->read_flags); memset(&tty->read_flags, 0, sizeof tty->read_flags);
n_tty_set_room(tty);
check_unthrottle(tty); check_unthrottle(tty);
} }
...@@ -1360,17 +1327,19 @@ static void n_tty_write_wakeup(struct tty_struct *tty) ...@@ -1360,17 +1327,19 @@ static void n_tty_write_wakeup(struct tty_struct *tty)
* calls one at a time and in order (or using flush_to_ldisc) * calls one at a time and in order (or using flush_to_ldisc)
*/ */
static void n_tty_receive_buf(struct tty_struct *tty, const unsigned char *cp, static unsigned int n_tty_receive_buf(struct tty_struct *tty,
char *fp, int count) const unsigned char *cp, char *fp, int count)
{ {
const unsigned char *p; const unsigned char *p;
char *f, flags = TTY_NORMAL; char *f, flags = TTY_NORMAL;
int i; int i;
char buf[64]; char buf[64];
unsigned long cpuflags; unsigned long cpuflags;
int left;
int ret = 0;
if (!tty->read_buf) if (!tty->read_buf)
return; return 0;
if (tty->real_raw) { if (tty->real_raw) {
spin_lock_irqsave(&tty->read_lock, cpuflags); spin_lock_irqsave(&tty->read_lock, cpuflags);
...@@ -1380,6 +1349,7 @@ static void n_tty_receive_buf(struct tty_struct *tty, const unsigned char *cp, ...@@ -1380,6 +1349,7 @@ static void n_tty_receive_buf(struct tty_struct *tty, const unsigned char *cp,
memcpy(tty->read_buf + tty->read_head, cp, i); memcpy(tty->read_buf + tty->read_head, cp, i);
tty->read_head = (tty->read_head + i) & (N_TTY_BUF_SIZE-1); tty->read_head = (tty->read_head + i) & (N_TTY_BUF_SIZE-1);
tty->read_cnt += i; tty->read_cnt += i;
ret += i;
cp += i; cp += i;
count -= i; count -= i;
...@@ -1389,8 +1359,10 @@ static void n_tty_receive_buf(struct tty_struct *tty, const unsigned char *cp, ...@@ -1389,8 +1359,10 @@ static void n_tty_receive_buf(struct tty_struct *tty, const unsigned char *cp,
memcpy(tty->read_buf + tty->read_head, cp, i); memcpy(tty->read_buf + tty->read_head, cp, i);
tty->read_head = (tty->read_head + i) & (N_TTY_BUF_SIZE-1); tty->read_head = (tty->read_head + i) & (N_TTY_BUF_SIZE-1);
tty->read_cnt += i; tty->read_cnt += i;
ret += i;
spin_unlock_irqrestore(&tty->read_lock, cpuflags); spin_unlock_irqrestore(&tty->read_lock, cpuflags);
} else { } else {
ret = count;
for (i = count, p = cp, f = fp; i; i--, p++) { for (i = count, p = cp, f = fp; i; i--, p++) {
if (f) if (f)
flags = *f++; flags = *f++;
...@@ -1418,8 +1390,6 @@ static void n_tty_receive_buf(struct tty_struct *tty, const unsigned char *cp, ...@@ -1418,8 +1390,6 @@ static void n_tty_receive_buf(struct tty_struct *tty, const unsigned char *cp,
tty->ops->flush_chars(tty); tty->ops->flush_chars(tty);
} }
n_tty_set_room(tty);
if ((!tty->icanon && (tty->read_cnt >= tty->minimum_to_wake)) || if ((!tty->icanon && (tty->read_cnt >= tty->minimum_to_wake)) ||
L_EXTPROC(tty)) { L_EXTPROC(tty)) {
kill_fasync(&tty->fasync, SIGIO, POLL_IN); kill_fasync(&tty->fasync, SIGIO, POLL_IN);
...@@ -1432,8 +1402,12 @@ static void n_tty_receive_buf(struct tty_struct *tty, const unsigned char *cp, ...@@ -1432,8 +1402,12 @@ static void n_tty_receive_buf(struct tty_struct *tty, const unsigned char *cp,
* mode. We don't want to throttle the driver if we're in * mode. We don't want to throttle the driver if we're in
* canonical mode and don't have a newline yet! * canonical mode and don't have a newline yet!
*/ */
if (tty->receive_room < TTY_THRESHOLD_THROTTLE) left = N_TTY_BUF_SIZE - tty->read_cnt - 1;
if (left < TTY_THRESHOLD_THROTTLE)
tty_throttle(tty); tty_throttle(tty);
return ret;
} }
int is_ignored(int sig) int is_ignored(int sig)
...@@ -1477,7 +1451,6 @@ static void n_tty_set_termios(struct tty_struct *tty, struct ktermios *old) ...@@ -1477,7 +1451,6 @@ static void n_tty_set_termios(struct tty_struct *tty, struct ktermios *old)
if (test_bit(TTY_HW_COOK_IN, &tty->flags)) { if (test_bit(TTY_HW_COOK_IN, &tty->flags)) {
tty->raw = 1; tty->raw = 1;
tty->real_raw = 1; tty->real_raw = 1;
n_tty_set_room(tty);
return; return;
} }
if (I_ISTRIP(tty) || I_IUCLC(tty) || I_IGNCR(tty) || if (I_ISTRIP(tty) || I_IUCLC(tty) || I_IGNCR(tty) ||
...@@ -1530,7 +1503,6 @@ static void n_tty_set_termios(struct tty_struct *tty, struct ktermios *old) ...@@ -1530,7 +1503,6 @@ static void n_tty_set_termios(struct tty_struct *tty, struct ktermios *old)
else else
tty->real_raw = 0; tty->real_raw = 0;
} }
n_tty_set_room(tty);
/* The termios change make the tty ready for I/O */ /* The termios change make the tty ready for I/O */
wake_up_interruptible(&tty->write_wait); wake_up_interruptible(&tty->write_wait);
wake_up_interruptible(&tty->read_wait); wake_up_interruptible(&tty->read_wait);
...@@ -1812,8 +1784,6 @@ static ssize_t n_tty_read(struct tty_struct *tty, struct file *file, ...@@ -1812,8 +1784,6 @@ static ssize_t n_tty_read(struct tty_struct *tty, struct file *file,
retval = -ERESTARTSYS; retval = -ERESTARTSYS;
break; break;
} }
/* FIXME: does n_tty_set_room need locking ? */
n_tty_set_room(tty);
timeout = schedule_timeout(timeout); timeout = schedule_timeout(timeout);
continue; continue;
} }
...@@ -1885,10 +1855,8 @@ static ssize_t n_tty_read(struct tty_struct *tty, struct file *file, ...@@ -1885,10 +1855,8 @@ static ssize_t n_tty_read(struct tty_struct *tty, struct file *file,
* longer than TTY_THRESHOLD_UNTHROTTLE in canonical mode, * longer than TTY_THRESHOLD_UNTHROTTLE in canonical mode,
* we won't get any more characters. * we won't get any more characters.
*/ */
if (n_tty_chars_in_buffer(tty) <= TTY_THRESHOLD_UNTHROTTLE) { if (n_tty_chars_in_buffer(tty) <= TTY_THRESHOLD_UNTHROTTLE)
n_tty_set_room(tty);
check_unthrottle(tty); check_unthrottle(tty);
}
if (b - buf >= minimum) if (b - buf >= minimum)
break; break;
...@@ -1910,7 +1878,6 @@ static ssize_t n_tty_read(struct tty_struct *tty, struct file *file, ...@@ -1910,7 +1878,6 @@ static ssize_t n_tty_read(struct tty_struct *tty, struct file *file,
} else if (test_and_clear_bit(TTY_PUSH, &tty->flags)) } else if (test_and_clear_bit(TTY_PUSH, &tty->flags))
goto do_it_again; goto do_it_again;
n_tty_set_room(tty);
return retval; return retval;
} }
......
...@@ -416,6 +416,7 @@ static void flush_to_ldisc(struct work_struct *work) ...@@ -416,6 +416,7 @@ static void flush_to_ldisc(struct work_struct *work)
struct tty_buffer *head, *tail = tty->buf.tail; struct tty_buffer *head, *tail = tty->buf.tail;
int seen_tail = 0; int seen_tail = 0;
while ((head = tty->buf.head) != NULL) { while ((head = tty->buf.head) != NULL) {
int copied;
int count; int count;
char *char_buf; char *char_buf;
unsigned char *flag_buf; unsigned char *flag_buf;
...@@ -442,17 +443,19 @@ static void flush_to_ldisc(struct work_struct *work) ...@@ -442,17 +443,19 @@ static void flush_to_ldisc(struct work_struct *work)
line discipline as we want to empty the queue */ line discipline as we want to empty the queue */
if (test_bit(TTY_FLUSHPENDING, &tty->flags)) if (test_bit(TTY_FLUSHPENDING, &tty->flags))
break; break;
if (!tty->receive_room || seen_tail)
break;
if (count > tty->receive_room)
count = tty->receive_room;
char_buf = head->char_buf_ptr + head->read; char_buf = head->char_buf_ptr + head->read;
flag_buf = head->flag_buf_ptr + head->read; flag_buf = head->flag_buf_ptr + head->read;
head->read += count;
spin_unlock_irqrestore(&tty->buf.lock, flags); spin_unlock_irqrestore(&tty->buf.lock, flags);
disc->ops->receive_buf(tty, char_buf, copied = disc->ops->receive_buf(tty, char_buf,
flag_buf, count); flag_buf, count);
spin_lock_irqsave(&tty->buf.lock, flags); spin_lock_irqsave(&tty->buf.lock, flags);
head->read += copied;
if (copied == 0 || seen_tail) {
schedule_work(&tty->buf.work);
break;
}
} }
clear_bit(TTY_FLUSHING, &tty->flags); clear_bit(TTY_FLUSHING, &tty->flags);
} }
......
...@@ -332,8 +332,7 @@ int paste_selection(struct tty_struct *tty) ...@@ -332,8 +332,7 @@ int paste_selection(struct tty_struct *tty)
continue; continue;
} }
count = sel_buffer_lth - pasted; count = sel_buffer_lth - pasted;
count = min(count, tty->receive_room); count = tty->ldisc->ops->receive_buf(tty, sel_buffer + pasted,
tty->ldisc->ops->receive_buf(tty, sel_buffer + pasted,
NULL, count); NULL, count);
pasted += count; pasted += count;
} }
......
...@@ -76,7 +76,7 @@ ...@@ -76,7 +76,7 @@
* tty device. It is solely the responsibility of the line * tty device. It is solely the responsibility of the line
* discipline to handle poll requests. * discipline to handle poll requests.
* *
* void (*receive_buf)(struct tty_struct *, const unsigned char *cp, * unsigned int (*receive_buf)(struct tty_struct *, const unsigned char *cp,
* char *fp, int count); * char *fp, int count);
* *
* This function is called by the low-level tty driver to send * This function is called by the low-level tty driver to send
...@@ -84,7 +84,8 @@ ...@@ -84,7 +84,8 @@
* processing. <cp> is a pointer to the buffer of input * processing. <cp> is a pointer to the buffer of input
* character received by the device. <fp> is a pointer to a * character received by the device. <fp> is a pointer to a
* pointer of flag bytes which indicate whether a character was * pointer of flag bytes which indicate whether a character was
* received with a parity error, etc. * received with a parity error, etc. Returns the amount of bytes
* received.
* *
* void (*write_wakeup)(struct tty_struct *); * void (*write_wakeup)(struct tty_struct *);
* *
...@@ -140,8 +141,8 @@ struct tty_ldisc_ops { ...@@ -140,8 +141,8 @@ struct tty_ldisc_ops {
/* /*
* The following routines are called from below. * The following routines are called from below.
*/ */
void (*receive_buf)(struct tty_struct *, const unsigned char *cp, unsigned int (*receive_buf)(struct tty_struct *,
char *fp, int count); const unsigned char *cp, char *fp, int count);
void (*write_wakeup)(struct tty_struct *); void (*write_wakeup)(struct tty_struct *);
void (*dcd_change)(struct tty_struct *, unsigned int, void (*dcd_change)(struct tty_struct *, unsigned int,
struct pps_event_time *); struct pps_event_time *);
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册