b01e9ebfdb
.Split TTY in order to support both x86 and ARM. .Add support for the TI 16750 UARTs on OMAP35x. .Various other improvements: .Kernel messages are printed using generic terminal write functions. That is, they are no longer directly displayed on the console. .The console can now be displayed on any terminal. This is configured by the "console={tty00,tty01,ttyc2,ttyc3,ttyc4}" boot variable -- basically any valid /dev/tty* terminal. .Cutify kernel messages with colors. Configured by "kernelclr={1,2,3,4,5,6,7}" boot variable.
1835 lines
54 KiB
C
1835 lines
54 KiB
C
/* This file contains the terminal driver, both for the IBM console and regular
|
|
* ASCII terminals. It handles only the device-independent part of a TTY, the
|
|
* device dependent parts are in console.c, rs232.c, etc. This file contains
|
|
* two main entry points, tty_task() and tty_wakeup(), and several minor entry
|
|
* points for use by the device-dependent code.
|
|
*
|
|
* The device-independent part accepts "keyboard" input from the device-
|
|
* dependent part, performs input processing (special key interpretation),
|
|
* and sends the input to a process reading from the TTY. Output to a TTY
|
|
* is sent to the device-dependent code for output processing and "screen"
|
|
* display. Input processing is done by the device by calling 'in_process'
|
|
* on the input characters, output processing may be done by the device itself
|
|
* or by calling 'out_process'. The TTY takes care of input queuing, the
|
|
* device does the output queuing. If a device receives an external signal,
|
|
* like an interrupt, then it causes tty_wakeup() to be run by the CLOCK task
|
|
* to, you guessed it, wake up the TTY to check if input or output can
|
|
* continue.
|
|
*
|
|
* The valid messages and their parameters are:
|
|
*
|
|
* notify from HARDWARE: output has been completed or input has arrived
|
|
* notify from SYSTEM : e.g., MINIX wants to shutdown; run code to
|
|
* cleanly stop
|
|
* DEV_READ: a process wants to read from a terminal
|
|
* DEV_WRITE: a process wants to write on a terminal
|
|
* DEV_IOCTL: a process wants to change a terminal's parameters
|
|
* DEV_OPEN: a tty line has been opened
|
|
* DEV_CLOSE: a tty line has been closed
|
|
* DEV_SELECT: start select notification request
|
|
* DEV_STATUS: FS wants to know status for SELECT or REVIVE
|
|
* CANCEL: terminate a previous incomplete system call immediately
|
|
*
|
|
* m_type TTY_LINE USER_ENDPT COUNT TTY_SPEKS IO_GRANT
|
|
* -----------------------------------------------------------------
|
|
* | HARD_INT | | | | | |
|
|
* |-------------+---------+---------+---------+---------+---------|
|
|
* | SYS_SIG | sig set | | | | |
|
|
* |-------------+---------+---------+---------+---------+---------|
|
|
* | DEV_READ |minor dev| proc nr | count | | grant |
|
|
* |-------------+---------+---------+---------+---------+---------|
|
|
* | DEV_WRITE |minor dev| proc nr | count | | grant |
|
|
* |-------------+---------+---------+---------+---------+---------|
|
|
* | DEV_IOCTL |minor dev| proc nr |func code|erase etc| |
|
|
* |-------------+---------+---------+---------+---------+---------|
|
|
* | DEV_OPEN |minor dev| proc nr | O_NOCTTY| | |
|
|
* |-------------+---------+---------+---------+---------+---------|
|
|
* | DEV_CLOSE |minor dev| proc nr | | | |
|
|
* |-------------+---------+---------+---------+---------+---------|
|
|
* | DEV_STATUS | | | | | |
|
|
* |-------------+---------+---------+---------+---------+---------|
|
|
* | CANCEL |minor dev| proc nr | | | |
|
|
* -----------------------------------------------------------------
|
|
*
|
|
* Changes:
|
|
* Jan 20, 2004 moved TTY driver to user-space (Jorrit N. Herder)
|
|
* Sep 20, 2004 local timer management/ sync alarms (Jorrit N. Herder)
|
|
* Jul 13, 2004 support for function key observers (Jorrit N. Herder)
|
|
*/
|
|
|
|
#include <assert.h>
|
|
#include <minix/drivers.h>
|
|
#include <minix/driver.h>
|
|
#include <termios.h>
|
|
#include <sys/ioc_tty.h>
|
|
#include <signal.h>
|
|
#include <minix/callnr.h>
|
|
#include <minix/sys_config.h>
|
|
#include <minix/tty.h>
|
|
#include <minix/keymap.h>
|
|
#include <minix/endpoint.h>
|
|
#include "tty.h"
|
|
|
|
#include <sys/time.h>
|
|
#include <sys/select.h>
|
|
|
|
unsigned long kbd_irq_set = 0;
|
|
unsigned long rs_irq_set = 0;
|
|
|
|
/* Address of a tty structure. */
|
|
#define tty_addr(line) (&tty_table[line])
|
|
|
|
/* Macros for magic tty types. */
|
|
#define isconsole(tp) ((tp) < tty_addr(NR_CONS))
|
|
#define ispty(tp) ((tp) != NULL && (tp)->tty_minor >= TTYPX_MINOR)
|
|
|
|
/* Macros for magic tty structure pointers. */
|
|
#define FIRST_TTY tty_addr(0)
|
|
#define END_TTY tty_addr(sizeof(tty_table) / sizeof(tty_table[0]))
|
|
|
|
/* A device exists if at least its 'devread' function is defined. */
|
|
#define tty_active(tp) ((tp)->tty_devread != NULL)
|
|
|
|
/* RS232 lines or pseudo terminals can be completely configured out. */
|
|
#if NR_RS_LINES == 0
|
|
#define rs_init(tp) ((void) 0)
|
|
#endif
|
|
|
|
#if NR_PTYS == 0
|
|
#define pty_init(tp) ((void) 0)
|
|
#define do_pty(tp, mp) ((void) 0)
|
|
#endif
|
|
|
|
struct kmessages kmess;
|
|
|
|
static void tty_timed_out(timer_t *tp);
|
|
static void settimer(tty_t *tty_ptr, int enable);
|
|
static void do_cancel(tty_t *tp, message *m_ptr);
|
|
static void do_ioctl(tty_t *tp, message *m_ptr);
|
|
static void do_open(tty_t *tp, message *m_ptr);
|
|
static void do_close(tty_t *tp, message *m_ptr);
|
|
static void do_read(tty_t *tp, message *m_ptr);
|
|
static void do_write(tty_t *tp, message *m_ptr);
|
|
static void do_select(tty_t *tp, message *m_ptr);
|
|
static void do_status(message *m_ptr);
|
|
static void in_transfer(tty_t *tp);
|
|
static int tty_echo(tty_t *tp, int ch);
|
|
static void rawecho(tty_t *tp, int ch);
|
|
static int back_over(tty_t *tp);
|
|
static void reprint(tty_t *tp);
|
|
static void dev_ioctl(tty_t *tp);
|
|
static void setattr(tty_t *tp);
|
|
static void tty_icancel(tty_t *tp);
|
|
static void tty_init(void);
|
|
static void do_new_kmess(void);
|
|
static tty_t * line2tty(int line);
|
|
static void set_console_line(char term[CONS_ARG]);
|
|
static void set_kernel_color(char color[CONS_ARG]);
|
|
static void set_color(tty_t *tp, int color);
|
|
static void reset_color(tty_t *tp);
|
|
|
|
/* Default attributes. */
|
|
static struct termios termios_defaults = {
|
|
TINPUT_DEF, TOUTPUT_DEF, TCTRL_DEF, TLOCAL_DEF, TSPEED_DEF, TSPEED_DEF,
|
|
{
|
|
TEOF_DEF, TEOL_DEF, TERASE_DEF, TINTR_DEF, TKILL_DEF, TMIN_DEF,
|
|
TQUIT_DEF, TTIME_DEF, TSUSP_DEF, TSTART_DEF, TSTOP_DEF,
|
|
TREPRINT_DEF, TLNEXT_DEF, TDISCARD_DEF,
|
|
},
|
|
};
|
|
static struct winsize winsize_defaults; /* = all zeroes */
|
|
|
|
/* Global variables for the TTY task (declared extern in tty.h). */
|
|
tty_t tty_table[NR_CONS+NR_RS_LINES+NR_PTYS];
|
|
int ccurrent; /* currently active console */
|
|
struct machine machine; /* kernel environment variables */
|
|
u32_t system_hz;
|
|
u32_t consoleline = CONS_MINOR;
|
|
u32_t kernel_msg_color = 0;
|
|
|
|
/* SEF functions and variables. */
|
|
static void sef_local_startup(void);
|
|
static int sef_cb_init_fresh(int type, sef_init_info_t *info);
|
|
static void sef_cb_signal_handler(int signo);
|
|
|
|
extern struct minix_kerninfo *_minix_kerninfo;
|
|
|
|
/*===========================================================================*
|
|
* tty_task *
|
|
*===========================================================================*/
|
|
int main(void)
|
|
{
|
|
/* Main routine of the terminal task. */
|
|
|
|
message tty_mess; /* buffer for all incoming messages */
|
|
int ipc_status;
|
|
unsigned line;
|
|
int r;
|
|
register tty_t *tp;
|
|
|
|
/* SEF local startup. */
|
|
sef_local_startup();
|
|
while (TRUE) {
|
|
/* Check for and handle any events on any of the ttys. */
|
|
for (tp = FIRST_TTY; tp < END_TTY; tp++) {
|
|
if (tp->tty_events) handle_events(tp);
|
|
}
|
|
|
|
/* Get a request message. */
|
|
r= driver_receive(ANY, &tty_mess, &ipc_status);
|
|
if (r != 0)
|
|
panic("driver_receive failed with: %d", r);
|
|
|
|
/* First handle all kernel notification types that the TTY supports.
|
|
* - An alarm went off, expire all timers and handle the events.
|
|
* - A hardware interrupt also is an invitation to check for events.
|
|
* - A new kernel message is available for printing.
|
|
* - Reset the console on system shutdown.
|
|
* Then see if this message is different from a normal device driver
|
|
* request and should be handled separately. These extra functions
|
|
* do not operate on a device, in constrast to the driver requests.
|
|
*/
|
|
|
|
if (is_ipc_notify(ipc_status)) {
|
|
switch (_ENDPOINT_P(tty_mess.m_source)) {
|
|
case CLOCK:
|
|
/* run watchdogs of expired timers */
|
|
expire_timers(tty_mess.NOTIFY_TIMESTAMP);
|
|
break;
|
|
case HARDWARE:
|
|
/* hardware interrupt notification */
|
|
|
|
/* fetch chars from keyboard */
|
|
if (tty_mess.NOTIFY_ARG & kbd_irq_set)
|
|
kbd_interrupt(&tty_mess);
|
|
#if NR_RS_LINES > 0
|
|
/* serial I/O */
|
|
if (tty_mess.NOTIFY_ARG & rs_irq_set)
|
|
rs_interrupt(&tty_mess);
|
|
#endif
|
|
/* run watchdogs of expired timers */
|
|
expire_timers(tty_mess.NOTIFY_TIMESTAMP);
|
|
break;
|
|
default:
|
|
/* do nothing */
|
|
break;
|
|
}
|
|
|
|
/* done, get new message */
|
|
continue;
|
|
}
|
|
|
|
switch (tty_mess.m_type) {
|
|
case FKEY_CONTROL: /* (un)register a fkey observer */
|
|
do_fkey_ctl(&tty_mess);
|
|
continue;
|
|
case INPUT_EVENT:
|
|
do_kb_inject(&tty_mess);
|
|
continue;
|
|
default: /* should be a driver request */
|
|
; /* do nothing; end switch */
|
|
}
|
|
|
|
/* Only device requests should get to this point. All requests,
|
|
* except DEV_STATUS, have a minor device number. Check this
|
|
* exception and get the minor device number otherwise.
|
|
*/
|
|
if (tty_mess.m_type == DEV_STATUS) {
|
|
do_status(&tty_mess);
|
|
continue;
|
|
}
|
|
line = tty_mess.TTY_LINE;
|
|
if (line == CONS_MINOR || line == LOG_MINOR) {
|
|
/* /dev/log output goes to /dev/console */
|
|
if (consoleline != CONS_MINOR) {
|
|
/* Console output must redirected */
|
|
line = consoleline;
|
|
tty_mess.TTY_LINE = line;
|
|
}
|
|
}
|
|
if (line == KBD_MINOR) {
|
|
do_kbd(&tty_mess);
|
|
continue;
|
|
} else if (line == KBDAUX_MINOR) {
|
|
do_kbdaux(&tty_mess);
|
|
continue;
|
|
} else if (line == VIDEO_MINOR) {
|
|
do_video(&tty_mess);
|
|
continue;
|
|
} else {
|
|
tp = line2tty(line);
|
|
|
|
/* Terminals and pseudo terminals belong together. We can only
|
|
* make a distinction between the two based on position in the
|
|
* tty_table and not on minor number (i.e., use ispty macro).
|
|
* Hence this special case.
|
|
*/
|
|
if (line - PTYPX_MINOR < NR_PTYS &&
|
|
tty_mess.m_type != DEV_IOCTL_S){
|
|
do_pty(tp, &tty_mess);
|
|
continue;
|
|
}
|
|
}
|
|
|
|
/* If the device doesn't exist or is not configured return ENXIO. */
|
|
if (tp == NULL || ! tty_active(tp)) {
|
|
if (tty_mess.m_source != LOG_PROC_NR) {
|
|
tty_reply(TASK_REPLY, tty_mess.m_source,
|
|
tty_mess.USER_ENDPT, ENXIO);
|
|
}
|
|
continue;
|
|
}
|
|
|
|
/* Execute the requested device driver function. */
|
|
switch (tty_mess.m_type) {
|
|
case DEV_READ_S: do_read(tp, &tty_mess); break;
|
|
case DEV_WRITE_S: do_write(tp, &tty_mess); break;
|
|
case DEV_IOCTL_S: do_ioctl(tp, &tty_mess); break;
|
|
case DEV_OPEN: do_open(tp, &tty_mess); break;
|
|
case DEV_CLOSE: do_close(tp, &tty_mess); break;
|
|
case DEV_SELECT: do_select(tp, &tty_mess); break;
|
|
case CANCEL: do_cancel(tp, &tty_mess); break;
|
|
default:
|
|
printf("Warning, TTY got unexpected request %d from %d\n",
|
|
tty_mess.m_type, tty_mess.m_source);
|
|
tty_reply(TASK_REPLY, tty_mess.m_source,
|
|
tty_mess.USER_ENDPT, EINVAL);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
set_color(tty_t *tp, int color)
|
|
{
|
|
message msg;
|
|
char buf[8];
|
|
|
|
buf[0] = '\033';
|
|
snprintf(&buf[1], sizeof(buf) - 1, "[1;%dm", color);
|
|
msg.m_source = KERNEL;
|
|
msg.IO_GRANT = buf;
|
|
msg.COUNT = sizeof(buf);
|
|
do_write(tp, &msg);
|
|
}
|
|
|
|
static void
|
|
reset_color(tty_t *tp)
|
|
{
|
|
message msg;
|
|
char buf[8];
|
|
|
|
#define SGR_COLOR_RESET 39
|
|
buf[0] = '\033';
|
|
snprintf(&buf[1], sizeof(buf) - 1, "[0;%dm", SGR_COLOR_RESET);
|
|
msg.m_source = KERNEL;
|
|
msg.IO_GRANT = buf;
|
|
msg.COUNT = sizeof(buf);
|
|
do_write(tp, &msg);
|
|
}
|
|
|
|
static tty_t *
|
|
line2tty(int line)
|
|
{
|
|
/* Convert a terminal line to tty_table pointer */
|
|
|
|
tty_t* tp;
|
|
|
|
if (line == KBD_MINOR || line == KBDAUX_MINOR || line == VIDEO_MINOR) {
|
|
return(NULL);
|
|
} else if ((line - CONS_MINOR) < NR_CONS) {
|
|
tp = tty_addr(line - CONS_MINOR);
|
|
} else if (line == LOG_MINOR) {
|
|
tp = tty_addr(consoleline);
|
|
} else if ((line - RS232_MINOR) < NR_RS_LINES) {
|
|
tp = tty_addr(line - RS232_MINOR + NR_CONS);
|
|
} else if ((line - TTYPX_MINOR) < NR_PTYS) {
|
|
tp = tty_addr(line - TTYPX_MINOR + NR_CONS + NR_RS_LINES);
|
|
} else if ((line - PTYPX_MINOR) < NR_PTYS) {
|
|
tp = tty_addr(line - PTYPX_MINOR + NR_CONS + NR_RS_LINES);
|
|
} else {
|
|
tp = NULL;
|
|
}
|
|
|
|
return(tp);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* sef_local_startup *
|
|
*===========================================================================*/
|
|
static void sef_local_startup()
|
|
{
|
|
/* Register init callbacks. */
|
|
sef_setcb_init_fresh(sef_cb_init_fresh);
|
|
sef_setcb_init_restart(sef_cb_init_fresh);
|
|
|
|
/* No live update support for now. */
|
|
|
|
/* Register signal callbacks. */
|
|
sef_setcb_signal_handler(sef_cb_signal_handler);
|
|
|
|
/* Let SEF perform startup. */
|
|
sef_startup();
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* sef_cb_init_fresh *
|
|
*===========================================================================*/
|
|
static int sef_cb_init_fresh(int UNUSED(type), sef_init_info_t *UNUSED(info))
|
|
{
|
|
/* Initialize the tty driver. */
|
|
int r;
|
|
char val[CONS_ARG];
|
|
|
|
/* Get kernel environment (protected_mode, pc_at and ega are needed). */
|
|
if (OK != (r=sys_getmachine(&machine))) {
|
|
panic("Couldn't obtain kernel environment: %d", r);
|
|
}
|
|
|
|
if (env_get_param("console", val, sizeof(val)) == OK) {
|
|
set_console_line(val);
|
|
}
|
|
|
|
if ((r = env_get_param("kernelclr", val, sizeof(val))) == OK) {
|
|
set_kernel_color(val);
|
|
}
|
|
|
|
/* Initialize the TTY driver. */
|
|
tty_init();
|
|
|
|
/* Final one-time keyboard initialization. */
|
|
kb_init_once();
|
|
|
|
return(OK);
|
|
}
|
|
|
|
static void
|
|
set_console_line(char term[CONS_ARG])
|
|
{
|
|
/* Parse 'term' and redirect console output there. */
|
|
int i;
|
|
|
|
/* Console */
|
|
if (!strncmp(term, "console", CONS_ARG - 1)) {
|
|
consoleline = CONS_MINOR+0;
|
|
}
|
|
|
|
/* The other console terminals */
|
|
for (i = 1; i < NR_CONS; i++) {
|
|
char cons[6];
|
|
strlcpy(cons, "ttyc0", sizeof(cons));
|
|
cons[4] += i;
|
|
if (!strncmp(term, cons,
|
|
CONS_ARG < sizeof(cons) ? CONS_ARG-1 : sizeof(cons) - 1))
|
|
consoleline = CONS_MINOR + i;
|
|
}
|
|
|
|
/* Serial lines */
|
|
for (i = 0; i < NR_RS_LINES; i++) {
|
|
char sercons[6];
|
|
strlcpy(sercons, "tty00", sizeof(sercons));
|
|
sercons[4] += i;
|
|
if (!strncmp(term, sercons,
|
|
CONS_ARG < sizeof(sercons) ? CONS_ARG-1:sizeof(sercons)-1))
|
|
consoleline = RS232_MINOR + i;
|
|
}
|
|
}
|
|
|
|
static void
|
|
set_kernel_color(char color[CONS_ARG])
|
|
{
|
|
int def_color;
|
|
|
|
#define SGR_COLOR_START 30
|
|
#define SGR_COLOR_END 37
|
|
|
|
def_color = atoi(color);
|
|
if ((SGR_COLOR_START + def_color) >= SGR_COLOR_START &&
|
|
(SGR_COLOR_START + def_color) <= SGR_COLOR_END) {
|
|
kernel_msg_color = def_color + SGR_COLOR_START;
|
|
}
|
|
}
|
|
|
|
static void
|
|
do_new_kmess(void)
|
|
{
|
|
/* Kernel wants to print a new message */
|
|
struct kmessages *kmess_ptr; /* kmessages structure */
|
|
char kernel_buf_copy[2*_KMESS_BUF_SIZE];
|
|
static int prev_next = 0;
|
|
int bytes, copy, restore = 0;
|
|
tty_t *tp, rtp;
|
|
message print_kmsg;
|
|
|
|
assert(_minix_kerninfo);
|
|
kmess_ptr = _minix_kerninfo->kmessages;
|
|
|
|
/* The kernel buffer is circular; print only the new part. Determine
|
|
* how many new bytes there are with the help of current and
|
|
* previous 'next' index. This works fine if less than _KMESS_BUF_SIZE
|
|
* bytes is new data; else we miss % _KMESS_BUF_SIZE here.
|
|
* Check for size being positive; the buffer might as well be emptied!
|
|
*/
|
|
if (kmess_ptr->km_size > 0) {
|
|
bytes = ((kmess_ptr->km_next + _KMESS_BUF_SIZE) - prev_next) %
|
|
_KMESS_BUF_SIZE;
|
|
/* Copy from current position to end of buffer */
|
|
copy = (prev_next + bytes) % _KMESS_BUF_SIZE;
|
|
memcpy(kernel_buf_copy, &kmess_ptr->km_buf[prev_next], copy);
|
|
|
|
/* Copy remainder from start of buffer */
|
|
if (copy < bytes) {
|
|
memcpy(&kernel_buf_copy[copy], &kmess_ptr->km_buf[0],
|
|
bytes - copy);
|
|
}
|
|
|
|
tp = line2tty(consoleline);
|
|
if (tp == NULL || !tty_active(tp))
|
|
panic("Don't know where to send kernel messages");
|
|
if (tp->tty_outleft > 0) {
|
|
/* Terminal is already printing */
|
|
rtp = *tp; /* Make backup */
|
|
tp->tty_outleft = 0; /* So do_write is happy */
|
|
restore = 1;
|
|
}
|
|
|
|
if (kernel_msg_color != 0)
|
|
set_color(tp, kernel_msg_color);
|
|
print_kmsg.m_source = KERNEL;
|
|
print_kmsg.IO_GRANT = kernel_buf_copy;
|
|
print_kmsg.COUNT = bytes;
|
|
do_write(tp, &print_kmsg);
|
|
if (kernel_msg_color != 0)
|
|
reset_color(tp);
|
|
if (restore) {
|
|
*tp = rtp;
|
|
}
|
|
}
|
|
|
|
/* Store 'next' pointer so that we can determine what part of the
|
|
* kernel messages buffer to print next time a notification arrives.
|
|
*/
|
|
prev_next = kmess_ptr->km_next;
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* sef_cb_signal_handler *
|
|
*===========================================================================*/
|
|
static void sef_cb_signal_handler(int signo)
|
|
{
|
|
/* Check for known signals, ignore anything else. */
|
|
switch(signo) {
|
|
/* There is a pending message from the kernel. */
|
|
case SIGKMESS:
|
|
do_new_kmess();
|
|
break;
|
|
/* Switch to primary console on termination. */
|
|
case SIGTERM:
|
|
cons_stop();
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* do_status *
|
|
*===========================================================================*/
|
|
static void do_status(m_ptr)
|
|
message *m_ptr;
|
|
{
|
|
register struct tty *tp;
|
|
int event_found;
|
|
int status;
|
|
int ops;
|
|
|
|
/* Check for select or revive events on any of the ttys. If we found an,
|
|
* event return a single status message for it. The FS will make another
|
|
* call to see if there is more.
|
|
*/
|
|
event_found = 0;
|
|
for (tp = FIRST_TTY; tp < END_TTY; tp++) {
|
|
if ((ops = select_try(tp, tp->tty_select_ops)) &&
|
|
tp->tty_select_proc == m_ptr->m_source) {
|
|
|
|
/* I/O for a selected minor device is ready. */
|
|
m_ptr->m_type = DEV_IO_READY;
|
|
m_ptr->DEV_MINOR = tp->tty_minor;
|
|
m_ptr->DEV_SEL_OPS = ops;
|
|
|
|
tp->tty_select_ops &= ~ops; /* unmark select event */
|
|
event_found = 1;
|
|
break;
|
|
}
|
|
else if (tp->tty_inrevived && tp->tty_incaller == m_ptr->m_source) {
|
|
|
|
/* Suspended request finished. Send a REVIVE. */
|
|
m_ptr->m_type = DEV_REVIVE;
|
|
m_ptr->REP_ENDPT = tp->tty_inproc;
|
|
m_ptr->REP_IO_GRANT = tp->tty_ingrant;
|
|
m_ptr->REP_STATUS = tp->tty_incum;
|
|
|
|
tp->tty_inleft = tp->tty_incum = 0;
|
|
tp->tty_inrevived = 0; /* unmark revive event */
|
|
tp->tty_ingrant = GRANT_INVALID;
|
|
event_found = 1;
|
|
break;
|
|
}
|
|
else if (tp->tty_outrevived && tp->tty_outcaller == m_ptr->m_source) {
|
|
|
|
/* Suspended request finished. Send a REVIVE. */
|
|
m_ptr->m_type = DEV_REVIVE;
|
|
m_ptr->REP_ENDPT = tp->tty_outproc;
|
|
m_ptr->REP_IO_GRANT = tp->tty_outgrant;
|
|
m_ptr->REP_STATUS = tp->tty_outcum;
|
|
|
|
tp->tty_outcum = 0;
|
|
tp->tty_outrevived = 0; /* unmark revive event */
|
|
tp->tty_outgrant = GRANT_INVALID;
|
|
event_found = 1;
|
|
break;
|
|
}
|
|
else if (tp->tty_iorevived && tp->tty_iocaller == m_ptr->m_source) {
|
|
|
|
/* Suspended request finished. Send a REVIVE. */
|
|
m_ptr->m_type = DEV_REVIVE;
|
|
m_ptr->REP_ENDPT = tp->tty_ioproc;
|
|
m_ptr->REP_IO_GRANT = tp->tty_iogrant;
|
|
m_ptr->REP_STATUS = tp->tty_iostatus;
|
|
tp->tty_iorevived = 0; /* unmark revive event */
|
|
tp->tty_iogrant = GRANT_INVALID;
|
|
event_found = 1;
|
|
break;
|
|
}
|
|
}
|
|
|
|
#if NR_PTYS > 0
|
|
if (!event_found)
|
|
event_found = pty_status(m_ptr);
|
|
#endif
|
|
if (!event_found)
|
|
event_found= kbd_status(m_ptr);
|
|
|
|
if (! event_found) {
|
|
/* No events of interest were found. Return an empty message. */
|
|
m_ptr->m_type = DEV_NO_STATUS;
|
|
}
|
|
|
|
/* Almost done. Send back the reply message to the caller. */
|
|
status = send(m_ptr->m_source, m_ptr);
|
|
if (status != OK) {
|
|
printf("tty`do_status: send to %d failed: %d\n",
|
|
m_ptr->m_source, status);
|
|
}
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* do_read *
|
|
*===========================================================================*/
|
|
static void do_read(tp, m_ptr)
|
|
register tty_t *tp; /* pointer to tty struct */
|
|
register message *m_ptr; /* pointer to message sent to the task */
|
|
{
|
|
/* A process wants to read from a terminal. */
|
|
int r;
|
|
|
|
/* Check if there is already a process hanging in a read, check if the
|
|
* parameters are correct, do I/O.
|
|
*/
|
|
if (tp->tty_inleft > 0) {
|
|
r = EIO;
|
|
} else
|
|
if (m_ptr->COUNT <= 0) {
|
|
r = EINVAL;
|
|
} else if (tp->tty_ingrant != GRANT_INVALID) {
|
|
/* This is actually a fundamental problem with TTY; it can handle
|
|
* only one reader per minor device. If we don't return an error,
|
|
* we'll overwrite the previous reader and that process will get
|
|
* stuck forever. */
|
|
r = ENOBUFS;
|
|
} else {
|
|
/* Copy information from the message to the tty struct. */
|
|
tp->tty_inrepcode = TASK_REPLY;
|
|
tp->tty_incaller = m_ptr->m_source;
|
|
tp->tty_inproc = m_ptr->USER_ENDPT;
|
|
tp->tty_ingrant = (cp_grant_id_t) m_ptr->IO_GRANT;
|
|
tp->tty_inoffset = 0;
|
|
tp->tty_inleft = m_ptr->COUNT;
|
|
|
|
if (!(tp->tty_termios.c_lflag & ICANON)
|
|
&& tp->tty_termios.c_cc[VTIME] > 0) {
|
|
if (tp->tty_termios.c_cc[VMIN] == 0) {
|
|
/* MIN & TIME specify a read timer that finishes the
|
|
* read in TIME/10 seconds if no bytes are available.
|
|
*/
|
|
settimer(tp, TRUE);
|
|
tp->tty_min = 1;
|
|
} else {
|
|
/* MIN & TIME specify an inter-byte timer that may
|
|
* have to be cancelled if there are no bytes yet.
|
|
*/
|
|
if (tp->tty_eotct == 0) {
|
|
settimer(tp, FALSE);
|
|
tp->tty_min = tp->tty_termios.c_cc[VMIN];
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Anything waiting in the input buffer? Clear it out... */
|
|
in_transfer(tp);
|
|
/* ...then go back for more. */
|
|
handle_events(tp);
|
|
if (tp->tty_inleft == 0) {
|
|
return; /* already done */
|
|
}
|
|
|
|
/* There were no bytes in the input queue available, so suspend
|
|
* the caller.
|
|
*/
|
|
r = SUSPEND; /* suspend the caller */
|
|
tp->tty_inrepcode = TTY_REVIVE;
|
|
}
|
|
tty_reply(TASK_REPLY, m_ptr->m_source, m_ptr->USER_ENDPT, r);
|
|
if (tp->tty_select_ops)
|
|
select_retry(tp);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* do_write *
|
|
*===========================================================================*/
|
|
static void do_write(tp, m_ptr)
|
|
register tty_t *tp;
|
|
register message *m_ptr; /* pointer to message sent to the task */
|
|
{
|
|
/* A process wants to write on a terminal. */
|
|
int r;
|
|
|
|
/* Check if there is already a process hanging in a write, check if the
|
|
* parameters are correct, do I/O.
|
|
*/
|
|
if (tp->tty_outleft > 0) {
|
|
r = EIO;
|
|
} else
|
|
if (m_ptr->COUNT <= 0) {
|
|
r = EINVAL;
|
|
} else {
|
|
/* Copy message parameters to the tty structure. */
|
|
tp->tty_outrepcode = TASK_REPLY;
|
|
tp->tty_outcaller = m_ptr->m_source;
|
|
tp->tty_outproc = m_ptr->USER_ENDPT;
|
|
tp->tty_outgrant = (cp_grant_id_t) m_ptr->IO_GRANT;
|
|
tp->tty_outoffset = 0;
|
|
tp->tty_outleft = m_ptr->COUNT;
|
|
|
|
/* Try to write. */
|
|
handle_events(tp);
|
|
if (tp->tty_outleft == 0)
|
|
return; /* already done */
|
|
|
|
/* None or not all the bytes could be written, so suspend the
|
|
* caller.
|
|
*/
|
|
r = SUSPEND; /* suspend the caller */
|
|
tp->tty_outrepcode = TTY_REVIVE;
|
|
}
|
|
tty_reply(TASK_REPLY, m_ptr->m_source, m_ptr->USER_ENDPT, r);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* do_ioctl *
|
|
*===========================================================================*/
|
|
static void do_ioctl(tp, m_ptr)
|
|
register tty_t *tp;
|
|
message *m_ptr; /* pointer to message sent to task */
|
|
{
|
|
/* Perform an IOCTL on this terminal. Posix termios calls are handled
|
|
* by the IOCTL system call
|
|
*/
|
|
|
|
int r;
|
|
union {
|
|
int i;
|
|
} param;
|
|
size_t size;
|
|
|
|
/* Size of the ioctl parameter. */
|
|
switch (m_ptr->TTY_REQUEST) {
|
|
case TCGETS: /* Posix tcgetattr function */
|
|
case TCSETS: /* Posix tcsetattr function, TCSANOW option */
|
|
case TCSETSW: /* Posix tcsetattr function, TCSADRAIN option */
|
|
case TCSETSF: /* Posix tcsetattr function, TCSAFLUSH option */
|
|
size = sizeof(struct termios);
|
|
break;
|
|
|
|
case TCSBRK: /* Posix tcsendbreak function */
|
|
case TCFLOW: /* Posix tcflow function */
|
|
case TCFLSH: /* Posix tcflush function */
|
|
case TIOCGPGRP: /* Posix tcgetpgrp function */
|
|
case TIOCSPGRP: /* Posix tcsetpgrp function */
|
|
size = sizeof(int);
|
|
break;
|
|
|
|
case TIOCGWINSZ: /* get window size (not Posix) */
|
|
case TIOCSWINSZ: /* set window size (not Posix) */
|
|
size = sizeof(struct winsize);
|
|
break;
|
|
|
|
case KIOCSMAP: /* load keymap (Minix extension) */
|
|
size = sizeof(keymap_t);
|
|
break;
|
|
|
|
case TIOCSFON: /* load font (Minix extension) */
|
|
size = sizeof(u8_t [8192]);
|
|
break;
|
|
|
|
case TCDRAIN: /* Posix tcdrain function -- no parameter */
|
|
default: size = 0;
|
|
}
|
|
|
|
r = OK;
|
|
switch (m_ptr->TTY_REQUEST) {
|
|
case TCGETS:
|
|
/* Get the termios attributes. */
|
|
r = sys_safecopyto(m_ptr->m_source, (cp_grant_id_t) m_ptr->IO_GRANT, 0,
|
|
(vir_bytes) &tp->tty_termios, (vir_bytes) size);
|
|
break;
|
|
|
|
case TCSETSW:
|
|
case TCSETSF:
|
|
case TCDRAIN:
|
|
if (tp->tty_outleft > 0) {
|
|
/* Wait for all ongoing output processing to finish. */
|
|
tp->tty_iocaller = m_ptr->m_source;
|
|
tp->tty_ioproc = m_ptr->USER_ENDPT;
|
|
tp->tty_ioreq = m_ptr->REQUEST;
|
|
tp->tty_iogrant = (cp_grant_id_t) m_ptr->IO_GRANT;
|
|
r = SUSPEND;
|
|
break;
|
|
}
|
|
if (m_ptr->TTY_REQUEST == TCDRAIN) break;
|
|
if (m_ptr->TTY_REQUEST == TCSETSF) tty_icancel(tp);
|
|
/*FALL THROUGH*/
|
|
case TCSETS:
|
|
/* Set the termios attributes. */
|
|
r = sys_safecopyfrom(m_ptr->m_source, (cp_grant_id_t) m_ptr->IO_GRANT,
|
|
0, (vir_bytes) &tp->tty_termios, (vir_bytes) size);
|
|
if (r != OK) break;
|
|
setattr(tp);
|
|
break;
|
|
|
|
case TCFLSH:
|
|
r = sys_safecopyfrom(m_ptr->m_source, (cp_grant_id_t) m_ptr->IO_GRANT,
|
|
0, (vir_bytes) ¶m.i, (vir_bytes) size);
|
|
if (r != OK) break;
|
|
switch (param.i) {
|
|
case TCIFLUSH: tty_icancel(tp); break;
|
|
case TCOFLUSH: (*tp->tty_ocancel)(tp, 0); break;
|
|
case TCIOFLUSH: tty_icancel(tp); (*tp->tty_ocancel)(tp, 0); break;
|
|
default: r = EINVAL;
|
|
}
|
|
break;
|
|
|
|
case TCFLOW:
|
|
r = sys_safecopyfrom(m_ptr->m_source, (cp_grant_id_t) m_ptr->IO_GRANT,
|
|
0, (vir_bytes) ¶m.i, (vir_bytes) size);
|
|
if (r != OK) break;
|
|
switch (param.i) {
|
|
case TCOOFF:
|
|
case TCOON:
|
|
tp->tty_inhibited = (param.i == TCOOFF);
|
|
tp->tty_events = 1;
|
|
break;
|
|
case TCIOFF:
|
|
(*tp->tty_echo)(tp, tp->tty_termios.c_cc[VSTOP]);
|
|
break;
|
|
case TCION:
|
|
(*tp->tty_echo)(tp, tp->tty_termios.c_cc[VSTART]);
|
|
break;
|
|
default:
|
|
r = EINVAL;
|
|
}
|
|
break;
|
|
|
|
case TCSBRK:
|
|
if (tp->tty_break != NULL) (*tp->tty_break)(tp,0);
|
|
break;
|
|
|
|
case TIOCGWINSZ:
|
|
r = sys_safecopyto(m_ptr->m_source, (cp_grant_id_t) m_ptr->IO_GRANT, 0,
|
|
(vir_bytes) &tp->tty_winsize, (vir_bytes) size);
|
|
break;
|
|
|
|
case TIOCSWINSZ:
|
|
r = sys_safecopyfrom(m_ptr->m_source, (cp_grant_id_t) m_ptr->IO_GRANT,
|
|
0, (vir_bytes) &tp->tty_winsize, (vir_bytes) size);
|
|
sigchar(tp, SIGWINCH, 0);
|
|
break;
|
|
|
|
case KIOCSMAP:
|
|
/* Load a new keymap (only /dev/console). */
|
|
if (isconsole(tp)) r = kbd_loadmap(m_ptr);
|
|
break;
|
|
|
|
case TIOCSFON_OLD:
|
|
printf("TTY: old TIOCSFON ignored.\n");
|
|
break;
|
|
case TIOCSFON:
|
|
/* Load a font into an EGA or VGA card (hs@hck.hr) */
|
|
if (isconsole(tp)) r = con_loadfont(m_ptr);
|
|
break;
|
|
|
|
/* These Posix functions are allowed to fail if _POSIX_JOB_CONTROL is
|
|
* not defined.
|
|
*/
|
|
case TIOCGPGRP:
|
|
case TIOCSPGRP:
|
|
default:
|
|
r = ENOTTY;
|
|
}
|
|
|
|
/* Send the reply. */
|
|
tty_reply(TASK_REPLY, m_ptr->m_source, m_ptr->USER_ENDPT, r);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* do_open *
|
|
*===========================================================================*/
|
|
static void do_open(tp, m_ptr)
|
|
register tty_t *tp;
|
|
message *m_ptr; /* pointer to message sent to task */
|
|
{
|
|
/* A tty line has been opened. Make it the callers controlling tty if
|
|
* O_NOCTTY is *not* set and it is not the log device. 1 is returned if
|
|
* the tty is made the controlling tty, otherwise OK or an error code.
|
|
*/
|
|
int r = OK;
|
|
|
|
if (m_ptr->TTY_LINE == LOG_MINOR) {
|
|
/* The log device is a write-only diagnostics device. */
|
|
if (m_ptr->COUNT & R_BIT) r = EACCES;
|
|
} else {
|
|
if (!(m_ptr->COUNT & O_NOCTTY)) {
|
|
tp->tty_pgrp = m_ptr->USER_ENDPT;
|
|
r = 1;
|
|
}
|
|
tp->tty_openct++;
|
|
if (tp->tty_openct == 1) {
|
|
/* Tell the device that the tty is opened */
|
|
(*tp->tty_open)(tp, 0);
|
|
}
|
|
}
|
|
tty_reply(TASK_REPLY, m_ptr->m_source, m_ptr->USER_ENDPT, r);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* do_close *
|
|
*===========================================================================*/
|
|
static void do_close(tp, m_ptr)
|
|
register tty_t *tp;
|
|
message *m_ptr; /* pointer to message sent to task */
|
|
{
|
|
/* A tty line has been closed. Clean up the line if it is the last close. */
|
|
|
|
if (m_ptr->TTY_LINE != LOG_MINOR && --tp->tty_openct == 0) {
|
|
tp->tty_pgrp = 0;
|
|
tty_icancel(tp);
|
|
(*tp->tty_ocancel)(tp, 0);
|
|
(*tp->tty_close)(tp, 0);
|
|
tp->tty_termios = termios_defaults;
|
|
tp->tty_winsize = winsize_defaults;
|
|
setattr(tp);
|
|
}
|
|
tty_reply(TASK_REPLY, m_ptr->m_source, m_ptr->USER_ENDPT, OK);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* do_cancel *
|
|
*===========================================================================*/
|
|
static void do_cancel(tp, m_ptr)
|
|
register tty_t *tp;
|
|
message *m_ptr; /* pointer to message sent to task */
|
|
{
|
|
/* A signal has been sent to a process that is hanging trying to read or write.
|
|
* The pending read or write must be finished off immediately.
|
|
*/
|
|
|
|
int proc_nr;
|
|
int mode;
|
|
int r = EINTR;
|
|
|
|
/* Check the parameters carefully, to avoid cancelling twice. */
|
|
proc_nr = m_ptr->USER_ENDPT;
|
|
mode = m_ptr->COUNT;
|
|
if ((mode & R_BIT) && tp->tty_inleft != 0 && proc_nr == tp->tty_inproc &&
|
|
tp->tty_ingrant == (cp_grant_id_t) m_ptr->IO_GRANT) {
|
|
/* Process was reading when killed. Clean up input. */
|
|
tty_icancel(tp);
|
|
r = tp->tty_incum > 0 ? tp->tty_incum : EAGAIN;
|
|
tp->tty_inleft = tp->tty_incum = tp->tty_inrevived = 0;
|
|
tp->tty_ingrant = GRANT_INVALID;
|
|
}
|
|
if ((mode & W_BIT) && tp->tty_outleft != 0 && proc_nr == tp->tty_outproc &&
|
|
tp->tty_outgrant == (cp_grant_id_t) m_ptr->IO_GRANT) {
|
|
/* Process was writing when killed. Clean up output. */
|
|
r = tp->tty_outcum > 0 ? tp->tty_outcum : EAGAIN;
|
|
tp->tty_outleft = tp->tty_outcum = tp->tty_outrevived = 0;
|
|
tp->tty_outgrant = GRANT_INVALID;
|
|
}
|
|
if (tp->tty_ioreq != 0 && proc_nr == tp->tty_ioproc) {
|
|
/* Process was waiting for output to drain. */
|
|
tp->tty_ioreq = 0;
|
|
}
|
|
tp->tty_events = 1;
|
|
tty_reply(TASK_REPLY, m_ptr->m_source, proc_nr, r);
|
|
}
|
|
|
|
int select_try(struct tty *tp, int ops)
|
|
{
|
|
int ready_ops = 0;
|
|
|
|
/* Special case. If line is hung up, no operations will block.
|
|
* (and it can be seen as an exceptional condition.)
|
|
*/
|
|
if (tp->tty_termios.c_ospeed == B0) {
|
|
ready_ops |= ops;
|
|
}
|
|
|
|
if (ops & SEL_RD) {
|
|
/* will i/o not block on read? */
|
|
if (tp->tty_inleft > 0) {
|
|
ready_ops |= SEL_RD; /* EIO - no blocking */
|
|
} else if (tp->tty_incount > 0) {
|
|
/* Is a regular read possible? tty_incount
|
|
* says there is data. But a read will only succeed
|
|
* in canonical mode if a newline has been seen.
|
|
*/
|
|
if (!(tp->tty_termios.c_lflag & ICANON) ||
|
|
tp->tty_eotct > 0) {
|
|
ready_ops |= SEL_RD;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (ops & SEL_WR) {
|
|
if (tp->tty_outleft > 0) ready_ops |= SEL_WR;
|
|
else if ((*tp->tty_devwrite)(tp, 1)) ready_ops |= SEL_WR;
|
|
}
|
|
return ready_ops;
|
|
}
|
|
|
|
int select_retry(struct tty *tp)
|
|
{
|
|
if (tp->tty_select_ops && select_try(tp, tp->tty_select_ops))
|
|
notify(tp->tty_select_proc);
|
|
return OK;
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* handle_events *
|
|
*===========================================================================*/
|
|
void handle_events(tp)
|
|
tty_t *tp; /* TTY to check for events. */
|
|
{
|
|
/* Handle any events pending on a TTY. These events are usually device
|
|
* interrupts.
|
|
*
|
|
* Two kinds of events are prominent:
|
|
* - a character has been received from the console or an RS232 line.
|
|
* - an RS232 line has completed a write request (on behalf of a user).
|
|
* The interrupt handler may delay the interrupt message at its discretion
|
|
* to avoid swamping the TTY task. Messages may be overwritten when the
|
|
* lines are fast or when there are races between different lines, input
|
|
* and output, because MINIX only provides single buffering for interrupt
|
|
* messages (in proc.c). This is handled by explicitly checking each line
|
|
* for fresh input and completed output on each interrupt.
|
|
*/
|
|
|
|
do {
|
|
tp->tty_events = 0;
|
|
|
|
/* Read input and perform input processing. */
|
|
(*tp->tty_devread)(tp, 0);
|
|
|
|
/* Perform output processing and write output. */
|
|
(*tp->tty_devwrite)(tp, 0);
|
|
|
|
/* Ioctl waiting for some event? */
|
|
if (tp->tty_ioreq != 0) dev_ioctl(tp);
|
|
} while (tp->tty_events);
|
|
|
|
/* Transfer characters from the input queue to a waiting process. */
|
|
in_transfer(tp);
|
|
|
|
/* Reply if enough bytes are available. */
|
|
if (tp->tty_incum >= tp->tty_min && 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;
|
|
tp->tty_inrevived = 0;
|
|
tp->tty_ingrant = GRANT_INVALID;
|
|
}
|
|
}
|
|
if (tp->tty_select_ops)
|
|
{
|
|
select_retry(tp);
|
|
}
|
|
#if NR_PTYS > 0
|
|
if (ispty(tp))
|
|
select_retry_pty(tp);
|
|
#endif
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* in_transfer *
|
|
*===========================================================================*/
|
|
static void in_transfer(tp)
|
|
register tty_t *tp; /* pointer to terminal to read from */
|
|
{
|
|
/* Transfer bytes from the input queue to a process reading from a terminal. */
|
|
|
|
int ch;
|
|
int count;
|
|
char buf[64], *bp;
|
|
|
|
/* Force read to succeed if the line is hung up, looks like EOF to reader. */
|
|
if (tp->tty_termios.c_ospeed == B0) tp->tty_min = 0;
|
|
|
|
/* Anything to do? */
|
|
if (tp->tty_inleft == 0 || tp->tty_eotct < tp->tty_min) return;
|
|
|
|
bp = buf;
|
|
while (tp->tty_inleft > 0 && tp->tty_eotct > 0) {
|
|
ch = *tp->tty_intail;
|
|
|
|
if (!(ch & IN_EOF)) {
|
|
/* One character to be delivered to the user. */
|
|
*bp = ch & IN_CHAR;
|
|
tp->tty_inleft--;
|
|
if (++bp == bufend(buf)) {
|
|
/* Temp buffer full, copy to user space. */
|
|
sys_safecopyto(tp->tty_incaller,
|
|
tp->tty_ingrant, tp->tty_inoffset,
|
|
(vir_bytes) buf,
|
|
(vir_bytes) buflen(buf));
|
|
tp->tty_inoffset += buflen(buf);
|
|
tp->tty_incum += buflen(buf);
|
|
bp = buf;
|
|
}
|
|
}
|
|
|
|
/* Remove the character from the input queue. */
|
|
if (++tp->tty_intail == bufend(tp->tty_inbuf))
|
|
tp->tty_intail = tp->tty_inbuf;
|
|
tp->tty_incount--;
|
|
if (ch & IN_EOT) {
|
|
tp->tty_eotct--;
|
|
/* Don't read past a line break in canonical mode. */
|
|
if (tp->tty_termios.c_lflag & ICANON) tp->tty_inleft = 0;
|
|
}
|
|
}
|
|
|
|
if (bp > buf) {
|
|
/* Leftover characters in the buffer. */
|
|
count = bp - buf;
|
|
sys_safecopyto(tp->tty_incaller,
|
|
tp->tty_ingrant, tp->tty_inoffset,
|
|
(vir_bytes) buf, (vir_bytes) count);
|
|
tp->tty_inoffset += count;
|
|
tp->tty_incum += count;
|
|
}
|
|
|
|
/* Usually reply to the reader, possibly even if incum == 0 (EOF). */
|
|
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;
|
|
tp->tty_inrevived = 0;
|
|
tp->tty_ingrant = GRANT_INVALID;
|
|
}
|
|
}
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* in_process *
|
|
*===========================================================================*/
|
|
static void in_process_send_byte(
|
|
tty_t *tp, /* terminal on which character has arrived */
|
|
int ch /* input character */
|
|
)
|
|
{
|
|
/* Save the character in the input queue. */
|
|
*tp->tty_inhead++ = ch;
|
|
if (tp->tty_inhead == bufend(tp->tty_inbuf))
|
|
tp->tty_inhead = tp->tty_inbuf;
|
|
tp->tty_incount++;
|
|
if (ch & IN_EOT) tp->tty_eotct++;
|
|
|
|
/* Try to finish input if the queue threatens to overflow. */
|
|
if (tp->tty_incount == buflen(tp->tty_inbuf)) in_transfer(tp);
|
|
}
|
|
|
|
int in_process(tp, buf, count, scode)
|
|
register tty_t *tp; /* terminal on which character has arrived */
|
|
char *buf; /* buffer with input characters */
|
|
int count; /* number of input characters */
|
|
int scode; /* scan code */
|
|
{
|
|
/* Characters have just been typed in. Process, save, and echo them. Return
|
|
* the number of characters processed.
|
|
*/
|
|
|
|
int ch, sig, ct;
|
|
int timeset = FALSE;
|
|
|
|
/* Send scancode if requested */
|
|
if (tp->tty_termios.c_iflag & SCANCODES) {
|
|
in_process_send_byte(tp, (scode & BYTE) | IN_EOT);
|
|
}
|
|
|
|
for (ct = 0; ct < count; ct++) {
|
|
/* Take one character. */
|
|
ch = *buf++ & BYTE;
|
|
|
|
/* Strip to seven bits? */
|
|
if (tp->tty_termios.c_iflag & ISTRIP) ch &= 0x7F;
|
|
|
|
/* Input extensions? */
|
|
if (tp->tty_termios.c_lflag & IEXTEN) {
|
|
|
|
/* Previous character was a character escape? */
|
|
if (tp->tty_escaped) {
|
|
tp->tty_escaped = NOT_ESCAPED;
|
|
ch |= IN_ESC; /* protect character */
|
|
}
|
|
|
|
/* LNEXT (^V) to escape the next character? */
|
|
if (ch == tp->tty_termios.c_cc[VLNEXT]) {
|
|
tp->tty_escaped = ESCAPED;
|
|
rawecho(tp, '^');
|
|
rawecho(tp, '\b');
|
|
continue; /* do not store the escape */
|
|
}
|
|
|
|
/* REPRINT (^R) to reprint echoed characters? */
|
|
if (ch == tp->tty_termios.c_cc[VREPRINT]) {
|
|
reprint(tp);
|
|
continue;
|
|
}
|
|
}
|
|
|
|
/* _POSIX_VDISABLE is a normal character value, so better escape it. */
|
|
if (ch == _POSIX_VDISABLE) ch |= IN_ESC;
|
|
|
|
/* Map CR to LF, ignore CR, or map LF to CR. */
|
|
if (ch == '\r') {
|
|
if (tp->tty_termios.c_iflag & IGNCR) continue;
|
|
if (tp->tty_termios.c_iflag & ICRNL) ch = '\n';
|
|
} else
|
|
if (ch == '\n') {
|
|
if (tp->tty_termios.c_iflag & INLCR) ch = '\r';
|
|
}
|
|
|
|
/* Canonical mode? */
|
|
if (tp->tty_termios.c_lflag & ICANON) {
|
|
|
|
/* Erase processing (rub out of last character). */
|
|
if (ch == tp->tty_termios.c_cc[VERASE]) {
|
|
(void) back_over(tp);
|
|
if (!(tp->tty_termios.c_lflag & ECHOE)) {
|
|
(void) tty_echo(tp, ch);
|
|
}
|
|
continue;
|
|
}
|
|
|
|
/* Kill processing (remove current line). */
|
|
if (ch == tp->tty_termios.c_cc[VKILL]) {
|
|
while (back_over(tp)) {}
|
|
if (!(tp->tty_termios.c_lflag & ECHOE)) {
|
|
(void) tty_echo(tp, ch);
|
|
if (tp->tty_termios.c_lflag & ECHOK)
|
|
rawecho(tp, '\n');
|
|
}
|
|
continue;
|
|
}
|
|
|
|
/* EOF (^D) means end-of-file, an invisible "line break". */
|
|
if (ch == tp->tty_termios.c_cc[VEOF]) ch |= IN_EOT | IN_EOF;
|
|
|
|
/* The line may be returned to the user after an LF. */
|
|
if (ch == '\n') ch |= IN_EOT;
|
|
|
|
/* Same thing with EOL, whatever it may be. */
|
|
if (ch == tp->tty_termios.c_cc[VEOL]) ch |= IN_EOT;
|
|
}
|
|
|
|
/* Start/stop input control? */
|
|
if (tp->tty_termios.c_iflag & IXON) {
|
|
|
|
/* Output stops on STOP (^S). */
|
|
if (ch == tp->tty_termios.c_cc[VSTOP]) {
|
|
tp->tty_inhibited = STOPPED;
|
|
tp->tty_events = 1;
|
|
continue;
|
|
}
|
|
|
|
/* Output restarts on START (^Q) or any character if IXANY. */
|
|
if (tp->tty_inhibited) {
|
|
if (ch == tp->tty_termios.c_cc[VSTART]
|
|
|| (tp->tty_termios.c_iflag & IXANY)) {
|
|
tp->tty_inhibited = RUNNING;
|
|
tp->tty_events = 1;
|
|
if (ch == tp->tty_termios.c_cc[VSTART])
|
|
continue;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (tp->tty_termios.c_lflag & ISIG) {
|
|
/* Check for INTR (^?) and QUIT (^\) characters. */
|
|
if (ch == tp->tty_termios.c_cc[VINTR]
|
|
|| ch == tp->tty_termios.c_cc[VQUIT]) {
|
|
sig = SIGINT;
|
|
if (ch == tp->tty_termios.c_cc[VQUIT]) sig = SIGQUIT;
|
|
sigchar(tp, sig, 1);
|
|
(void) tty_echo(tp, ch);
|
|
continue;
|
|
}
|
|
}
|
|
|
|
/* Is there space in the input buffer? */
|
|
if (tp->tty_incount == buflen(tp->tty_inbuf)) {
|
|
/* No space; discard in canonical mode, keep in raw mode. */
|
|
if (tp->tty_termios.c_lflag & ICANON) continue;
|
|
break;
|
|
}
|
|
|
|
if (!(tp->tty_termios.c_lflag & ICANON)) {
|
|
/* In raw mode all characters are "line breaks". */
|
|
ch |= IN_EOT;
|
|
|
|
/* Start an inter-byte timer? */
|
|
if (!timeset && tp->tty_termios.c_cc[VMIN] > 0
|
|
&& tp->tty_termios.c_cc[VTIME] > 0) {
|
|
settimer(tp, TRUE);
|
|
timeset = TRUE;
|
|
}
|
|
}
|
|
|
|
/* Perform the intricate function of echoing. */
|
|
if (tp->tty_termios.c_lflag & (ECHO|ECHONL)) ch = tty_echo(tp, ch);
|
|
|
|
/* Send processed byte of input unless scancodes sent instead */
|
|
if (!(tp->tty_termios.c_iflag & SCANCODES)) {
|
|
in_process_send_byte(tp, ch);
|
|
}
|
|
}
|
|
return ct;
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* echo *
|
|
*===========================================================================*/
|
|
static int tty_echo(tp, ch)
|
|
register tty_t *tp; /* terminal on which to echo */
|
|
register int ch; /* pointer to character to echo */
|
|
{
|
|
/* Echo the character if echoing is on. Some control characters are echoed
|
|
* with their normal effect, other control characters are echoed as "^X",
|
|
* normal characters are echoed normally. EOF (^D) is echoed, but immediately
|
|
* backspaced over. Return the character with the echoed length added to its
|
|
* attributes.
|
|
*/
|
|
int len, rp;
|
|
|
|
ch &= ~IN_LEN;
|
|
if (!(tp->tty_termios.c_lflag & ECHO)) {
|
|
if (ch == ('\n' | IN_EOT) && (tp->tty_termios.c_lflag
|
|
& (ICANON|ECHONL)) == (ICANON|ECHONL))
|
|
(*tp->tty_echo)(tp, '\n');
|
|
return(ch);
|
|
}
|
|
|
|
/* "Reprint" tells if the echo output has been messed up by other output. */
|
|
rp = tp->tty_incount == 0 ? FALSE : tp->tty_reprint;
|
|
|
|
if ((ch & IN_CHAR) < ' ') {
|
|
switch (ch & (IN_ESC|IN_EOF|IN_EOT|IN_CHAR)) {
|
|
case '\t':
|
|
len = 0;
|
|
do {
|
|
(*tp->tty_echo)(tp, ' ');
|
|
len++;
|
|
} while (len < TAB_SIZE && (tp->tty_position & TAB_MASK) != 0);
|
|
break;
|
|
case '\r' | IN_EOT:
|
|
case '\n' | IN_EOT:
|
|
(*tp->tty_echo)(tp, ch & IN_CHAR);
|
|
len = 0;
|
|
break;
|
|
default:
|
|
(*tp->tty_echo)(tp, '^');
|
|
(*tp->tty_echo)(tp, '@' + (ch & IN_CHAR));
|
|
len = 2;
|
|
}
|
|
} else
|
|
if ((ch & IN_CHAR) == '\177') {
|
|
/* A DEL prints as "^?". */
|
|
(*tp->tty_echo)(tp, '^');
|
|
(*tp->tty_echo)(tp, '?');
|
|
len = 2;
|
|
} else {
|
|
(*tp->tty_echo)(tp, ch & IN_CHAR);
|
|
len = 1;
|
|
}
|
|
if (ch & IN_EOF) while (len > 0) { (*tp->tty_echo)(tp, '\b'); len--; }
|
|
|
|
tp->tty_reprint = rp;
|
|
return(ch | (len << IN_LSHIFT));
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* rawecho *
|
|
*===========================================================================*/
|
|
static void rawecho(tp, ch)
|
|
register tty_t *tp;
|
|
int ch;
|
|
{
|
|
/* Echo without interpretation if ECHO is set. */
|
|
int rp = tp->tty_reprint;
|
|
if (tp->tty_termios.c_lflag & ECHO) (*tp->tty_echo)(tp, ch);
|
|
tp->tty_reprint = rp;
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* back_over *
|
|
*===========================================================================*/
|
|
static int back_over(tp)
|
|
register tty_t *tp;
|
|
{
|
|
/* Backspace to previous character on screen and erase it. */
|
|
u16_t *head;
|
|
int len;
|
|
|
|
if (tp->tty_incount == 0) return(0); /* queue empty */
|
|
head = tp->tty_inhead;
|
|
if (head == tp->tty_inbuf) head = bufend(tp->tty_inbuf);
|
|
if (*--head & IN_EOT) return(0); /* can't erase "line breaks" */
|
|
if (tp->tty_reprint) reprint(tp); /* reprint if messed up */
|
|
tp->tty_inhead = head;
|
|
tp->tty_incount--;
|
|
if (tp->tty_termios.c_lflag & ECHOE) {
|
|
len = (*head & IN_LEN) >> IN_LSHIFT;
|
|
while (len > 0) {
|
|
rawecho(tp, '\b');
|
|
rawecho(tp, ' ');
|
|
rawecho(tp, '\b');
|
|
len--;
|
|
}
|
|
}
|
|
return(1); /* one character erased */
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* reprint *
|
|
*===========================================================================*/
|
|
static void reprint(tp)
|
|
register tty_t *tp; /* pointer to tty struct */
|
|
{
|
|
/* Restore what has been echoed to screen before if the user input has been
|
|
* messed up by output, or if REPRINT (^R) is typed.
|
|
*/
|
|
int count;
|
|
u16_t *head;
|
|
|
|
tp->tty_reprint = FALSE;
|
|
|
|
/* Find the last line break in the input. */
|
|
head = tp->tty_inhead;
|
|
count = tp->tty_incount;
|
|
while (count > 0) {
|
|
if (head == tp->tty_inbuf) head = bufend(tp->tty_inbuf);
|
|
if (head[-1] & IN_EOT) break;
|
|
head--;
|
|
count--;
|
|
}
|
|
if (count == tp->tty_incount) return; /* no reason to reprint */
|
|
|
|
/* Show REPRINT (^R) and move to a new line. */
|
|
(void) tty_echo(tp, tp->tty_termios.c_cc[VREPRINT] | IN_ESC);
|
|
rawecho(tp, '\r');
|
|
rawecho(tp, '\n');
|
|
|
|
/* Reprint from the last break onwards. */
|
|
do {
|
|
if (head == bufend(tp->tty_inbuf)) head = tp->tty_inbuf;
|
|
*head = tty_echo(tp, *head);
|
|
head++;
|
|
count++;
|
|
} while (count < tp->tty_incount);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* out_process *
|
|
*===========================================================================*/
|
|
void out_process(tp, bstart, bpos, bend, icount, ocount)
|
|
tty_t *tp;
|
|
char *bstart, *bpos, *bend; /* start/pos/end of circular buffer */
|
|
int *icount; /* # input chars / input chars used */
|
|
int *ocount; /* max output chars / output chars used */
|
|
{
|
|
/* Perform output processing on a circular buffer. *icount is the number of
|
|
* bytes to process, and the number of bytes actually processed on return.
|
|
* *ocount is the space available on input and the space used on output.
|
|
* (Naturally *icount < *ocount.) The column position is updated modulo
|
|
* the TAB size, because we really only need it for tabs.
|
|
*/
|
|
|
|
int tablen;
|
|
int ict = *icount;
|
|
int oct = *ocount;
|
|
int pos = tp->tty_position;
|
|
|
|
while (ict > 0) {
|
|
switch (*bpos) {
|
|
case '\7':
|
|
break;
|
|
case '\b':
|
|
pos--;
|
|
break;
|
|
case '\r':
|
|
pos = 0;
|
|
break;
|
|
case '\n':
|
|
if ((tp->tty_termios.c_oflag & (OPOST|ONLCR))
|
|
== (OPOST|ONLCR)) {
|
|
/* Map LF to CR+LF if there is space. Note that the
|
|
* next character in the buffer is overwritten, so
|
|
* we stop at this point.
|
|
*/
|
|
if (oct >= 2) {
|
|
*bpos = '\r';
|
|
if (++bpos == bend) bpos = bstart;
|
|
*bpos = '\n';
|
|
pos = 0;
|
|
ict--;
|
|
oct -= 2;
|
|
}
|
|
goto out_done; /* no space or buffer got changed */
|
|
}
|
|
break;
|
|
case '\t':
|
|
/* Best guess for the tab length. */
|
|
tablen = TAB_SIZE - (pos & TAB_MASK);
|
|
|
|
if ((tp->tty_termios.c_oflag & (OPOST|XTABS))
|
|
== (OPOST|XTABS)) {
|
|
/* Tabs must be expanded. */
|
|
if (oct >= tablen) {
|
|
pos += tablen;
|
|
ict--;
|
|
oct -= tablen;
|
|
do {
|
|
*bpos = ' ';
|
|
if (++bpos == bend) bpos = bstart;
|
|
} while (--tablen != 0);
|
|
}
|
|
goto out_done;
|
|
}
|
|
/* Tabs are output directly. */
|
|
pos += tablen;
|
|
break;
|
|
default:
|
|
/* Assume any other character prints as one character. */
|
|
pos++;
|
|
}
|
|
if (++bpos == bend) bpos = bstart;
|
|
ict--;
|
|
oct--;
|
|
}
|
|
out_done:
|
|
tp->tty_position = pos & TAB_MASK;
|
|
|
|
*icount -= ict; /* [io]ct are the number of chars not used */
|
|
*ocount -= oct; /* *[io]count are the number of chars that are used */
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* dev_ioctl *
|
|
*===========================================================================*/
|
|
static void dev_ioctl(tp)
|
|
tty_t *tp;
|
|
{
|
|
/* The ioctl's TCSETSW, TCSETSF and TCDRAIN wait for output to finish to make
|
|
* sure that an attribute change doesn't affect the processing of current
|
|
* output. Once output finishes the ioctl is executed as in do_ioctl().
|
|
*/
|
|
int result = EINVAL;
|
|
|
|
if (tp->tty_outleft > 0) return; /* output not finished */
|
|
|
|
if (tp->tty_ioreq != TCDRAIN) {
|
|
if (tp->tty_ioreq == TCSETSF) tty_icancel(tp);
|
|
result = sys_safecopyfrom(tp->tty_iocaller, tp->tty_iogrant, 0,
|
|
(vir_bytes) &tp->tty_termios,
|
|
(vir_bytes) sizeof(tp->tty_termios));
|
|
if (result == OK) setattr(tp);
|
|
}
|
|
tp->tty_ioreq = 0;
|
|
notify(tp->tty_iocaller);
|
|
tp->tty_iorevived = 1;
|
|
tp->tty_iostatus = result;
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* setattr *
|
|
*===========================================================================*/
|
|
static void setattr(tp)
|
|
tty_t *tp;
|
|
{
|
|
/* Apply the new line attributes (raw/canonical, line speed, etc.) */
|
|
u16_t *inp;
|
|
int count;
|
|
|
|
if (!(tp->tty_termios.c_lflag & ICANON)) {
|
|
/* Raw mode; put a "line break" on all characters in the input queue.
|
|
* It is undefined what happens to the input queue when ICANON is
|
|
* switched off, a process should use TCSAFLUSH to flush the queue.
|
|
* Keeping the queue to preserve typeahead is the Right Thing, however
|
|
* when a process does use TCSANOW to switch to raw mode.
|
|
*/
|
|
count = tp->tty_eotct = tp->tty_incount;
|
|
inp = tp->tty_intail;
|
|
while (count > 0) {
|
|
*inp |= IN_EOT;
|
|
if (++inp == bufend(tp->tty_inbuf)) inp = tp->tty_inbuf;
|
|
--count;
|
|
}
|
|
}
|
|
|
|
/* Inspect MIN and TIME. */
|
|
settimer(tp, FALSE);
|
|
if (tp->tty_termios.c_lflag & ICANON) {
|
|
/* No MIN & TIME in canonical mode. */
|
|
tp->tty_min = 1;
|
|
} else {
|
|
/* In raw mode MIN is the number of chars wanted, and TIME how long
|
|
* to wait for them. With interesting exceptions if either is zero.
|
|
*/
|
|
tp->tty_min = tp->tty_termios.c_cc[VMIN];
|
|
if (tp->tty_min == 0 && tp->tty_termios.c_cc[VTIME] > 0)
|
|
tp->tty_min = 1;
|
|
}
|
|
|
|
if (!(tp->tty_termios.c_iflag & IXON)) {
|
|
/* No start/stop output control, so don't leave output inhibited. */
|
|
tp->tty_inhibited = RUNNING;
|
|
tp->tty_events = 1;
|
|
}
|
|
|
|
/* Setting the output speed to zero hangs up the phone. */
|
|
if (tp->tty_termios.c_ospeed == B0) sigchar(tp, SIGHUP, 1);
|
|
|
|
/* SCANCODES is supported only for the console */
|
|
if (!isconsole(tp)) tp->tty_termios.c_iflag &= ~SCANCODES;
|
|
|
|
/* Set new line speed, character size, etc at the device level. */
|
|
(*tp->tty_ioctl)(tp, 0);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* tty_reply *
|
|
*===========================================================================*/
|
|
void
|
|
tty_reply_f(
|
|
file, line, code, replyee, proc_nr, status)
|
|
char *file;
|
|
int line;
|
|
int code; /* TASK_REPLY or REVIVE */
|
|
int replyee; /* destination address for the reply */
|
|
int proc_nr; /* to whom should the reply go? */
|
|
int status; /* reply code */
|
|
{
|
|
/* Send a reply to a process that wanted to read or write data. */
|
|
message tty_mess;
|
|
|
|
tty_mess.m_type = code;
|
|
tty_mess.REP_ENDPT = proc_nr;
|
|
tty_mess.REP_STATUS = status;
|
|
|
|
/* Don't reply to KERNEL (kernel messages) */
|
|
if (replyee == KERNEL) return;
|
|
|
|
/* TTY is not supposed to send a TTY_REVIVE message. The
|
|
* REVIVE message is gone, TTY_REVIVE is only used as an internal
|
|
* placeholder for something that is not supposed to be a message.
|
|
*/
|
|
if(code == TTY_REVIVE) {
|
|
printf("%s:%d: ", file, line);
|
|
panic("tty_reply sending TTY_REVIVE");
|
|
}
|
|
|
|
status = send(replyee, &tty_mess);
|
|
if (status != OK)
|
|
printf("tty`tty_reply: send to %d failed: %d\n", replyee, status);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* sigchar *
|
|
*===========================================================================*/
|
|
void sigchar(tp, sig, mayflush)
|
|
register tty_t *tp;
|
|
int sig; /* SIGINT, SIGQUIT, SIGKILL or SIGHUP */
|
|
int mayflush;
|
|
{
|
|
/* Process a SIGINT, SIGQUIT or SIGKILL char from the keyboard or SIGHUP from
|
|
* a tty close, "stty 0", or a real RS-232 hangup. PM will send the signal to
|
|
* the process group (INT, QUIT), all processes (KILL), or the session leader
|
|
* (HUP).
|
|
*/
|
|
int status;
|
|
|
|
if (tp->tty_pgrp != 0) {
|
|
if (OK != (status = sys_kill(tp->tty_pgrp, sig))) {
|
|
panic("Error; call to sys_kill failed: %d", status);
|
|
}
|
|
}
|
|
|
|
if (mayflush && !(tp->tty_termios.c_lflag & NOFLSH)) {
|
|
tp->tty_incount = tp->tty_eotct = 0; /* kill earlier input */
|
|
tp->tty_intail = tp->tty_inhead;
|
|
(*tp->tty_ocancel)(tp, 0); /* kill all output */
|
|
tp->tty_inhibited = RUNNING;
|
|
tp->tty_events = 1;
|
|
}
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* tty_icancel *
|
|
*===========================================================================*/
|
|
static void tty_icancel(tp)
|
|
register tty_t *tp;
|
|
{
|
|
/* Discard all pending input, tty buffer or device. */
|
|
|
|
tp->tty_incount = tp->tty_eotct = 0;
|
|
tp->tty_intail = tp->tty_inhead;
|
|
(*tp->tty_icancel)(tp, 0);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* tty_devnop *
|
|
*===========================================================================*/
|
|
static int tty_devnop(tty_t *UNUSED(tp), int UNUSED(try))
|
|
{
|
|
/* Some functions need not be implemented at the device level. */
|
|
return 0;
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* tty_init *
|
|
*===========================================================================*/
|
|
static void tty_init()
|
|
{
|
|
/* Initialize tty structure and call device initialization routines. */
|
|
|
|
register tty_t *tp;
|
|
int s;
|
|
|
|
system_hz = sys_hz();
|
|
|
|
/* Initialize the terminal lines. */
|
|
memset(tty_table, '\0' , sizeof(tty_table));
|
|
|
|
for (tp = FIRST_TTY,s=0; tp < END_TTY; tp++,s++) {
|
|
|
|
tp->tty_index = s;
|
|
init_timer(&tp->tty_tmr);
|
|
|
|
tp->tty_intail = tp->tty_inhead = tp->tty_inbuf;
|
|
tp->tty_min = 1;
|
|
tp->tty_ingrant = tp->tty_outgrant = tp->tty_iogrant = GRANT_INVALID;
|
|
tp->tty_termios = termios_defaults;
|
|
tp->tty_icancel = tp->tty_ocancel = tp->tty_ioctl = tp->tty_close =
|
|
tp->tty_open = tty_devnop;
|
|
if (tp < tty_addr(NR_CONS)) {
|
|
scr_init(tp);
|
|
|
|
/* Initialize the keyboard driver. */
|
|
kb_init(tp);
|
|
|
|
tp->tty_minor = CONS_MINOR + s;
|
|
} else
|
|
if (tp < tty_addr(NR_CONS+NR_RS_LINES)) {
|
|
rs_init(tp);
|
|
tp->tty_minor = RS232_MINOR + s-NR_CONS;
|
|
} else {
|
|
pty_init(tp);
|
|
tp->tty_minor = s - (NR_CONS+NR_RS_LINES) + TTYPX_MINOR;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* tty_timed_out *
|
|
*===========================================================================*/
|
|
static void tty_timed_out(timer_t *tp)
|
|
{
|
|
/* This timer has expired. Set the events flag, to force processing. */
|
|
tty_t *tty_ptr;
|
|
tty_ptr = &tty_table[tmr_arg(tp)->ta_int];
|
|
tty_ptr->tty_min = 0; /* force read to succeed */
|
|
tty_ptr->tty_events = 1;
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* settimer *
|
|
*===========================================================================*/
|
|
static void settimer(tty_ptr, enable)
|
|
tty_t *tty_ptr; /* line to set or unset a timer on */
|
|
int enable; /* set timer if true, otherwise unset */
|
|
{
|
|
clock_t ticks;
|
|
|
|
if (enable) {
|
|
ticks = tty_ptr->tty_termios.c_cc[VTIME] * (system_hz/10);
|
|
|
|
/* Set a new timer for enabling the TTY events flags. */
|
|
set_timer(&tty_ptr->tty_tmr, ticks, tty_timed_out, tty_ptr->tty_index);
|
|
} else {
|
|
/* Remove the timer from the active and expired lists. */
|
|
cancel_timer(&tty_ptr->tty_tmr);
|
|
}
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* do_select *
|
|
*===========================================================================*/
|
|
static void do_select(tp, m_ptr)
|
|
register tty_t *tp; /* pointer to tty struct */
|
|
register message *m_ptr; /* pointer to message sent to the task */
|
|
{
|
|
int ops, ready_ops = 0, watch;
|
|
|
|
ops = m_ptr->USER_ENDPT & (SEL_RD|SEL_WR|SEL_ERR);
|
|
watch = (m_ptr->USER_ENDPT & SEL_NOTIFY) ? 1 : 0;
|
|
|
|
ready_ops = select_try(tp, ops);
|
|
|
|
if (!ready_ops && ops && watch) {
|
|
tp->tty_select_ops |= ops;
|
|
tp->tty_select_proc = m_ptr->m_source;
|
|
}
|
|
|
|
tty_reply(TASK_REPLY, m_ptr->m_source, m_ptr->USER_ENDPT, ready_ops);
|
|
|
|
return;
|
|
}
|
|
|