2005-04-21 16:53:53 +02:00
|
|
|
#include <minix/config.h>
|
2005-09-11 19:09:11 +02:00
|
|
|
/*---------------------------------------------------------------------------*
|
|
|
|
* rs232.c - serial driver for 8250 and 16450 UARTs *
|
|
|
|
* Added support for Atari ST M68901 and YM-2149 --kub *
|
|
|
|
*---------------------------------------------------------------------------*/
|
2005-04-21 16:53:53 +02:00
|
|
|
|
2010-03-22 22:25:22 +01:00
|
|
|
#include <minix/drivers.h>
|
2005-04-21 16:53:53 +02:00
|
|
|
#include <termios.h>
|
|
|
|
#include <signal.h>
|
|
|
|
#include "tty.h"
|
|
|
|
|
|
|
|
#if NR_RS_LINES > 0
|
|
|
|
|
|
|
|
/* 8250 constants. */
|
|
|
|
#define UART_FREQ 115200L /* timer frequency */
|
|
|
|
|
|
|
|
/* Interrupt enable bits. */
|
|
|
|
#define IE_RECEIVER_READY 1
|
|
|
|
#define IE_TRANSMITTER_READY 2
|
|
|
|
#define IE_LINE_STATUS_CHANGE 4
|
|
|
|
#define IE_MODEM_STATUS_CHANGE 8
|
|
|
|
|
|
|
|
/* Interrupt status bits. */
|
|
|
|
#define IS_MODEM_STATUS_CHANGE 0
|
|
|
|
#define IS_TRANSMITTER_READY 2
|
|
|
|
#define IS_RECEIVER_READY 4
|
|
|
|
#define IS_LINE_STATUS_CHANGE 6
|
|
|
|
|
|
|
|
/* Line control bits. */
|
|
|
|
#define LC_2STOP_BITS 0x04
|
|
|
|
#define LC_PARITY 0x08
|
|
|
|
#define LC_PAREVEN 0x10
|
|
|
|
#define LC_BREAK 0x40
|
|
|
|
#define LC_ADDRESS_DIVISOR 0x80
|
|
|
|
|
|
|
|
/* Line status bits. */
|
|
|
|
#define LS_OVERRUN_ERR 2
|
|
|
|
#define LS_PARITY_ERR 4
|
|
|
|
#define LS_FRAMING_ERR 8
|
|
|
|
#define LS_BREAK_INTERRUPT 0x10
|
|
|
|
#define LS_TRANSMITTER_READY 0x20
|
|
|
|
|
|
|
|
/* Modem control bits. */
|
|
|
|
#define MC_DTR 1
|
|
|
|
#define MC_RTS 2
|
|
|
|
#define MC_OUT2 8 /* required for PC & AT interrupts */
|
|
|
|
|
|
|
|
/* Modem status bits. */
|
|
|
|
#define MS_CTS 0x10
|
|
|
|
#define MS_RLSD 0x80 /* Received Line Signal Detect */
|
|
|
|
#define MS_DRLSD 0x08 /* RLSD Delta */
|
|
|
|
|
2008-11-19 13:26:10 +01:00
|
|
|
#define DATA_BITS_SHIFT 8 /* amount data bits shifted in mode */
|
|
|
|
#define DEF_BAUD 1200 /* default baud rate */
|
2005-04-21 16:53:53 +02:00
|
|
|
|
2008-11-19 13:26:10 +01:00
|
|
|
#define RS_IBUFSIZE 1024 /* RS232 input buffer size */
|
|
|
|
#define RS_OBUFSIZE 1024 /* RS232 output buffer size */
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Input buffer watermarks.
|
|
|
|
* The external device is asked to stop sending when the buffer
|
|
|
|
* exactly reaches high water, or when TTY requests it. Sending restarts
|
|
|
|
* when the input buffer empties below the low watermark.
|
|
|
|
*/
|
2008-11-19 13:26:10 +01:00
|
|
|
#define RS_ILOWWATER (1 * RS_IBUFSIZE / 4)
|
|
|
|
#define RS_IHIGHWATER (3 * RS_IBUFSIZE / 4)
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Output buffer low watermark.
|
|
|
|
* TTY is notified when the output buffer empties below the low watermark, so
|
|
|
|
* it may continue filling the buffer if doing a large write.
|
|
|
|
*/
|
2008-11-19 13:26:10 +01:00
|
|
|
#define RS_OLOWWATER (1 * RS_OBUFSIZE / 4)
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Macros to handle flow control.
|
|
|
|
* Interrupts must be off when they are used.
|
|
|
|
* Time is critical - already the function call for outb() is annoying.
|
|
|
|
* If outb() can be done in-line, tests to avoid it can be dropped.
|
|
|
|
* istart() tells external device we are ready by raising RTS.
|
|
|
|
* istop() tells external device we are not ready by dropping RTS.
|
|
|
|
* DTR is kept high all the time (it probably should be raised by open and
|
|
|
|
* dropped by close of the device).
|
|
|
|
* OUT2 is also kept high all the time.
|
|
|
|
*/
|
|
|
|
#define istart(rs) \
|
2005-05-13 14:29:10 +02:00
|
|
|
(sys_outb((rs)->modem_ctl_port, MC_OUT2 | MC_RTS | MC_DTR), \
|
2005-04-21 16:53:53 +02:00
|
|
|
(rs)->idevready = TRUE)
|
|
|
|
#define istop(rs) \
|
2005-05-13 14:29:10 +02:00
|
|
|
(sys_outb((rs)->modem_ctl_port, MC_OUT2 | MC_DTR), \
|
2005-04-21 16:53:53 +02:00
|
|
|
(rs)->idevready = FALSE)
|
|
|
|
|
|
|
|
/* Macro to tell if device is ready. The rs->cts field is set to MS_CTS if
|
|
|
|
* CLOCAL is in effect for a line without a CTS wire.
|
|
|
|
*/
|
2005-05-13 14:29:10 +02:00
|
|
|
#define devready(rs) ((my_inb(rs->modem_status_port) | rs->cts) & MS_CTS)
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Macro to tell if transmitter is ready. */
|
2005-05-13 14:29:10 +02:00
|
|
|
#define txready(rs) (my_inb(rs->line_status_port) & LS_TRANSMITTER_READY)
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Macro to tell if carrier has dropped.
|
|
|
|
* The RS232 Carrier Detect (CD) line is usually connected to the 8250
|
|
|
|
* Received Line Signal Detect pin, reflected by bit MS_RLSD in the Modem
|
|
|
|
* Status Register. The MS_DRLSD bit tells if MS_RLSD has just changed state.
|
|
|
|
* So if MS_DRLSD is set and MS_RLSD cleared, we know that carrier has just
|
|
|
|
* dropped.
|
|
|
|
*/
|
|
|
|
#define devhup(rs) \
|
2005-05-13 14:29:10 +02:00
|
|
|
((my_inb(rs->modem_status_port) & (MS_RLSD|MS_DRLSD)) == MS_DRLSD)
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Types. */
|
|
|
|
typedef unsigned char bool_t; /* boolean */
|
|
|
|
|
|
|
|
/* RS232 device structure, one per device. */
|
|
|
|
typedef struct rs232 {
|
|
|
|
tty_t *tty; /* associated TTY structure */
|
|
|
|
|
|
|
|
int icount; /* number of bytes in the input buffer */
|
|
|
|
char *ihead; /* next free spot in input buffer */
|
|
|
|
char *itail; /* first byte to give to TTY */
|
|
|
|
bool_t idevready; /* nonzero if we are ready to receive (RTS) */
|
|
|
|
char cts; /* normally 0, but MS_CTS if CLOCAL is set */
|
|
|
|
|
|
|
|
unsigned char ostate; /* combination of flags: */
|
|
|
|
#define ODONE 1 /* output completed (< output enable bits) */
|
|
|
|
#define ORAW 2 /* raw mode for xoff disable (< enab. bits) */
|
|
|
|
#define OWAKEUP 4 /* tty_wakeup() pending (asm code only) */
|
|
|
|
#define ODEVREADY MS_CTS /* external device hardware ready (CTS) */
|
|
|
|
#define OQUEUED 0x20 /* output buffer not empty */
|
|
|
|
#define OSWREADY 0x40 /* external device software ready (no xoff) */
|
|
|
|
#define ODEVHUP MS_RLSD /* external device has dropped carrier */
|
|
|
|
#define OSOFTBITS (ODONE | ORAW | OWAKEUP | OQUEUED | OSWREADY)
|
|
|
|
/* user-defined bits */
|
|
|
|
#if (OSOFTBITS | ODEVREADY | ODEVHUP) == OSOFTBITS
|
|
|
|
/* a weak sanity check */
|
|
|
|
#error /* bits are not unique */
|
|
|
|
#endif
|
|
|
|
unsigned char oxoff; /* char to stop output */
|
|
|
|
bool_t inhibited; /* output inhibited? (follows tty_inhibited) */
|
|
|
|
bool_t drain; /* if set drain output and reconfigure line */
|
|
|
|
int ocount; /* number of bytes in the output buffer */
|
|
|
|
char *ohead; /* next free spot in output buffer */
|
|
|
|
char *otail; /* next char to output */
|
|
|
|
|
|
|
|
#if (MACHINE == IBM_PC)
|
|
|
|
port_t xmit_port; /* i/o ports */
|
|
|
|
port_t recv_port;
|
|
|
|
port_t div_low_port;
|
|
|
|
port_t div_hi_port;
|
|
|
|
port_t int_enab_port;
|
|
|
|
port_t int_id_port;
|
|
|
|
port_t line_ctl_port;
|
|
|
|
port_t modem_ctl_port;
|
|
|
|
port_t line_status_port;
|
|
|
|
port_t modem_status_port;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
unsigned char lstatus; /* last line status */
|
|
|
|
unsigned char pad; /* ensure alignment for 16-bit ints */
|
|
|
|
unsigned framing_errors; /* error counts (no reporting yet) */
|
|
|
|
unsigned overrun_errors;
|
|
|
|
unsigned parity_errors;
|
|
|
|
unsigned break_interrupts;
|
|
|
|
|
2005-07-29 17:22:58 +02:00
|
|
|
int irq; /* irq for this line */
|
2005-05-13 14:29:10 +02:00
|
|
|
int irq_hook_id; /* interrupt hook */
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
char ibuf[RS_IBUFSIZE]; /* input buffer */
|
|
|
|
char obuf[RS_OBUFSIZE]; /* output buffer */
|
|
|
|
} rs232_t;
|
|
|
|
|
2010-02-09 16:23:38 +01:00
|
|
|
PRIVATE rs232_t rs_lines[NR_RS_LINES];
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
#if (MACHINE == IBM_PC)
|
|
|
|
/* 8250 base addresses. */
|
|
|
|
PRIVATE port_t addr_8250[] = {
|
|
|
|
0x3F8, /* COM1 */
|
|
|
|
0x2F8, /* COM2 */
|
|
|
|
0x3E8, /* COM3 */
|
|
|
|
0x2E8, /* COM4 */
|
|
|
|
};
|
|
|
|
#endif
|
|
|
|
|
|
|
|
FORWARD _PROTOTYPE( void in_int, (rs232_t *rs) );
|
|
|
|
FORWARD _PROTOTYPE( void line_int, (rs232_t *rs) );
|
|
|
|
FORWARD _PROTOTYPE( void modem_int, (rs232_t *rs) );
|
2005-09-11 19:09:11 +02:00
|
|
|
FORWARD _PROTOTYPE( int rs_write, (tty_t *tp, int try) );
|
2005-04-21 16:53:53 +02:00
|
|
|
FORWARD _PROTOTYPE( void rs_echo, (tty_t *tp, int c) );
|
2005-09-11 19:09:11 +02:00
|
|
|
FORWARD _PROTOTYPE( int rs_ioctl, (tty_t *tp, int try) );
|
2005-04-21 16:53:53 +02:00
|
|
|
FORWARD _PROTOTYPE( void rs_config, (rs232_t *rs) );
|
2005-09-11 19:09:11 +02:00
|
|
|
FORWARD _PROTOTYPE( int rs_read, (tty_t *tp, int try) );
|
|
|
|
FORWARD _PROTOTYPE( int rs_icancel, (tty_t *tp, int try) );
|
|
|
|
FORWARD _PROTOTYPE( int rs_ocancel, (tty_t *tp, int try) );
|
2005-04-21 16:53:53 +02:00
|
|
|
FORWARD _PROTOTYPE( void rs_ostart, (rs232_t *rs) );
|
2005-09-11 19:09:11 +02:00
|
|
|
FORWARD _PROTOTYPE( int rs_break, (tty_t *tp, int try) );
|
|
|
|
FORWARD _PROTOTYPE( int rs_close, (tty_t *tp, int try) );
|
2005-04-21 16:53:53 +02:00
|
|
|
FORWARD _PROTOTYPE( void out_int, (rs232_t *rs) );
|
2005-07-29 17:22:58 +02:00
|
|
|
FORWARD _PROTOTYPE( void rs232_handler, (rs232_t *rs) );
|
2005-04-21 16:53:53 +02:00
|
|
|
|
2005-05-13 14:29:10 +02:00
|
|
|
/* XXX */
|
|
|
|
PRIVATE void lock(void) {}
|
|
|
|
PRIVATE void unlock(void) {}
|
|
|
|
|
|
|
|
PRIVATE int my_inb(port_t port)
|
|
|
|
{
|
2006-03-25 00:02:56 +01:00
|
|
|
int r;
|
|
|
|
unsigned long v = 0;
|
2005-05-13 14:29:10 +02:00
|
|
|
r = sys_inb(port, &v);
|
2005-09-11 19:09:11 +02:00
|
|
|
if (r != OK)
|
2005-05-13 14:29:10 +02:00
|
|
|
printf("RS232 warning: failed inb 0x%x\n", port);
|
|
|
|
|
2006-03-25 00:02:56 +01:00
|
|
|
return (int) v;
|
2005-05-13 14:29:10 +02:00
|
|
|
}
|
2005-04-21 16:53:53 +02:00
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_write *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE int rs_write(register tty_t *tp, int try)
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* (*devwrite)() routine for RS232. */
|
|
|
|
|
|
|
|
rs232_t *rs = tp->tty_priv;
|
|
|
|
int count, ocount;
|
|
|
|
|
|
|
|
if (rs->inhibited != tp->tty_inhibited) {
|
|
|
|
/* Inhibition state has changed. */
|
|
|
|
lock();
|
|
|
|
rs->ostate |= OSWREADY;
|
|
|
|
if (tp->tty_inhibited) rs->ostate &= ~OSWREADY;
|
|
|
|
unlock();
|
|
|
|
rs->inhibited = tp->tty_inhibited;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (rs->drain) {
|
|
|
|
/* Wait for the line to drain then reconfigure and continue output. */
|
2005-06-17 15:37:41 +02:00
|
|
|
if (rs->ocount > 0) return 0;
|
2005-04-21 16:53:53 +02:00
|
|
|
rs->drain = FALSE;
|
|
|
|
rs_config(rs);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* While there is something to do. */
|
|
|
|
for (;;) {
|
|
|
|
ocount = buflen(rs->obuf) - rs->ocount;
|
|
|
|
count = bufend(rs->obuf) - rs->ohead;
|
|
|
|
if (count > ocount) count = ocount;
|
|
|
|
if (count > tp->tty_outleft) count = tp->tty_outleft;
|
2005-06-17 15:37:41 +02:00
|
|
|
if (count == 0 || tp->tty_inhibited) {
|
2005-09-11 19:09:11 +02:00
|
|
|
if (try) return 0;
|
2005-06-17 15:37:41 +02:00
|
|
|
break;
|
|
|
|
}
|
2005-09-11 19:09:11 +02:00
|
|
|
if (try) return 1;
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Copy from user space to the RS232 output buffer. */
|
2006-06-20 11:02:54 +02:00
|
|
|
if(tp->tty_out_safe) {
|
|
|
|
sys_safecopyfrom(tp->tty_outproc, tp->tty_out_vir_g,
|
|
|
|
tp->tty_out_vir_offset, (vir_bytes) rs->ohead, count, D);
|
|
|
|
} else {
|
|
|
|
sys_vircopy(tp->tty_outproc, D, (vir_bytes) tp->tty_out_vir_g,
|
2005-05-13 14:29:10 +02:00
|
|
|
SELF, D, (vir_bytes) rs->ohead, (phys_bytes) count);
|
2006-06-20 11:02:54 +02:00
|
|
|
}
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Perform output processing on the output buffer. */
|
|
|
|
out_process(tp, rs->obuf, rs->ohead, bufend(rs->obuf), &count, &ocount);
|
|
|
|
if (count == 0) break;
|
|
|
|
|
|
|
|
/* Assume echoing messed up by output. */
|
|
|
|
tp->tty_reprint = TRUE;
|
|
|
|
|
|
|
|
/* Bookkeeping. */
|
|
|
|
lock(); /* protect interrupt sensitive rs->ocount */
|
|
|
|
rs->ocount += ocount;
|
|
|
|
rs_ostart(rs);
|
|
|
|
unlock();
|
|
|
|
if ((rs->ohead += ocount) >= bufend(rs->obuf))
|
|
|
|
rs->ohead -= buflen(rs->obuf);
|
2006-06-20 11:02:54 +02:00
|
|
|
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. */
|
2007-01-04 13:06:04 +01:00
|
|
|
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);
|
2007-01-04 13:06:04 +01:00
|
|
|
tp->tty_outcum = 0;
|
|
|
|
}
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
if (tp->tty_outleft > 0 && tp->tty_termios.c_ospeed == B0) {
|
|
|
|
/* Oops, the line has hung up. */
|
2007-01-04 13:06:04 +01:00
|
|
|
if(tp->tty_outrepcode == TTY_REVIVE) {
|
|
|
|
notify(tp->tty_outcaller);
|
|
|
|
tp->tty_outrevived = 1;
|
|
|
|
} else {
|
|
|
|
tty_reply(tp->tty_outrepcode, tp->tty_outcaller,
|
|
|
|
tp->tty_outproc, EIO);
|
|
|
|
tp->tty_outleft = tp->tty_outcum = 0;
|
|
|
|
}
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
2005-06-17 15:37:41 +02:00
|
|
|
|
|
|
|
return 1;
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_echo *
|
|
|
|
*===========================================================================*/
|
2005-04-21 16:53:53 +02:00
|
|
|
PRIVATE void rs_echo(tp, c)
|
|
|
|
tty_t *tp; /* which TTY */
|
|
|
|
int c; /* character to echo */
|
|
|
|
{
|
|
|
|
/* Echo one character. (Like rs_write, but only one character, optionally.) */
|
|
|
|
|
|
|
|
rs232_t *rs = tp->tty_priv;
|
|
|
|
int count, ocount;
|
|
|
|
|
|
|
|
ocount = buflen(rs->obuf) - rs->ocount;
|
|
|
|
if (ocount == 0) return; /* output buffer full */
|
|
|
|
count = 1;
|
|
|
|
*rs->ohead = c; /* add one character */
|
|
|
|
|
|
|
|
out_process(tp, rs->obuf, rs->ohead, bufend(rs->obuf), &count, &ocount);
|
|
|
|
if (count == 0) return;
|
|
|
|
|
|
|
|
lock();
|
|
|
|
rs->ocount += ocount;
|
|
|
|
rs_ostart(rs);
|
|
|
|
unlock();
|
|
|
|
if ((rs->ohead += ocount) >= bufend(rs->obuf)) rs->ohead -= buflen(rs->obuf);
|
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_ioctl *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE int rs_ioctl(tty_t *tp, int dummy)
|
|
|
|
/* tp; which TTY */
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* Reconfigure the line as soon as the output has drained. */
|
|
|
|
rs232_t *rs = tp->tty_priv;
|
|
|
|
|
|
|
|
rs->drain = TRUE;
|
2005-07-29 17:22:58 +02:00
|
|
|
return 0; /* dummy */
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_config *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE void rs_config(rs232_t *rs)
|
|
|
|
/* rs which line */
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* Set various line control parameters for RS232 I/O.
|
|
|
|
* If DataBits == 5 and StopBits == 2, 8250 will generate 1.5 stop bits.
|
|
|
|
* The 8250 can't handle split speed, so we use the input speed.
|
|
|
|
*/
|
|
|
|
|
|
|
|
tty_t *tp = rs->tty;
|
|
|
|
int divisor;
|
|
|
|
int line_controls;
|
|
|
|
static struct speed2divisor {
|
|
|
|
speed_t speed;
|
|
|
|
int divisor;
|
|
|
|
} s2d[] = {
|
|
|
|
#if (MACHINE == IBM_PC)
|
|
|
|
{ B50, UART_FREQ / 50 },
|
|
|
|
#endif
|
|
|
|
{ B75, UART_FREQ / 75 },
|
|
|
|
{ B110, UART_FREQ / 110 },
|
|
|
|
{ B134, UART_FREQ * 10 / 1345 },
|
|
|
|
{ B150, UART_FREQ / 150 },
|
|
|
|
{ B200, UART_FREQ / 200 },
|
|
|
|
{ B300, UART_FREQ / 300 },
|
|
|
|
{ B600, UART_FREQ / 600 },
|
|
|
|
{ B1200, UART_FREQ / 1200 },
|
|
|
|
#if (MACHINE == IBM_PC)
|
|
|
|
{ B1800, UART_FREQ / 1800 },
|
|
|
|
#endif
|
|
|
|
{ B2400, UART_FREQ / 2400 },
|
|
|
|
{ B4800, UART_FREQ / 4800 },
|
|
|
|
{ B9600, UART_FREQ / 9600 },
|
|
|
|
{ B19200, UART_FREQ / 19200 },
|
|
|
|
#if (MACHINE == IBM_PC)
|
|
|
|
{ B38400, UART_FREQ / 38400 },
|
|
|
|
{ B57600, UART_FREQ / 57600 },
|
|
|
|
{ B115200, UART_FREQ / 115200L },
|
|
|
|
#endif
|
|
|
|
};
|
|
|
|
struct speed2divisor *s2dp;
|
|
|
|
|
|
|
|
/* RS232 needs to know the xoff character, and if CTS works. */
|
|
|
|
rs->oxoff = tp->tty_termios.c_cc[VSTOP];
|
|
|
|
rs->cts = (tp->tty_termios.c_cflag & CLOCAL) ? MS_CTS : 0;
|
|
|
|
|
|
|
|
/* Look up the 8250 rate divisor from the output speed. */
|
|
|
|
divisor = 0;
|
|
|
|
for (s2dp = s2d; s2dp < s2d + sizeof(s2d)/sizeof(s2d[0]); s2dp++) {
|
|
|
|
if (s2dp->speed == tp->tty_termios.c_ospeed) divisor = s2dp->divisor;
|
|
|
|
}
|
|
|
|
if (divisor == 0) return; /* B0? */
|
|
|
|
|
|
|
|
/* Compute line control flag bits. */
|
|
|
|
line_controls = 0;
|
|
|
|
if (tp->tty_termios.c_cflag & PARENB) {
|
|
|
|
line_controls |= LC_PARITY;
|
|
|
|
if (!(tp->tty_termios.c_cflag & PARODD)) line_controls |= LC_PAREVEN;
|
|
|
|
}
|
|
|
|
if (divisor >= (UART_FREQ / 110)) line_controls |= LC_2STOP_BITS;
|
|
|
|
line_controls |= (tp->tty_termios.c_cflag & CSIZE) >> 2;
|
|
|
|
|
|
|
|
/* Lock out interrupts while setting the speed. The receiver register is
|
|
|
|
* going to be hidden by the div_low register, but the input interrupt
|
|
|
|
* handler relies on reading it to clear the interrupt and avoid looping
|
|
|
|
* forever.
|
|
|
|
*/
|
|
|
|
lock();
|
|
|
|
|
|
|
|
/* Select the baud rate divisor registers and change the rate. */
|
2005-05-13 14:29:10 +02:00
|
|
|
sys_outb(rs->line_ctl_port, LC_ADDRESS_DIVISOR);
|
|
|
|
sys_outb(rs->div_low_port, divisor);
|
|
|
|
sys_outb(rs->div_hi_port, divisor >> 8);
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Change the line controls and reselect the usual registers. */
|
2005-05-13 14:29:10 +02:00
|
|
|
sys_outb(rs->line_ctl_port, line_controls);
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
rs->ostate = devready(rs) | ORAW | OSWREADY; /* reads modem_ctl_port */
|
|
|
|
if ((tp->tty_termios.c_lflag & IXON) && rs->oxoff != _POSIX_VDISABLE)
|
|
|
|
rs->ostate &= ~ORAW;
|
|
|
|
|
|
|
|
unlock();
|
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_init *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PUBLIC void rs_init(tty_t *tp)
|
|
|
|
/* tp which TTY */
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
2006-03-25 00:02:56 +01:00
|
|
|
unsigned long dummy;
|
2005-04-21 16:53:53 +02:00
|
|
|
/* Initialize RS232 for one line. */
|
|
|
|
|
|
|
|
register rs232_t *rs;
|
|
|
|
int line;
|
|
|
|
port_t this_8250;
|
|
|
|
int irq;
|
2009-01-29 16:06:40 +01:00
|
|
|
char l[10];
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Associate RS232 and TTY structures. */
|
|
|
|
line = tp - &tty_table[NR_CONS];
|
2009-01-29 16:06:40 +01:00
|
|
|
|
|
|
|
/* See if kernel debugging is enabled; if so, don't initialize this
|
|
|
|
* serial line, making tty not look at the irq and returning ENXIO
|
|
|
|
* for all requests on it from userland. (The kernel will use it.)
|
|
|
|
*/
|
|
|
|
if(env_get_param(SERVARNAME, l, sizeof(l)-1) == OK && atoi(l) == line) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2005-04-21 16:53:53 +02:00
|
|
|
rs = tp->tty_priv = &rs_lines[line];
|
|
|
|
rs->tty = tp;
|
|
|
|
|
|
|
|
/* Set up input queue. */
|
|
|
|
rs->ihead = rs->itail = rs->ibuf;
|
|
|
|
|
|
|
|
/* Precalculate port numbers for speed. Magic numbers in the code (once). */
|
|
|
|
this_8250 = addr_8250[line];
|
|
|
|
rs->xmit_port = this_8250 + 0;
|
|
|
|
rs->recv_port = this_8250 + 0;
|
|
|
|
rs->div_low_port = this_8250 + 0;
|
|
|
|
rs->div_hi_port = this_8250 + 1;
|
|
|
|
rs->int_enab_port = this_8250 + 1;
|
|
|
|
rs->int_id_port = this_8250 + 2;
|
|
|
|
rs->line_ctl_port = this_8250 + 3;
|
|
|
|
rs->modem_ctl_port = this_8250 + 4;
|
|
|
|
rs->line_status_port = this_8250 + 5;
|
|
|
|
rs->modem_status_port = this_8250 + 6;
|
|
|
|
|
|
|
|
/* Set up the hardware to a base state, in particular
|
|
|
|
* o turn off DTR (MC_DTR) to try to stop the external device.
|
|
|
|
* o be careful about the divisor latch. Some BIOS's leave it enabled
|
|
|
|
* here and that caused trouble (no interrupts) in version 1.5 by
|
|
|
|
* hiding the interrupt enable port in the next step, and worse trouble
|
|
|
|
* (continual interrupts) in an old version by hiding the receiver
|
|
|
|
* port in the first interrupt. Call rs_ioctl() early to avoid this.
|
|
|
|
* o disable interrupts at the chip level, to force an edge transition
|
|
|
|
* on the 8259 line when interrupts are next enabled and active.
|
|
|
|
* RS232 interrupts are guaranteed to be disabled now by the 8259
|
|
|
|
* mask, but there used to be trouble if the mask was set without
|
|
|
|
* handling a previous interrupt.
|
|
|
|
*/
|
|
|
|
istop(rs); /* sets modem_ctl_port */
|
|
|
|
rs_config(rs);
|
2005-05-13 14:29:10 +02:00
|
|
|
sys_outb(rs->int_enab_port, 0);
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
/* Clear any harmful leftover interrupts. An output interrupt is harmless
|
|
|
|
* and will occur when interrupts are enabled anyway. Set up the output
|
|
|
|
* queue using the status from clearing the modem status interrupt.
|
|
|
|
*/
|
2005-05-13 14:29:10 +02:00
|
|
|
sys_inb(rs->line_status_port, &dummy);
|
|
|
|
sys_inb(rs->recv_port, &dummy);
|
2005-04-21 16:53:53 +02:00
|
|
|
rs->ostate = devready(rs) | ORAW | OSWREADY; /* reads modem_ctl_port */
|
|
|
|
rs->ohead = rs->otail = rs->obuf;
|
|
|
|
|
|
|
|
/* Enable interrupts for both interrupt controller and device. */
|
|
|
|
irq = (line & 1) == 0 ? RS232_IRQ : SECONDARY_IRQ;
|
|
|
|
|
2005-07-29 17:22:58 +02:00
|
|
|
rs->irq = irq;
|
2005-07-29 17:33:31 +02:00
|
|
|
rs->irq_hook_id = rs->irq; /* call back with irq line number */
|
2005-09-11 19:09:11 +02:00
|
|
|
if (sys_irqsetpolicy(irq, IRQ_REENABLE, &rs->irq_hook_id) != OK) {
|
2005-05-13 14:29:10 +02:00
|
|
|
printf("RS232: Couldn't obtain hook for irq %d\n", irq);
|
|
|
|
} else {
|
2005-09-11 19:09:11 +02:00
|
|
|
if (sys_irqenable(&rs->irq_hook_id) != OK) {
|
2005-05-13 14:29:10 +02:00
|
|
|
printf("RS232: Couldn't enable irq %d (hooked)\n", irq);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2005-07-29 17:22:58 +02:00
|
|
|
rs_irq_set |= (1 << irq);
|
|
|
|
|
2005-05-13 14:29:10 +02:00
|
|
|
sys_outb(rs->int_enab_port, IE_LINE_STATUS_CHANGE | IE_MODEM_STATUS_CHANGE
|
2005-04-21 16:53:53 +02:00
|
|
|
| IE_RECEIVER_READY | IE_TRANSMITTER_READY);
|
|
|
|
|
|
|
|
/* Fill in TTY function hooks. */
|
|
|
|
tp->tty_devread = rs_read;
|
|
|
|
tp->tty_devwrite = rs_write;
|
|
|
|
tp->tty_echo = rs_echo;
|
|
|
|
tp->tty_icancel = rs_icancel;
|
|
|
|
tp->tty_ocancel = rs_ocancel;
|
|
|
|
tp->tty_ioctl = rs_ioctl;
|
|
|
|
tp->tty_break = rs_break;
|
|
|
|
tp->tty_close = rs_close;
|
|
|
|
|
|
|
|
/* Tell external device we are ready. */
|
|
|
|
istart(rs);
|
2005-07-29 17:22:58 +02:00
|
|
|
|
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_interrupt *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PUBLIC void rs_interrupt(message *m)
|
2005-07-29 17:22:58 +02:00
|
|
|
{
|
|
|
|
unsigned long irq_set;
|
|
|
|
int i;
|
|
|
|
rs232_t *rs;
|
|
|
|
|
|
|
|
irq_set= m->NOTIFY_ARG;
|
|
|
|
for (i= 0, rs = rs_lines; i<NR_RS_LINES; i++, rs++)
|
|
|
|
{
|
|
|
|
if (irq_set & (1 << rs->irq))
|
|
|
|
rs232_handler(rs);
|
|
|
|
}
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_icancel *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE int rs_icancel(tty_t *tp, int dummy)
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* Cancel waiting input. */
|
|
|
|
rs232_t *rs = tp->tty_priv;
|
|
|
|
|
|
|
|
lock();
|
|
|
|
rs->icount = 0;
|
|
|
|
rs->itail = rs->ihead;
|
|
|
|
istart(rs);
|
|
|
|
unlock();
|
2005-07-29 17:22:58 +02:00
|
|
|
|
|
|
|
return 0; /* dummy */
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_ocancel *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE int rs_ocancel(tty_t *tp, int dummy)
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* Cancel pending output. */
|
|
|
|
rs232_t *rs = tp->tty_priv;
|
|
|
|
|
|
|
|
lock();
|
|
|
|
rs->ostate &= ~(ODONE | OQUEUED);
|
|
|
|
rs->ocount = 0;
|
|
|
|
rs->otail = rs->ohead;
|
|
|
|
unlock();
|
2005-07-29 17:22:58 +02:00
|
|
|
|
|
|
|
return 0; /* dummy */
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_read *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE int rs_read(tty_t *tp, int try)
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* Process characters from the circular input buffer. */
|
|
|
|
|
|
|
|
rs232_t *rs = tp->tty_priv;
|
|
|
|
int icount, count, ostate;
|
|
|
|
|
|
|
|
if (!(tp->tty_termios.c_cflag & CLOCAL)) {
|
2005-09-11 19:09:11 +02:00
|
|
|
if (try) return 1;
|
2005-04-21 16:53:53 +02:00
|
|
|
/* Send a SIGHUP if hangup detected. */
|
|
|
|
lock();
|
|
|
|
ostate = rs->ostate;
|
|
|
|
rs->ostate &= ~ODEVHUP; /* save ostate, clear DEVHUP */
|
|
|
|
unlock();
|
|
|
|
if (ostate & ODEVHUP) {
|
2009-04-06 11:39:42 +02:00
|
|
|
sigchar(tp, SIGHUP, 1);
|
2005-04-21 16:53:53 +02:00
|
|
|
tp->tty_termios.c_ospeed = B0; /* Disable further I/O. */
|
2008-11-19 13:26:10 +01:00
|
|
|
return 0;
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
if (try) {
|
|
|
|
if (rs->icount > 0)
|
2005-06-17 15:37:41 +02:00
|
|
|
return 1;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2005-04-21 16:53:53 +02:00
|
|
|
while ((count = rs->icount) > 0) {
|
|
|
|
icount = bufend(rs->ibuf) - rs->itail;
|
|
|
|
if (count > icount) count = icount;
|
|
|
|
|
|
|
|
/* Perform input processing on (part of) the input buffer. */
|
2010-04-15 08:55:42 +02:00
|
|
|
if ((count = in_process(tp, rs->itail, count, -1)) == 0) break;
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
lock(); /* protect interrupt sensitive variables */
|
|
|
|
rs->icount -= count;
|
|
|
|
if (!rs->idevready && rs->icount < RS_ILOWWATER) istart(rs);
|
|
|
|
unlock();
|
|
|
|
if ((rs->itail += count) == bufend(rs->ibuf)) rs->itail = rs->ibuf;
|
|
|
|
}
|
2008-11-19 13:26:10 +01:00
|
|
|
|
|
|
|
return 0;
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_ostart *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE void rs_ostart(rs232_t *rs)
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* Tell RS232 there is something waiting in the output buffer. */
|
|
|
|
|
|
|
|
rs->ostate |= OQUEUED;
|
|
|
|
if (txready(rs)) out_int(rs);
|
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_break *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE int rs_break(tty_t *tp, int dummy)
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* Generate a break condition by setting the BREAK bit for 0.4 sec. */
|
|
|
|
rs232_t *rs = tp->tty_priv;
|
2006-03-25 00:02:56 +01:00
|
|
|
unsigned long line_controls;
|
2005-04-21 16:53:53 +02:00
|
|
|
|
2005-05-13 14:29:10 +02:00
|
|
|
sys_inb(rs->line_ctl_port, &line_controls);
|
|
|
|
sys_outb(rs->line_ctl_port, line_controls | LC_BREAK);
|
|
|
|
/* XXX */
|
|
|
|
/* milli_delay(400); */ /* ouch */
|
|
|
|
printf("RS232 break\n");
|
|
|
|
sys_outb(rs->line_ctl_port, line_controls);
|
2005-07-29 17:22:58 +02:00
|
|
|
return 0; /* dummy */
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs_close *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE int rs_close(tty_t *tp, int dummy)
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* The line is closed; optionally hang up. */
|
|
|
|
rs232_t *rs = tp->tty_priv;
|
|
|
|
|
|
|
|
if (tp->tty_termios.c_cflag & HUPCL) {
|
2005-05-13 14:29:10 +02:00
|
|
|
sys_outb(rs->modem_ctl_port, MC_OUT2 | MC_RTS);
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
2005-07-29 17:22:58 +02:00
|
|
|
return 0; /* dummy */
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Low level (interrupt) routines. */
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* rs232_handler *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE void rs232_handler(struct rs232 *rs)
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* Interrupt hander for RS232. */
|
|
|
|
|
|
|
|
while (TRUE) {
|
2006-03-25 00:02:56 +01:00
|
|
|
unsigned long v;
|
2005-04-21 16:53:53 +02:00
|
|
|
/* Loop to pick up ALL pending interrupts for device.
|
|
|
|
* This usually just wastes time unless the hardware has a buffer
|
|
|
|
* (and then we have to worry about being stuck in the loop too long).
|
|
|
|
* Unfortunately, some serial cards lock up without this.
|
|
|
|
*/
|
2005-05-13 14:29:10 +02:00
|
|
|
sys_inb(rs->int_id_port, &v);
|
|
|
|
switch (v) {
|
2005-04-21 16:53:53 +02:00
|
|
|
case IS_RECEIVER_READY:
|
|
|
|
in_int(rs);
|
|
|
|
continue;
|
|
|
|
case IS_TRANSMITTER_READY:
|
|
|
|
out_int(rs);
|
|
|
|
continue;
|
|
|
|
case IS_MODEM_STATUS_CHANGE:
|
|
|
|
modem_int(rs);
|
|
|
|
continue;
|
|
|
|
case IS_LINE_STATUS_CHANGE:
|
|
|
|
line_int(rs);
|
|
|
|
continue;
|
|
|
|
}
|
2005-07-29 17:22:58 +02:00
|
|
|
return;
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* in_int *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE void in_int(register rs232_t *rs)
|
|
|
|
/* rs line with input interrupt */
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* Read the data which just arrived.
|
|
|
|
* If it is the oxoff char, clear OSWREADY, else if OSWREADY was clear, set
|
|
|
|
* it and restart output (any char does this, not just xon).
|
|
|
|
* Put data in the buffer if room, otherwise discard it.
|
|
|
|
* Set a flag for the clock interrupt handler to eventually notify TTY.
|
|
|
|
*/
|
|
|
|
|
2006-03-25 00:02:56 +01:00
|
|
|
unsigned long c;
|
2005-04-21 16:53:53 +02:00
|
|
|
|
2007-04-23 16:59:32 +02:00
|
|
|
#if 0 /* Enable this if you want serial input in the kernel */
|
|
|
|
return;
|
|
|
|
#endif
|
|
|
|
|
2005-05-13 14:29:10 +02:00
|
|
|
sys_inb(rs->recv_port, &c);
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
if (!(rs->ostate & ORAW)) {
|
|
|
|
if (c == rs->oxoff) {
|
|
|
|
rs->ostate &= ~OSWREADY;
|
|
|
|
} else
|
|
|
|
if (!(rs->ostate & OSWREADY)) {
|
|
|
|
rs->ostate |= OSWREADY;
|
|
|
|
if (txready(rs)) out_int(rs);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2005-10-24 15:57:19 +02:00
|
|
|
if (rs->icount == buflen(rs->ibuf))
|
|
|
|
{
|
|
|
|
printf("in_int: discarding byte\n");
|
|
|
|
return; /* input buffer full, discard */
|
|
|
|
}
|
2005-04-21 16:53:53 +02:00
|
|
|
|
|
|
|
if (++rs->icount == RS_IHIGHWATER && rs->idevready) istop(rs);
|
|
|
|
*rs->ihead = c;
|
|
|
|
if (++rs->ihead == bufend(rs->ibuf)) rs->ihead = rs->ibuf;
|
|
|
|
if (rs->icount == 1) {
|
|
|
|
rs->tty->tty_events = 1;
|
|
|
|
force_timeout();
|
|
|
|
}
|
2005-10-24 15:57:19 +02:00
|
|
|
else
|
|
|
|
printf("in_int: icount = %d\n", rs->icount);
|
2005-04-21 16:53:53 +02:00
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* line_int *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE void line_int(register rs232_t *rs)
|
|
|
|
/* rs line with line status interrupt */
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* Check for and record errors. */
|
|
|
|
|
2010-01-27 11:19:13 +01:00
|
|
|
unsigned long s;
|
2006-03-25 00:02:56 +01:00
|
|
|
sys_inb(rs->line_status_port, &s);
|
|
|
|
rs->lstatus = s;
|
2005-04-21 16:53:53 +02:00
|
|
|
if (rs->lstatus & LS_FRAMING_ERR) ++rs->framing_errors;
|
|
|
|
if (rs->lstatus & LS_OVERRUN_ERR) ++rs->overrun_errors;
|
|
|
|
if (rs->lstatus & LS_PARITY_ERR) ++rs->parity_errors;
|
|
|
|
if (rs->lstatus & LS_BREAK_INTERRUPT) ++rs->break_interrupts;
|
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
|
|
|
* modem_int *
|
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE void modem_int(register rs232_t *rs)
|
|
|
|
/* rs line with modem interrupt */
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* Get possibly new device-ready status, and clear ODEVREADY if necessary.
|
|
|
|
* If the device just became ready, restart output.
|
|
|
|
*/
|
|
|
|
|
|
|
|
if (devhup(rs)) {
|
|
|
|
rs->ostate |= ODEVHUP;
|
|
|
|
rs->tty->tty_events = 1;
|
|
|
|
force_timeout();
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!devready(rs))
|
|
|
|
rs->ostate &= ~ODEVREADY;
|
|
|
|
else if (!(rs->ostate & ODEVREADY)) {
|
|
|
|
rs->ostate |= ODEVREADY;
|
|
|
|
if (txready(rs)) out_int(rs);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2005-09-11 19:09:11 +02:00
|
|
|
/*===========================================================================*
|
2005-04-21 16:53:53 +02:00
|
|
|
* out_int *
|
2005-09-11 19:09:11 +02:00
|
|
|
*===========================================================================*/
|
2010-01-27 11:19:13 +01:00
|
|
|
PRIVATE void out_int(register rs232_t *rs)
|
|
|
|
/* rs; line with output interrupt */
|
2005-04-21 16:53:53 +02:00
|
|
|
{
|
|
|
|
/* If there is output to do and everything is ready, do it (local device is
|
|
|
|
* known ready).
|
|
|
|
* Notify TTY when the buffer goes empty.
|
|
|
|
*/
|
|
|
|
|
|
|
|
if (rs->ostate >= (ODEVREADY | OQUEUED | OSWREADY)) {
|
|
|
|
/* Bit test allows ORAW and requires the others. */
|
2005-05-13 14:29:10 +02:00
|
|
|
sys_outb(rs->xmit_port, *rs->otail);
|
2005-04-21 16:53:53 +02:00
|
|
|
if (++rs->otail == bufend(rs->obuf)) rs->otail = rs->obuf;
|
|
|
|
if (--rs->ocount == 0) {
|
|
|
|
rs->ostate ^= (ODONE | OQUEUED); /* ODONE on, OQUEUED off */
|
|
|
|
rs->tty->tty_events = 1;
|
|
|
|
force_timeout();
|
|
|
|
} else
|
|
|
|
if (rs->ocount == RS_OLOWWATER) { /* running low? */
|
|
|
|
rs->tty->tty_events = 1;
|
|
|
|
force_timeout();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif /* NR_RS_LINES > 0 */
|
|
|
|
|