351 строка
8.8 KiB
C
351 строка
8.8 KiB
C
/*
|
|
* Tty port functions
|
|
*/
|
|
|
|
#include <linux/types.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/tty.h>
|
|
#include <linux/tty_driver.h>
|
|
#include <linux/tty_flip.h>
|
|
#include <linux/serial.h>
|
|
#include <linux/timer.h>
|
|
#include <linux/string.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/init.h>
|
|
#include <linux/wait.h>
|
|
#include <linux/bitops.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/module.h>
|
|
|
|
void tty_port_init(struct tty_port *port)
|
|
{
|
|
memset(port, 0, sizeof(*port));
|
|
init_waitqueue_head(&port->open_wait);
|
|
init_waitqueue_head(&port->close_wait);
|
|
mutex_init(&port->mutex);
|
|
spin_lock_init(&port->lock);
|
|
port->close_delay = (50 * HZ) / 100;
|
|
port->closing_wait = (3000 * HZ) / 100;
|
|
}
|
|
EXPORT_SYMBOL(tty_port_init);
|
|
|
|
int tty_port_alloc_xmit_buf(struct tty_port *port)
|
|
{
|
|
/* We may sleep in get_zeroed_page() */
|
|
mutex_lock(&port->mutex);
|
|
if (port->xmit_buf == NULL)
|
|
port->xmit_buf = (unsigned char *)get_zeroed_page(GFP_KERNEL);
|
|
mutex_unlock(&port->mutex);
|
|
if (port->xmit_buf == NULL)
|
|
return -ENOMEM;
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(tty_port_alloc_xmit_buf);
|
|
|
|
void tty_port_free_xmit_buf(struct tty_port *port)
|
|
{
|
|
mutex_lock(&port->mutex);
|
|
if (port->xmit_buf != NULL) {
|
|
free_page((unsigned long)port->xmit_buf);
|
|
port->xmit_buf = NULL;
|
|
}
|
|
mutex_unlock(&port->mutex);
|
|
}
|
|
EXPORT_SYMBOL(tty_port_free_xmit_buf);
|
|
|
|
|
|
/**
|
|
* tty_port_tty_get - get a tty reference
|
|
* @port: tty port
|
|
*
|
|
* Return a refcount protected tty instance or NULL if the port is not
|
|
* associated with a tty (eg due to close or hangup)
|
|
*/
|
|
|
|
struct tty_struct *tty_port_tty_get(struct tty_port *port)
|
|
{
|
|
unsigned long flags;
|
|
struct tty_struct *tty;
|
|
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
tty = tty_kref_get(port->tty);
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
return tty;
|
|
}
|
|
EXPORT_SYMBOL(tty_port_tty_get);
|
|
|
|
/**
|
|
* tty_port_tty_set - set the tty of a port
|
|
* @port: tty port
|
|
* @tty: the tty
|
|
*
|
|
* Associate the port and tty pair. Manages any internal refcounts.
|
|
* Pass NULL to deassociate a port
|
|
*/
|
|
|
|
void tty_port_tty_set(struct tty_port *port, struct tty_struct *tty)
|
|
{
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
if (port->tty)
|
|
tty_kref_put(port->tty);
|
|
port->tty = tty_kref_get(tty);
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
}
|
|
EXPORT_SYMBOL(tty_port_tty_set);
|
|
|
|
/**
|
|
* tty_port_hangup - hangup helper
|
|
* @port: tty port
|
|
*
|
|
* Perform port level tty hangup flag and count changes. Drop the tty
|
|
* reference.
|
|
*/
|
|
|
|
void tty_port_hangup(struct tty_port *port)
|
|
{
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
port->count = 0;
|
|
port->flags &= ~ASYNC_NORMAL_ACTIVE;
|
|
if (port->tty)
|
|
tty_kref_put(port->tty);
|
|
port->tty = NULL;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
wake_up_interruptible(&port->open_wait);
|
|
}
|
|
EXPORT_SYMBOL(tty_port_hangup);
|
|
|
|
/**
|
|
* tty_port_carrier_raised - carrier raised check
|
|
* @port: tty port
|
|
*
|
|
* Wrapper for the carrier detect logic. For the moment this is used
|
|
* to hide some internal details. This will eventually become entirely
|
|
* internal to the tty port.
|
|
*/
|
|
|
|
int tty_port_carrier_raised(struct tty_port *port)
|
|
{
|
|
if (port->ops->carrier_raised == NULL)
|
|
return 1;
|
|
return port->ops->carrier_raised(port);
|
|
}
|
|
EXPORT_SYMBOL(tty_port_carrier_raised);
|
|
|
|
/**
|
|
* tty_port_raise_dtr_rts - Raise DTR/RTS
|
|
* @port: tty port
|
|
*
|
|
* Wrapper for the DTR/RTS raise logic. For the moment this is used
|
|
* to hide some internal details. This will eventually become entirely
|
|
* internal to the tty port.
|
|
*/
|
|
|
|
void tty_port_raise_dtr_rts(struct tty_port *port)
|
|
{
|
|
if (port->ops->dtr_rts)
|
|
port->ops->dtr_rts(port, 1);
|
|
}
|
|
EXPORT_SYMBOL(tty_port_raise_dtr_rts);
|
|
|
|
/**
|
|
* tty_port_lower_dtr_rts - Lower DTR/RTS
|
|
* @port: tty port
|
|
*
|
|
* Wrapper for the DTR/RTS raise logic. For the moment this is used
|
|
* to hide some internal details. This will eventually become entirely
|
|
* internal to the tty port.
|
|
*/
|
|
|
|
void tty_port_lower_dtr_rts(struct tty_port *port)
|
|
{
|
|
if (port->ops->dtr_rts)
|
|
port->ops->dtr_rts(port, 0);
|
|
}
|
|
EXPORT_SYMBOL(tty_port_lower_dtr_rts);
|
|
|
|
/**
|
|
* tty_port_block_til_ready - Waiting logic for tty open
|
|
* @port: the tty port being opened
|
|
* @tty: the tty device being bound
|
|
* @filp: the file pointer of the opener
|
|
*
|
|
* Implement the core POSIX/SuS tty behaviour when opening a tty device.
|
|
* Handles:
|
|
* - hangup (both before and during)
|
|
* - non blocking open
|
|
* - rts/dtr/dcd
|
|
* - signals
|
|
* - port flags and counts
|
|
*
|
|
* The passed tty_port must implement the carrier_raised method if it can
|
|
* do carrier detect and the dtr_rts method if it supports software
|
|
* management of these lines. Note that the dtr/rts raise is done each
|
|
* iteration as a hangup may have previously dropped them while we wait.
|
|
*/
|
|
|
|
int tty_port_block_til_ready(struct tty_port *port,
|
|
struct tty_struct *tty, struct file *filp)
|
|
{
|
|
int do_clocal = 0, retval;
|
|
unsigned long flags;
|
|
DEFINE_WAIT(wait);
|
|
int cd;
|
|
|
|
/* block if port is in the process of being closed */
|
|
if (tty_hung_up_p(filp) || port->flags & ASYNC_CLOSING) {
|
|
wait_event_interruptible(port->close_wait,
|
|
!(port->flags & ASYNC_CLOSING));
|
|
if (port->flags & ASYNC_HUP_NOTIFY)
|
|
return -EAGAIN;
|
|
else
|
|
return -ERESTARTSYS;
|
|
}
|
|
|
|
/* if non-blocking mode is set we can pass directly to open unless
|
|
the port has just hung up or is in another error state */
|
|
if ((filp->f_flags & O_NONBLOCK) ||
|
|
(tty->flags & (1 << TTY_IO_ERROR))) {
|
|
port->flags |= ASYNC_NORMAL_ACTIVE;
|
|
return 0;
|
|
}
|
|
|
|
if (C_CLOCAL(tty))
|
|
do_clocal = 1;
|
|
|
|
/* Block waiting until we can proceed. We may need to wait for the
|
|
carrier, but we must also wait for any close that is in progress
|
|
before the next open may complete */
|
|
|
|
retval = 0;
|
|
|
|
/* The port lock protects the port counts */
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
if (!tty_hung_up_p(filp))
|
|
port->count--;
|
|
port->blocked_open++;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
|
|
while (1) {
|
|
/* Indicate we are open */
|
|
if (tty->termios->c_cflag & CBAUD)
|
|
tty_port_raise_dtr_rts(port);
|
|
|
|
prepare_to_wait(&port->open_wait, &wait, TASK_INTERRUPTIBLE);
|
|
/* Check for a hangup or uninitialised port. Return accordingly */
|
|
if (tty_hung_up_p(filp) || !(port->flags & ASYNC_INITIALIZED)) {
|
|
if (port->flags & ASYNC_HUP_NOTIFY)
|
|
retval = -EAGAIN;
|
|
else
|
|
retval = -ERESTARTSYS;
|
|
break;
|
|
}
|
|
/* Probe the carrier. For devices with no carrier detect this
|
|
will always return true */
|
|
cd = tty_port_carrier_raised(port);
|
|
if (!(port->flags & ASYNC_CLOSING) &&
|
|
(do_clocal || cd))
|
|
break;
|
|
if (signal_pending(current)) {
|
|
retval = -ERESTARTSYS;
|
|
break;
|
|
}
|
|
schedule();
|
|
}
|
|
finish_wait(&port->open_wait, &wait);
|
|
|
|
/* Update counts. A parallel hangup will have set count to zero and
|
|
we must not mess that up further */
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
if (!tty_hung_up_p(filp))
|
|
port->count++;
|
|
port->blocked_open--;
|
|
if (retval == 0)
|
|
port->flags |= ASYNC_NORMAL_ACTIVE;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
return retval;
|
|
|
|
}
|
|
EXPORT_SYMBOL(tty_port_block_til_ready);
|
|
|
|
int tty_port_close_start(struct tty_port *port, struct tty_struct *tty, struct file *filp)
|
|
{
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
if (tty_hung_up_p(filp)) {
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
return 0;
|
|
}
|
|
|
|
if( tty->count == 1 && port->count != 1) {
|
|
printk(KERN_WARNING
|
|
"tty_port_close_start: tty->count = 1 port count = %d.\n",
|
|
port->count);
|
|
port->count = 1;
|
|
}
|
|
if (--port->count < 0) {
|
|
printk(KERN_WARNING "tty_port_close_start: count = %d\n",
|
|
port->count);
|
|
port->count = 0;
|
|
}
|
|
|
|
if (port->count) {
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
return 0;
|
|
}
|
|
port->flags |= ASYNC_CLOSING;
|
|
tty->closing = 1;
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
/* Don't block on a stalled port, just pull the chain */
|
|
if (tty->flow_stopped)
|
|
tty_driver_flush_buffer(tty);
|
|
if (port->flags & ASYNC_INITIALIZED &&
|
|
port->closing_wait != ASYNC_CLOSING_WAIT_NONE)
|
|
tty_wait_until_sent(tty, port->closing_wait);
|
|
if (port->drain_delay) {
|
|
unsigned int bps = tty_get_baud_rate(tty);
|
|
long timeout;
|
|
|
|
if (bps > 1200)
|
|
timeout = max_t(long, (HZ * 10 * port->drain_delay) / bps,
|
|
HZ / 10);
|
|
else
|
|
timeout = 2 * HZ;
|
|
schedule_timeout_interruptible(timeout);
|
|
}
|
|
return 1;
|
|
}
|
|
EXPORT_SYMBOL(tty_port_close_start);
|
|
|
|
void tty_port_close_end(struct tty_port *port, struct tty_struct *tty)
|
|
{
|
|
unsigned long flags;
|
|
|
|
tty_ldisc_flush(tty);
|
|
|
|
if (tty->termios->c_cflag & HUPCL)
|
|
tty_port_lower_dtr_rts(port);
|
|
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
tty->closing = 0;
|
|
|
|
if (port->blocked_open) {
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
if (port->close_delay) {
|
|
msleep_interruptible(
|
|
jiffies_to_msecs(port->close_delay));
|
|
}
|
|
spin_lock_irqsave(&port->lock, flags);
|
|
wake_up_interruptible(&port->open_wait);
|
|
}
|
|
port->flags &= ~(ASYNC_NORMAL_ACTIVE | ASYNC_CLOSING);
|
|
wake_up_interruptible(&port->close_wait);
|
|
spin_unlock_irqrestore(&port->lock, flags);
|
|
}
|
|
EXPORT_SYMBOL(tty_port_close_end);
|