minix/drivers/tty/pty.c

678 lines
18 KiB
C
Raw Normal View History

2005-04-21 16:53:53 +02:00
/* pty.c - pseudo terminal driver Author: Kees J. Bot
* 30 Dec 1995
* PTYs can be seen as a bidirectional pipe with TTY
* input and output processing. For example a simple rlogin session:
*
* keyboard -> rlogin -> in.rld -> /dev/ptypX -> /dev/ttypX -> shell
* shell -> /dev/ttypX -> /dev/ptypX -> in.rld -> rlogin -> screen
*
* This file takes care of copying data between the tty/pty device pairs and
* the open/read/write/close calls on the pty devices. The TTY task takes
* care of the input and output processing (interrupt, backspace, raw I/O,
* etc.) using the pty_read() and pty_write() functions as the "keyboard" and
* "screen" functions of the ttypX devices.
* Be careful when reading this code, the terms "reading" and "writing" are
* used both for the tty and the pty end of the pseudo tty. Writes to one
* end are to be read at the other end and vice-versa.
*/
#include "../drivers.h"
2005-08-01 16:40:21 +02:00
#include <assert.h>
2005-04-21 16:53:53 +02:00
#include <termios.h>
#include <signal.h>
#include <minix/com.h>
#include <minix/callnr.h>
2005-08-05 15:50:58 +02:00
#include <sys/select.h>
2005-04-21 16:53:53 +02:00
#include "tty.h"
#if NR_PTYS > 0
/* PTY bookkeeping structure, one per pty/tty pair. */
typedef struct pty {
tty_t *tty; /* associated TTY structure */
char state; /* flags: busy, closed, ... */
/* Read call on /dev/ptypX. */
2005-08-01 16:40:21 +02:00
char rdsendreply; /* send a reply (instead of notify) */
int rdcaller; /* process making the call (usually FS) */
int rdproc; /* process that wants to read from the pty */
vir_bytes rdvir_g; /* virtual address in readers address space */
vir_bytes rdvir_offset; /* offset in above grant */
int rdsafe; /* safe read mode? */
2005-04-21 16:53:53 +02:00
int rdleft; /* # bytes yet to be read */
int rdcum; /* # bytes written so far */
/* Write call to /dev/ptypX. */
2005-08-01 16:40:21 +02:00
char wrsendreply; /* send a reply (instead of notify) */
int wrcaller; /* process making the call (usually FS) */
int wrproc; /* process that wants to write to the pty */
vir_bytes wrvir_g; /* virtual address in writers address space */
vir_bytes wrvir_offset; /* offset in above grant */
int wrsafe; /* safe write mode? */
2005-04-21 16:53:53 +02:00
int wrleft; /* # bytes yet to be written */
int wrcum; /* # bytes written so far */
/* Output buffer. */
int ocount; /* # characters in the buffer */
char *ohead, *otail; /* head and tail of the circular buffer */
char obuf[2048]; /* buffer for bytes going to the pty reader */
2005-08-05 15:50:58 +02:00
/* select() data. */
int select_ops, /* Which operations do we want to know about? */
select_proc, /* Who wants to know about it? */
select_ready_ops; /* For callback. */
2005-04-21 16:53:53 +02:00
} pty_t;
#define PTY_ACTIVE 0x01 /* pty is open/active */
#define TTY_CLOSED 0x02 /* tty side has closed down */
#define PTY_CLOSED 0x04 /* pty side has closed down */
PRIVATE pty_t pty_table[NR_PTYS]; /* PTY bookkeeping */
2005-09-11 19:09:11 +02:00
FORWARD _PROTOTYPE( int pty_write, (tty_t *tp, int try) );
2005-04-21 16:53:53 +02:00
FORWARD _PROTOTYPE( void pty_echo, (tty_t *tp, int c) );
FORWARD _PROTOTYPE( void pty_start, (pty_t *pp) );
FORWARD _PROTOTYPE( void pty_finish, (pty_t *pp) );
2005-08-05 15:50:58 +02:00
FORWARD _PROTOTYPE( int pty_read, (tty_t *tp, int try) );
FORWARD _PROTOTYPE( int pty_close, (tty_t *tp, int try) );
FORWARD _PROTOTYPE( int pty_icancel, (tty_t *tp, int try) );
FORWARD _PROTOTYPE( int pty_ocancel, (tty_t *tp, int try) );
FORWARD _PROTOTYPE( int pty_select, (tty_t *tp, message *m) );
2005-04-21 16:53:53 +02:00
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* do_pty *
*===========================================================================*/
2005-04-21 16:53:53 +02:00
PUBLIC void do_pty(tp, m_ptr)
tty_t *tp;
message *m_ptr;
{
/* Perform an open/close/read/write call on a /dev/ptypX device. */
pty_t *pp = tp->tty_priv;
int r;
2005-05-09 16:35:26 +02:00
phys_bytes p;
int safe = 0;
2005-04-21 16:53:53 +02:00
switch (m_ptr->m_type) {
case DEV_READ_S:
safe=1;
2005-04-21 16:53:53 +02:00
/* Check, store information on the reader, do I/O. */
if (pp->state & TTY_CLOSED) {
r = 0;
break;
}
2005-08-01 16:40:21 +02:00
if (pp->rdleft != 0 || pp->rdcum != 0) {
2005-04-21 16:53:53 +02:00
r = EIO;
break;
}
if (m_ptr->COUNT <= 0) {
r = EINVAL;
break;
}
2005-05-09 16:35:26 +02:00
#if DEAD_CODE
if (numap_local(m_ptr->IO_ENDPT, (vir_bytes) m_ptr->ADDRESS,
2005-04-21 16:53:53 +02:00
m_ptr->COUNT) == 0) {
2005-05-09 16:35:26 +02:00
#else
if ((r = sys_umap(m_ptr->IO_ENDPT, D, (vir_bytes) m_ptr->ADDRESS,
2005-05-09 16:35:26 +02:00
m_ptr->COUNT, &p)) != OK) {
#endif
2005-04-21 16:53:53 +02:00
break;
}
2005-08-01 16:40:21 +02:00
pp->rdsendreply = TRUE;
2005-04-21 16:53:53 +02:00
pp->rdcaller = m_ptr->m_source;
pp->rdproc = m_ptr->IO_ENDPT;
pp->rdvir_g = (vir_bytes) m_ptr->ADDRESS;
pp->rdvir_offset = 0;
pp->rdsafe = safe;
2005-04-21 16:53:53 +02:00
pp->rdleft = m_ptr->COUNT;
pty_start(pp);
handle_events(tp);
if (pp->rdleft == 0) {
return; /* already done */
}
2005-04-21 16:53:53 +02:00
#if DEAD_CODE
2005-04-21 16:53:53 +02:00
if (m_ptr->TTY_FLAGS & O_NONBLOCK) {
r = EAGAIN; /* don't suspend */
pp->rdleft = pp->rdcum = 0;
} else
#endif
{
2005-04-21 16:53:53 +02:00
r = SUSPEND; /* do suspend */
2005-08-01 16:40:21 +02:00
pp->rdsendreply = FALSE;
2005-04-21 16:53:53 +02:00
}
break;
case DEV_WRITE_S:
safe=1;
2005-04-21 16:53:53 +02:00
/* Check, store information on the writer, do I/O. */
if (pp->state & TTY_CLOSED) {
r = EIO;
break;
}
2005-08-01 16:40:21 +02:00
if (pp->wrleft != 0 || pp->wrcum != 0) {
2005-04-21 16:53:53 +02:00
r = EIO;
break;
}
if (m_ptr->COUNT <= 0) {
r = EINVAL;
break;
}
2005-05-09 16:35:26 +02:00
#if DEAD_CODE
if (numap_local(m_ptr->IO_ENDPT, (vir_bytes) m_ptr->ADDRESS,
2005-04-21 16:53:53 +02:00
m_ptr->COUNT) == 0) {
r = EFAULT;
2005-05-09 16:35:26 +02:00
#else
if ((r = sys_umap(m_ptr->IO_ENDPT, D, (vir_bytes) m_ptr->ADDRESS,
2005-05-09 16:35:26 +02:00
m_ptr->COUNT, &p)) != OK) {
#endif
2005-04-21 16:53:53 +02:00
break;
}
2005-08-01 16:40:21 +02:00
pp->wrsendreply = TRUE;
2005-04-21 16:53:53 +02:00
pp->wrcaller = m_ptr->m_source;
pp->wrproc = m_ptr->IO_ENDPT;
pp->wrvir_g = (vir_bytes) m_ptr->ADDRESS;
pp->wrvir_offset = 0;
pp->wrsafe = safe;
2005-04-21 16:53:53 +02:00
pp->wrleft = m_ptr->COUNT;
handle_events(tp);
if (pp->wrleft == 0) {
return; /* already done */
}
2005-04-21 16:53:53 +02:00
#if DEAD_CODE
2005-04-21 16:53:53 +02:00
if (m_ptr->TTY_FLAGS & O_NONBLOCK) { /* don't suspend */
r = pp->wrcum > 0 ? pp->wrcum : EAGAIN;
pp->wrleft = pp->wrcum = 0;
} else
#endif
{
2005-08-01 16:40:21 +02:00
pp->wrsendreply = FALSE; /* do suspend */
2005-04-21 16:53:53 +02:00
r = SUSPEND;
}
break;
case DEV_OPEN:
r = pp->state != 0 ? EIO : OK;
pp->state |= PTY_ACTIVE;
2005-08-01 16:40:21 +02:00
pp->rdcum = 0;
pp->wrcum = 0;
2005-04-21 16:53:53 +02:00
break;
case DEV_CLOSE:
r = OK;
if (pp->state & TTY_CLOSED) {
pp->state = 0;
} else {
pp->state |= PTY_CLOSED;
sigchar(tp, SIGHUP);
}
break;
2005-08-05 15:50:58 +02:00
case DEV_SELECT:
r = pty_select(tp, m_ptr);
break;
2005-04-21 16:53:53 +02:00
case CANCEL:
r = EINTR;
if (m_ptr->IO_ENDPT == pp->rdproc) {
2005-04-21 16:53:53 +02:00
/* Cancel a read from a PTY. */
r = pp->rdcum > 0 ? pp->rdcum : EAGAIN;
2005-04-21 16:53:53 +02:00
pp->rdleft = pp->rdcum = 0;
}
if (m_ptr->IO_ENDPT == pp->wrproc) {
2005-04-21 16:53:53 +02:00
/* Cancel a write to a PTY. */
r = pp->wrcum > 0 ? pp->wrcum : EAGAIN;
2005-04-21 16:53:53 +02:00
pp->wrleft = pp->wrcum = 0;
}
break;
default:
r = EINVAL;
}
tty_reply(TASK_REPLY, m_ptr->m_source, m_ptr->IO_ENDPT, r);
2005-04-21 16:53:53 +02:00
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* pty_write *
*===========================================================================*/
PRIVATE int pty_write(tp, try)
2005-04-21 16:53:53 +02:00
tty_t *tp;
int try;
2005-04-21 16:53:53 +02:00
{
/* (*dev_write)() routine for PTYs. Transfer bytes from the writer on
* /dev/ttypX to the output buffer.
*/
pty_t *pp = tp->tty_priv;
2005-05-09 16:35:26 +02:00
int count, ocount, s;
2005-04-21 16:53:53 +02:00
phys_bytes user_phys;
/* PTY closed down? */
if (pp->state & PTY_CLOSED) {
2005-09-11 19:09:11 +02:00
if (try) return 1;
2005-04-21 16:53:53 +02:00
if (tp->tty_outleft > 0) {
if(tp->tty_outrepcode == TTY_REVIVE) {
notify(tp->tty_outcaller);
tp->tty_outrevived = 1;
} else {
tty_reply(tp->tty_outrepcode, tp->tty_outcaller,
2005-04-21 16:53:53 +02:00
tp->tty_outproc, EIO);
tp->tty_outleft = tp->tty_outcum = 0;
}
2005-04-21 16:53:53 +02:00
}
return;
}
/* While there is something to do. */
for (;;) {
ocount = buflen(pp->obuf) - pp->ocount;
2005-09-11 19:09:11 +02:00
if (try) return (ocount > 0);
2005-04-21 16:53:53 +02:00
count = bufend(pp->obuf) - pp->ohead;
if (count > ocount) count = ocount;
if (count > tp->tty_outleft) count = tp->tty_outleft;
2005-08-05 15:50:58 +02:00
if (count == 0 || tp->tty_inhibited)
break;
2005-04-21 16:53:53 +02:00
/* Copy from user space to the PTY output buffer. */
if(tp->tty_out_safe) {
if ((s = sys_safecopyfrom(tp->tty_outproc, tp->tty_out_vir_g,
tp->tty_out_vir_offset, (vir_bytes) pp->ohead, count, D))!=OK) {
break;
}
} else {
if ((s = sys_vircopy(tp->tty_outproc, D, (vir_bytes) tp->tty_out_vir_g,
SELF, D, (vir_bytes) pp->ohead, (phys_bytes) count)) != OK) {
2005-05-09 16:35:26 +02:00
break;
}
2005-05-09 16:35:26 +02:00
}
2005-04-21 16:53:53 +02:00
/* Perform output processing on the output buffer. */
out_process(tp, pp->obuf, pp->ohead, bufend(pp->obuf), &count, &ocount);
if (count == 0) break;
/* Assume echoing messed up by output. */
tp->tty_reprint = TRUE;
/* Bookkeeping. */
pp->ocount += ocount;
if ((pp->ohead += ocount) >= bufend(pp->obuf))
pp->ohead -= buflen(pp->obuf);
pty_start(pp);
if(tp->tty_out_safe) tp->tty_out_vir_offset += count;
else tp->tty_out_vir_g += count;
2005-04-21 16:53:53 +02:00
tp->tty_outcum += count;
if ((tp->tty_outleft -= count) == 0) {
/* Output is finished, reply to the writer. */
if(tp->tty_outrepcode == TTY_REVIVE) {
notify(tp->tty_outcaller);
tp->tty_outrevived = 1;
} else {
tty_reply(tp->tty_outrepcode, tp->tty_outcaller,
2005-04-21 16:53:53 +02:00
tp->tty_outproc, tp->tty_outcum);
tp->tty_outcum = 0;
}
2005-04-21 16:53:53 +02:00
}
}
pty_finish(pp);
return 1;
2005-04-21 16:53:53 +02:00
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* pty_echo *
*===========================================================================*/
2005-04-21 16:53:53 +02:00
PRIVATE void pty_echo(tp, c)
tty_t *tp;
int c;
{
/* Echo one character. (Like pty_write, but only one character, optionally.) */
pty_t *pp = tp->tty_priv;
int count, ocount;
ocount = buflen(pp->obuf) - pp->ocount;
if (ocount == 0) return; /* output buffer full */
count = 1;
*pp->ohead = c; /* add one character */
out_process(tp, pp->obuf, pp->ohead, bufend(pp->obuf), &count, &ocount);
if (count == 0) return;
pp->ocount += ocount;
if ((pp->ohead += ocount) >= bufend(pp->obuf)) pp->ohead -= buflen(pp->obuf);
pty_start(pp);
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* pty_start *
*===========================================================================*/
2005-04-21 16:53:53 +02:00
PRIVATE void pty_start(pp)
pty_t *pp;
{
/* Transfer bytes written to the output buffer to the PTY reader. */
int count;
/* While there are things to do. */
for (;;) {
2005-05-09 16:35:26 +02:00
int s;
2005-04-21 16:53:53 +02:00
count = bufend(pp->obuf) - pp->otail;
if (count > pp->ocount) count = pp->ocount;
if (count > pp->rdleft) count = pp->rdleft;
if (count == 0) break;
/* Copy from the output buffer to the readers address space. */
if (pp->rdsafe) {
if((s = sys_safecopyto(pp->rdproc, pp->rdvir_g,
pp->rdvir_offset, (vir_bytes) pp->otail, count, D)) != OK) {
2005-05-09 16:35:26 +02:00
break;
}
pp->rdvir_offset += count;
} else {
if ((s = sys_vircopy(SELF, D, (vir_bytes)pp->otail,
(vir_bytes) pp->rdproc, D, (vir_bytes) pp->rdvir_g, (phys_bytes) count)) != OK) {
printf("pty tty: copy failed (error %d)\n", s);
break;
}
pp->rdvir_g += count;
2005-05-09 16:35:26 +02:00
}
2005-04-21 16:53:53 +02:00
/* Bookkeeping. */
pp->ocount -= count;
if ((pp->otail += count) == bufend(pp->obuf)) pp->otail = pp->obuf;
pp->rdcum += count;
pp->rdleft -= count;
}
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* pty_finish *
*===========================================================================*/
2005-04-21 16:53:53 +02:00
PRIVATE void pty_finish(pp)
pty_t *pp;
{
/* Finish the read request of a PTY reader if there is at least one byte
* transferred.
*/
if (pp->rdcum > 0) {
2005-08-01 16:40:21 +02:00
if (pp->rdsendreply) {
tty_reply(TASK_REPLY, pp->rdcaller, pp->rdproc, pp->rdcum);
pp->rdleft = pp->rdcum = 0;
}
else
notify(pp->rdcaller);
2005-04-21 16:53:53 +02:00
}
2005-08-05 15:50:58 +02:00
2005-04-21 16:53:53 +02:00
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* pty_read *
*===========================================================================*/
PRIVATE int pty_read(tp, try)
2005-04-21 16:53:53 +02:00
tty_t *tp;
int try;
2005-04-21 16:53:53 +02:00
{
/* Offer bytes from the PTY writer for input on the TTY. (Do it one byte at
* a time, 99% of the writes will be for one byte, so no sense in being smart.)
*/
pty_t *pp = tp->tty_priv;
char c;
if (pp->state & PTY_CLOSED) {
2005-09-11 19:09:11 +02:00
if (try) return 1;
2005-04-21 16:53:53 +02:00
if (tp->tty_inleft > 0) {
if(tp->tty_inrepcode == TTY_REVIVE) {
notify(tp->tty_incaller);
tp->tty_inrevived = 1;
} else {
tty_reply(tp->tty_inrepcode, tp->tty_incaller,
tp->tty_inproc, tp->tty_incum);
tp->tty_inleft = tp->tty_incum = 0;
}
2005-04-21 16:53:53 +02:00
}
return 1;
}
2005-09-11 19:09:11 +02:00
if (try) {
if (pp->wrleft > 0)
return 1;
return 0;
2005-04-21 16:53:53 +02:00
}
while (pp->wrleft > 0) {
2005-05-09 16:35:26 +02:00
int s;
2005-04-21 16:53:53 +02:00
/* Transfer one character to 'c'. */
if(pp->wrsafe) {
if ((s = sys_safecopyfrom(pp->wrproc, pp->wrvir_g,
pp->wrvir_offset, (vir_bytes) &c, 1, D)) != OK) {
printf("pty: safecopy failed (error %d)\n", s);
break;
}
pp->wrvir_offset++;
} else {
if ((s = sys_vircopy(pp->wrproc, D, (vir_bytes) pp->wrvir_g,
SELF, D, (vir_bytes) &c, (phys_bytes) 1)) != OK) {
2005-05-09 16:35:26 +02:00
printf("pty: copy failed (error %d)\n", s);
break;
}
pp->wrvir_g++;
2005-05-09 16:35:26 +02:00
}
2005-04-21 16:53:53 +02:00
/* Input processing. */
if (in_process(tp, &c, 1) == 0) break;
/* PTY writer bookkeeping. */
pp->wrcum++;
if (--pp->wrleft == 0) {
2005-08-01 16:40:21 +02:00
if (pp->wrsendreply) {
tty_reply(TASK_REPLY, pp->wrcaller, pp->wrproc,
pp->wrcum);
pp->wrcum = 0;
}
else
notify(pp->wrcaller);
2005-04-21 16:53:53 +02:00
}
}
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* pty_close *
*===========================================================================*/
PRIVATE int pty_close(tp, try)
2005-04-21 16:53:53 +02:00
tty_t *tp;
int try;
2005-04-21 16:53:53 +02:00
{
/* The tty side has closed, so shut down the pty side. */
pty_t *pp = tp->tty_priv;
if (!(pp->state & PTY_ACTIVE)) return;
if (pp->rdleft > 0) {
2005-08-01 16:40:21 +02:00
assert(!pp->rdsendreply);
notify(pp->rdcaller);
2005-04-21 16:53:53 +02:00
}
if (pp->wrleft > 0) {
2005-08-01 16:40:21 +02:00
assert(!pp->wrsendreply);
notify(pp->wrcaller);
2005-04-21 16:53:53 +02:00
}
if (pp->state & PTY_CLOSED) pp->state = 0; else pp->state |= TTY_CLOSED;
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* pty_icancel *
*===========================================================================*/
PRIVATE int pty_icancel(tp, try)
2005-04-21 16:53:53 +02:00
tty_t *tp;
int try;
2005-04-21 16:53:53 +02:00
{
/* Discard waiting input. */
pty_t *pp = tp->tty_priv;
if (pp->wrleft > 0) {
2005-08-01 16:40:21 +02:00
pp->wrcum += pp->wrleft;
pp->wrleft= 0;
notify(pp->wrcaller);
2005-04-21 16:53:53 +02:00
}
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* pty_ocancel *
*===========================================================================*/
PRIVATE int pty_ocancel(tp, try)
2005-04-21 16:53:53 +02:00
tty_t *tp;
int try;
2005-04-21 16:53:53 +02:00
{
/* Drain the output buffer. */
pty_t *pp = tp->tty_priv;
pp->ocount = 0;
pp->otail = pp->ohead;
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* pty_init *
*===========================================================================*/
2005-04-21 16:53:53 +02:00
PUBLIC void pty_init(tp)
tty_t *tp;
{
pty_t *pp;
int line;
/* Associate PTY and TTY structures. */
line = tp - &tty_table[NR_CONS + NR_RS_LINES];
pp = tp->tty_priv = &pty_table[line];
pp->tty = tp;
2005-08-05 15:50:58 +02:00
pp->select_ops = 0;
2005-04-21 16:53:53 +02:00
/* Set up output queue. */
pp->ohead = pp->otail = pp->obuf;
/* Fill in TTY function hooks. */
tp->tty_devread = pty_read;
tp->tty_devwrite = pty_write;
tp->tty_echo = pty_echo;
tp->tty_icancel = pty_icancel;
tp->tty_ocancel = pty_ocancel;
tp->tty_close = pty_close;
2005-08-05 15:50:58 +02:00
tp->tty_select_ops = 0;
2005-04-21 16:53:53 +02:00
}
2005-08-01 16:40:21 +02:00
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* pty_status *
*===========================================================================*/
2005-08-01 16:40:21 +02:00
PUBLIC int pty_status(message *m_ptr)
{
int i, event_found;
pty_t *pp;
event_found = 0;
for (i= 0, pp = pty_table; i<NR_PTYS; i++, pp++) {
2005-08-05 15:50:58 +02:00
if ((((pp->state & TTY_CLOSED) && pp->rdleft > 0) ||
2005-08-01 16:40:21 +02:00
pp->rdcum > 0) &&
pp->rdcaller == m_ptr->m_source)
{
m_ptr->m_type = DEV_REVIVE;
m_ptr->REP_ENDPT = pp->rdproc;
m_ptr->REP_IO_GRANT = pp->rdvir_g;
2005-08-01 16:40:21 +02:00
m_ptr->REP_STATUS = pp->rdcum;
pp->rdleft = pp->rdcum = 0;
event_found = 1;
break;
}
2005-08-05 15:50:58 +02:00
if ((((pp->state & TTY_CLOSED) && pp->wrleft > 0) ||
2005-08-01 16:40:21 +02:00
pp->wrcum > 0) &&
pp->wrcaller == m_ptr->m_source)
{
m_ptr->m_type = DEV_REVIVE;
m_ptr->REP_ENDPT = pp->wrproc;
m_ptr->REP_IO_GRANT = pp->wrvir_g;
2005-08-01 16:40:21 +02:00
if (pp->wrcum == 0)
m_ptr->REP_STATUS = EIO;
else
m_ptr->REP_STATUS = pp->wrcum;
pp->wrleft = pp->wrcum = 0;
event_found = 1;
break;
}
2005-08-05 15:50:58 +02:00
2005-09-11 19:09:11 +02:00
if (pp->select_ready_ops && pp->select_proc == m_ptr->m_source) {
2005-08-05 15:50:58 +02:00
m_ptr->m_type = DEV_IO_READY;
m_ptr->DEV_MINOR = PTYPX_MINOR + i;
m_ptr->DEV_SEL_OPS = pp->select_ready_ops;
pp->select_ready_ops = 0;
event_found = 1;
break;
}
2005-08-01 16:40:21 +02:00
}
return event_found;
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* select_try_pty *
*===========================================================================*/
2005-08-05 15:50:58 +02:00
PRIVATE int select_try_pty(tty_t *tp, int ops)
{
pty_t *pp = tp->tty_priv;
int r = 0;
2005-09-11 19:09:11 +02:00
if (ops & SEL_WR) {
2005-08-05 15:50:58 +02:00
/* Write won't block on error. */
if (pp->state & TTY_CLOSED) r |= SEL_WR;
else if (pp->wrleft != 0 || pp->wrcum != 0) r |= SEL_WR;
else r |= SEL_WR;
}
2005-09-11 19:09:11 +02:00
if (ops & SEL_RD) {
2005-08-05 15:50:58 +02:00
/* Read won't block on error. */
if (pp->state & TTY_CLOSED) r |= SEL_RD;
2005-09-11 19:09:11 +02:00
else if (pp->rdleft != 0 || pp->rdcum != 0) r |= SEL_RD;
else if (pp->ocount > 0) r |= SEL_RD; /* Actual data. */
2005-08-05 15:50:58 +02:00
}
return r;
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* select_retry_pty *
*===========================================================================*/
2005-08-05 15:50:58 +02:00
PUBLIC void select_retry_pty(tty_t *tp)
{
pty_t *pp = tp->tty_priv;
int r;
/* See if the pty side of a pty is ready to return a select. */
2005-09-11 19:09:11 +02:00
if (pp->select_ops && (r=select_try_pty(tp, pp->select_ops))) {
2005-08-05 15:50:58 +02:00
pp->select_ops &= ~r;
pp->select_ready_ops |= r;
notify(pp->select_proc);
}
}
2005-09-11 19:09:11 +02:00
/*===========================================================================*
* pty_select *
*===========================================================================*/
2005-08-05 15:50:58 +02:00
PRIVATE int pty_select(tty_t *tp, message *m)
{
pty_t *pp = tp->tty_priv;
int ops, ready_ops = 0, watch;
ops = m->IO_ENDPT & (SEL_RD|SEL_WR|SEL_ERR);
watch = (m->IO_ENDPT & SEL_NOTIFY) ? 1 : 0;
2005-08-05 15:50:58 +02:00
ready_ops = select_try_pty(tp, ops);
2005-09-11 19:09:11 +02:00
if (!ready_ops && ops && watch) {
2005-08-05 15:50:58 +02:00
pp->select_ops |= ops;
pp->select_proc = m->m_source;
}
return ready_ops;
}
2005-04-21 16:53:53 +02:00
#endif /* NR_PTYS > 0 */