mirror of
https://git.FreeBSD.org/src.git
synced 2024-12-27 11:55:06 +00:00
fbd7573929
warning.
2967 lines
74 KiB
C
2967 lines
74 KiB
C
/*-
|
|
* cyclades cyclom-y serial driver
|
|
* Andrew Herbert <andrew@werple.apana.org.au>, 17 August 1993
|
|
*
|
|
* Copyright (c) 1993 Andrew Herbert.
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. The name Andrew Herbert may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY ``AS IS'' AND ANY EXPRESS OR IMPLIED
|
|
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
|
|
* NO EVENT SHALL I BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
|
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
|
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
|
* PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
* $FreeBSD$
|
|
*/
|
|
|
|
#include "opt_compat.h"
|
|
#include "cy.h"
|
|
|
|
/*
|
|
* TODO:
|
|
* Atomic COR change.
|
|
* Consoles.
|
|
*/
|
|
|
|
/*
|
|
* Temporary compile-time configuration options.
|
|
*/
|
|
#define RxFifoThreshold (CD1400_RX_FIFO_SIZE / 2)
|
|
/* Number of chars in the receiver FIFO before an
|
|
* an interrupt is generated. Should depend on
|
|
* line speed. Needs to be about 6 on a 486DX33
|
|
* for 4 active ports at 115200 bps. Why doesn't
|
|
* 10 work?
|
|
*/
|
|
#define PollMode /* Use polling-based irq service routine, not the
|
|
* hardware svcack lines. Must be defined for
|
|
* Cyclom-16Y boards. Less efficient for Cyclom-8Ys,
|
|
* and stops 4 * 115200 bps from working.
|
|
*/
|
|
#undef Smarts /* Enable slightly more CD1400 intelligence. Mainly
|
|
* the output CR/LF processing, plus we can avoid a
|
|
* few checks usually done in ttyinput().
|
|
*
|
|
* XXX not fully implemented, and not particularly
|
|
* worthwhile.
|
|
*/
|
|
#undef CyDebug /* Include debugging code (not very expensive). */
|
|
|
|
/* These will go away. */
|
|
#undef SOFT_CTS_OFLOW
|
|
#define SOFT_HOTCHAR
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/dkstat.h>
|
|
#include <sys/fcntl.h>
|
|
#include <sys/interrupt.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/lock.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/mutex.h>
|
|
#include <sys/syslog.h>
|
|
#include <sys/tty.h>
|
|
|
|
#include <machine/psl.h>
|
|
|
|
#include <i386/isa/isa_device.h>
|
|
#include <i386/isa/cyreg.h>
|
|
#include <i386/isa/ic/cd1400.h>
|
|
|
|
#ifndef COMPAT_OLDISA
|
|
#error "The cy device requires the old isa compatibility shims"
|
|
#endif
|
|
|
|
#ifdef SMP
|
|
|
|
#include <machine/smptests.h> /** xxx_LOCK */
|
|
|
|
#ifdef USE_COMLOCK
|
|
#define COM_LOCK() mtx_lock_spin(&com_mtx)
|
|
#define COM_UNLOCK() mtx_unlock_spin(&com_mtx)
|
|
#else
|
|
#define COM_LOCK()
|
|
#define COM_UNLOCK()
|
|
#endif /* USE_COMLOCK */
|
|
|
|
#else /* SMP */
|
|
|
|
#define COM_LOCK()
|
|
#define COM_UNLOCK()
|
|
|
|
#endif /* SMP */
|
|
|
|
extern struct mtx com_mtx;
|
|
|
|
/*
|
|
* Dictionary so that I can name everything *sio* or *com* to compare with
|
|
* sio.c. There is also lots of ugly formatting and unnecessary ifdefs to
|
|
* simplify the comparision. These will go away.
|
|
*/
|
|
#define LSR_BI CD1400_RDSR_BREAK
|
|
#define LSR_FE CD1400_RDSR_FE
|
|
#define LSR_OE CD1400_RDSR_OE
|
|
#define LSR_PE CD1400_RDSR_PE
|
|
#define MCR_DTR CD1400_MSVR2_DTR
|
|
#define MCR_RTS CD1400_MSVR1_RTS
|
|
#define MSR_CTS CD1400_MSVR2_CTS
|
|
#define MSR_DCD CD1400_MSVR2_CD
|
|
#define MSR_DSR CD1400_MSVR2_DSR
|
|
#define MSR_RI CD1400_MSVR2_RI
|
|
#define NSIO (NCY * CY_MAX_PORTS)
|
|
#define comconsole cyconsole
|
|
#define comdefaultrate cydefaultrate
|
|
#define com_events cy_events
|
|
#define comhardclose cyhardclose
|
|
#define commctl cymctl
|
|
#define comparam cyparam
|
|
#define comspeed cyspeed
|
|
#define comstart cystart
|
|
#define comwakeup cywakeup
|
|
#define p_com_addr p_cy_addr
|
|
#define sioattach cyattach
|
|
#define sioclose cyclose
|
|
#define siodriver cydriver
|
|
#define siodtrwakeup cydtrwakeup
|
|
#define sioinput cyinput
|
|
#define siointr cyintr
|
|
#define siointr1 cyintr1
|
|
#define sioioctl cyioctl
|
|
#define sioopen cyopen
|
|
#define siopoll cypoll
|
|
#define sioprobe cyprobe
|
|
#define siosettimeout cysettimeout
|
|
#define siosetwater cysetwater
|
|
#define comstop cystop
|
|
#define siowrite cywrite
|
|
#define sio_ih cy_ih
|
|
#define sio_irec cy_irec
|
|
#define sio_timeout cy_timeout
|
|
#define sio_timeout_handle cy_timeout_handle
|
|
#define sio_timeouts_until_log cy_timeouts_until_log
|
|
|
|
#define CY_MAX_PORTS (CD1400_NO_OF_CHANNELS * CY_MAX_CD1400s)
|
|
|
|
/* We encode the cyclom unit number (cyu) in spare bits in the IVR's. */
|
|
#define CD1400_xIVR_CHAN_SHIFT 3
|
|
#define CD1400_xIVR_CHAN 0x1F
|
|
|
|
/*
|
|
* ETC states. com->etc may also contain a hardware ETC command value,
|
|
* meaning that execution of that command is pending.
|
|
*/
|
|
#define ETC_NONE 0 /* we depend on bzero() setting this */
|
|
#define ETC_BREAK_STARTING 1
|
|
#define ETC_BREAK_STARTED 2
|
|
#define ETC_BREAK_ENDING 3
|
|
#define ETC_BREAK_ENDED 4
|
|
|
|
#define LOTS_OF_EVENTS 64 /* helps separate urgent events from input */
|
|
|
|
#define CALLOUT_MASK 0x80
|
|
#define CONTROL_MASK 0x60
|
|
#define CONTROL_INIT_STATE 0x20
|
|
#define CONTROL_LOCK_STATE 0x40
|
|
#define DEV_TO_UNIT(dev) (MINOR_TO_UNIT(minor(dev)))
|
|
#define MINOR_MAGIC_MASK (CALLOUT_MASK | CONTROL_MASK)
|
|
/*
|
|
* Not all of the magic is parametrized in the following macros. 16 and
|
|
* 0xff are related to the bitfields in a udev_t. CY_MAX_PORTS must be
|
|
* ((0xff & ~MINOR_MAGIC_MASK) + 1) for things to work.
|
|
*/
|
|
#define MINOR_TO_UNIT(mynor) (((mynor) >> 16) * CY_MAX_PORTS \
|
|
| (((mynor) & 0xff) & ~MINOR_MAGIC_MASK))
|
|
#define UNIT_TO_MINOR(unit) (((unit) / CY_MAX_PORTS) << 16 \
|
|
| (((unit) & 0xff) & ~MINOR_MAGIC_MASK))
|
|
|
|
/*
|
|
* com state bits.
|
|
* (CS_BUSY | CS_TTGO) and (CS_BUSY | CS_TTGO | CS_ODEVREADY) must be higher
|
|
* than the other bits so that they can be tested as a group without masking
|
|
* off the low bits.
|
|
*
|
|
* The following com and tty flags correspond closely:
|
|
* CS_BUSY = TS_BUSY (maintained by comstart(), siopoll() and
|
|
* comstop())
|
|
* CS_TTGO = ~TS_TTSTOP (maintained by comparam() and comstart())
|
|
* CS_CTS_OFLOW = CCTS_OFLOW (maintained by comparam())
|
|
* CS_RTS_IFLOW = CRTS_IFLOW (maintained by comparam())
|
|
* TS_FLUSH is not used.
|
|
* XXX I think TIOCSETA doesn't clear TS_TTSTOP when it clears IXON.
|
|
* XXX CS_*FLOW should be CF_*FLOW in com->flags (control flags not state).
|
|
*/
|
|
#define CS_BUSY 0x80 /* output in progress */
|
|
#define CS_TTGO 0x40 /* output not stopped by XOFF */
|
|
#define CS_ODEVREADY 0x20 /* external device h/w ready (CTS) */
|
|
#define CS_CHECKMSR 1 /* check of MSR scheduled */
|
|
#define CS_CTS_OFLOW 2 /* use CTS output flow control */
|
|
#define CS_DTR_OFF 0x10 /* DTR held off */
|
|
#define CS_ODONE 4 /* output completed */
|
|
#define CS_RTS_IFLOW 8 /* use RTS input flow control */
|
|
#define CSE_ODONE 1 /* output transmitted */
|
|
|
|
static char const * const error_desc[] = {
|
|
#define CE_OVERRUN 0
|
|
"silo overflow",
|
|
#define CE_INTERRUPT_BUF_OVERFLOW 1
|
|
"interrupt-level buffer overflow",
|
|
#define CE_TTY_BUF_OVERFLOW 2
|
|
"tty-level buffer overflow",
|
|
};
|
|
|
|
#define CE_NTYPES 3
|
|
#define CE_RECORD(com, errnum) (++(com)->delta_error_counts[errnum])
|
|
|
|
/* types. XXX - should be elsewhere */
|
|
typedef u_char bool_t; /* boolean */
|
|
typedef u_char volatile *cy_addr;
|
|
|
|
/* queue of linear buffers */
|
|
struct lbq {
|
|
u_char *l_head; /* next char to process */
|
|
u_char *l_tail; /* one past the last char to process */
|
|
struct lbq *l_next; /* next in queue */
|
|
bool_t l_queued; /* nonzero if queued */
|
|
};
|
|
|
|
/* com device structure */
|
|
struct com_s {
|
|
u_char state; /* miscellaneous flag bits */
|
|
bool_t active_out; /* nonzero if the callout device is open */
|
|
#if 0
|
|
u_char cfcr_image; /* copy of value written to CFCR */
|
|
#endif
|
|
u_char etc; /* pending Embedded Transmit Command */
|
|
u_char extra_state; /* more flag bits, separate for order trick */
|
|
#if 0
|
|
u_char fifo_image; /* copy of value written to FIFO */
|
|
#endif
|
|
u_char gfrcr_image; /* copy of value read from GFRCR */
|
|
#if 0
|
|
bool_t hasfifo; /* nonzero for 16550 UARTs */
|
|
bool_t loses_outints; /* nonzero if device loses output interrupts */
|
|
#endif
|
|
u_char mcr_dtr; /* MCR bit that is wired to DTR */
|
|
u_char mcr_image; /* copy of value written to MCR */
|
|
u_char mcr_rts; /* MCR bit that is wired to RTS */
|
|
#if 0
|
|
#ifdef COM_MULTIPORT
|
|
bool_t multiport; /* is this unit part of a multiport device? */
|
|
#endif /* COM_MULTIPORT */
|
|
bool_t no_irq; /* nonzero if irq is not attached */
|
|
bool_t poll; /* nonzero if polling is required */
|
|
bool_t poll_output; /* nonzero if polling for output is required */
|
|
#endif
|
|
int unit; /* unit number */
|
|
int dtr_wait; /* time to hold DTR down on close (* 1/hz) */
|
|
#if 0
|
|
u_int tx_fifo_size;
|
|
#endif
|
|
u_int wopeners; /* # processes waiting for DCD in open() */
|
|
|
|
/*
|
|
* The high level of the driver never reads status registers directly
|
|
* because there would be too many side effects to handle conveniently.
|
|
* Instead, it reads copies of the registers stored here by the
|
|
* interrupt handler.
|
|
*/
|
|
u_char last_modem_status; /* last MSR read by intr handler */
|
|
u_char prev_modem_status; /* last MSR handled by high level */
|
|
|
|
u_char hotchar; /* ldisc-specific char to be handled ASAP */
|
|
u_char *ibuf; /* start of input buffer */
|
|
u_char *ibufend; /* end of input buffer */
|
|
u_char *ibufold; /* old input buffer, to be freed */
|
|
u_char *ihighwater; /* threshold in input buffer */
|
|
u_char *iptr; /* next free spot in input buffer */
|
|
int ibufsize; /* size of ibuf (not include error bytes) */
|
|
int ierroff; /* offset of error bytes in ibuf */
|
|
|
|
struct lbq obufq; /* head of queue of output buffers */
|
|
struct lbq obufs[2]; /* output buffers */
|
|
|
|
int cy_align; /* index for register alignment */
|
|
cy_addr cy_iobase; /* base address of this port's cyclom */
|
|
cy_addr iobase; /* base address of this port's cd1400 */
|
|
int mcr_rts_reg; /* cd1400 reg number of reg holding mcr_rts */
|
|
|
|
struct tty *tp; /* cross reference */
|
|
|
|
/* Initial state. */
|
|
struct termios it_in; /* should be in struct tty */
|
|
struct termios it_out;
|
|
|
|
/* Lock state. */
|
|
struct termios lt_in; /* should be in struct tty */
|
|
struct termios lt_out;
|
|
|
|
bool_t do_timestamp;
|
|
bool_t do_dcd_timestamp;
|
|
struct timeval timestamp;
|
|
struct timeval dcd_timestamp;
|
|
|
|
u_long bytes_in; /* statistics */
|
|
u_long bytes_out;
|
|
u_int delta_error_counts[CE_NTYPES];
|
|
u_long error_counts[CE_NTYPES];
|
|
|
|
u_int recv_exception; /* exception chars received */
|
|
u_int mdm; /* modem signal changes */
|
|
#ifdef CyDebug
|
|
u_int start_count; /* no. of calls to comstart() */
|
|
u_int start_real; /* no. of calls that did something */
|
|
#endif
|
|
u_char car; /* CD1400 CAR shadow (if first unit in cd) */
|
|
u_char channel_control;/* CD1400 CCR control command shadow */
|
|
u_char cor[3]; /* CD1400 COR1-3 shadows */
|
|
u_char intr_enable; /* CD1400 SRER shadow */
|
|
|
|
/*
|
|
* Data area for output buffers. Someday we should build the output
|
|
* buffer queue without copying data.
|
|
*/
|
|
u_char obuf1[256];
|
|
u_char obuf2[256];
|
|
};
|
|
|
|
/* PCI driver entry point. */
|
|
int cyattach_common __P((cy_addr cy_iobase, int cy_align));
|
|
ointhand2_t siointr;
|
|
|
|
static int cy_units __P((cy_addr cy_iobase, int cy_align));
|
|
static int sioattach __P((struct isa_device *dev));
|
|
static void cd1400_channel_cmd __P((struct com_s *com, int cmd));
|
|
static void cd1400_channel_cmd_wait __P((struct com_s *com));
|
|
static void cd_etc __P((struct com_s *com, int etc));
|
|
static int cd_getreg __P((struct com_s *com, int reg));
|
|
static void cd_setreg __P((struct com_s *com, int reg, int val));
|
|
static timeout_t siodtrwakeup;
|
|
static void comhardclose __P((struct com_s *com));
|
|
static void sioinput __P((struct com_s *com));
|
|
#if 0
|
|
static void siointr1 __P((struct com_s *com));
|
|
#endif
|
|
static int commctl __P((struct com_s *com, int bits, int how));
|
|
static int comparam __P((struct tty *tp, struct termios *t));
|
|
static void siopoll __P((void *arg));
|
|
static int sioprobe __P((struct isa_device *dev));
|
|
static void siosettimeout __P((void));
|
|
static int siosetwater __P((struct com_s *com, speed_t speed));
|
|
static int comspeed __P((speed_t speed, u_long cy_clock,
|
|
int *prescaler_io));
|
|
static void comstart __P((struct tty *tp));
|
|
static void comstop __P((struct tty *tp, int rw));
|
|
static timeout_t comwakeup;
|
|
static void disc_optim __P((struct tty *tp, struct termios *t,
|
|
struct com_s *com));
|
|
|
|
#ifdef CyDebug
|
|
void cystatus __P((int unit));
|
|
#endif
|
|
|
|
static char driver_name[] = "cy";
|
|
|
|
/* table and macro for fast conversion from a unit number to its com struct */
|
|
static struct com_s *p_com_addr[NSIO];
|
|
#define com_addr(unit) (p_com_addr[unit])
|
|
|
|
struct isa_driver siodriver = {
|
|
INTR_TYPE_TTY | INTR_FAST,
|
|
sioprobe,
|
|
sioattach,
|
|
driver_name
|
|
};
|
|
COMPAT_ISA_DRIVER(cy, cydriver); /* XXX */
|
|
|
|
static d_open_t sioopen;
|
|
static d_close_t sioclose;
|
|
static d_write_t siowrite;
|
|
static d_ioctl_t sioioctl;
|
|
|
|
#define CDEV_MAJOR 48
|
|
static struct cdevsw sio_cdevsw = {
|
|
/* open */ sioopen,
|
|
/* close */ sioclose,
|
|
/* read */ ttyread,
|
|
/* write */ siowrite,
|
|
/* ioctl */ sioioctl,
|
|
/* poll */ ttypoll,
|
|
/* mmap */ nommap,
|
|
/* strategy */ nostrategy,
|
|
/* name */ driver_name,
|
|
/* maj */ CDEV_MAJOR,
|
|
/* dump */ nodump,
|
|
/* psize */ nopsize,
|
|
/* flags */ D_TTY | D_KQFILTER,
|
|
/* kqfilter */ ttykqfilter,
|
|
};
|
|
|
|
static int comconsole = -1;
|
|
static speed_t comdefaultrate = TTYDEF_SPEED;
|
|
static u_int com_events; /* input chars + weighted output completions */
|
|
static void *sio_ih;
|
|
static int sio_timeout;
|
|
static int sio_timeouts_until_log;
|
|
static struct callout_handle sio_timeout_handle
|
|
= CALLOUT_HANDLE_INITIALIZER(&sio_timeout_handle);
|
|
|
|
#ifdef CyDebug
|
|
static u_int cd_inbs;
|
|
static u_int cy_inbs;
|
|
static u_int cd_outbs;
|
|
static u_int cy_outbs;
|
|
static u_int cy_svrr_probes;
|
|
static u_int cy_timeouts;
|
|
#endif
|
|
|
|
static int cy_chip_offset[] = {
|
|
0x0000, 0x0400, 0x0800, 0x0c00, 0x0200, 0x0600, 0x0a00, 0x0e00,
|
|
};
|
|
static int cy_nr_cd1400s[NCY];
|
|
static int cy_total_devices;
|
|
#undef RxFifoThreshold
|
|
static int volatile RxFifoThreshold = (CD1400_RX_FIFO_SIZE / 2);
|
|
|
|
static int
|
|
sioprobe(dev)
|
|
struct isa_device *dev;
|
|
{
|
|
cy_addr iobase;
|
|
|
|
iobase = (cy_addr)dev->id_maddr;
|
|
|
|
/* Cyclom-16Y hardware reset (Cyclom-8Ys don't care) */
|
|
cy_inb(iobase, CY16_RESET, 0); /* XXX? */
|
|
DELAY(500); /* wait for the board to get its act together */
|
|
|
|
/* this is needed to get the board out of reset */
|
|
cy_outb(iobase, CY_CLEAR_INTR, 0, 0);
|
|
DELAY(500);
|
|
|
|
return (cy_units(iobase, 0) == 0 ? 0 : -1);
|
|
}
|
|
|
|
static int
|
|
cy_units(cy_iobase, cy_align)
|
|
cy_addr cy_iobase;
|
|
int cy_align;
|
|
{
|
|
int cyu;
|
|
u_char firmware_version;
|
|
int i;
|
|
cy_addr iobase;
|
|
|
|
for (cyu = 0; cyu < CY_MAX_CD1400s; ++cyu) {
|
|
iobase = cy_iobase + (cy_chip_offset[cyu] << cy_align);
|
|
|
|
/* wait for chip to become ready for new command */
|
|
for (i = 0; i < 10; i++) {
|
|
DELAY(50);
|
|
if (!cd_inb(iobase, CD1400_CCR, cy_align))
|
|
break;
|
|
}
|
|
|
|
/* clear the GFRCR register */
|
|
cd_outb(iobase, CD1400_GFRCR, cy_align, 0);
|
|
|
|
/* issue a reset command */
|
|
cd_outb(iobase, CD1400_CCR, cy_align,
|
|
CD1400_CCR_CMDRESET | CD1400_CCR_FULLRESET);
|
|
|
|
/* XXX bogus initialization to avoid a gcc bug/warning. */
|
|
firmware_version = 0;
|
|
|
|
/* wait for the CD1400 to initialize itself */
|
|
for (i = 0; i < 200; i++) {
|
|
DELAY(50);
|
|
|
|
/* retrieve firmware version */
|
|
firmware_version = cd_inb(iobase, CD1400_GFRCR,
|
|
cy_align);
|
|
if ((firmware_version & 0xf0) == 0x40)
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* Anything in the 0x40-0x4F range is fine.
|
|
* If one CD1400 is bad then we don't support higher
|
|
* numbered good ones on this board.
|
|
*/
|
|
if ((firmware_version & 0xf0) != 0x40)
|
|
break;
|
|
}
|
|
return (cyu);
|
|
}
|
|
|
|
static int
|
|
sioattach(isdp)
|
|
struct isa_device *isdp;
|
|
{
|
|
int adapter;
|
|
|
|
adapter = cyattach_common((cy_addr) isdp->id_maddr, 0);
|
|
if (adapter < 0)
|
|
return (0);
|
|
|
|
/*
|
|
* XXX
|
|
* This kludge is to allow ISA/PCI device specifications in the
|
|
* kernel config file to be in any order.
|
|
*/
|
|
if (isdp->id_unit != adapter) {
|
|
printf("cy%d: attached as cy%d\n", isdp->id_unit, adapter);
|
|
isdp->id_unit = adapter; /* XXX */
|
|
}
|
|
isdp->id_ointr = siointr;
|
|
/* isdp->id_ri_flags |= RI_FAST; XXX unimplemented - use newbus! */
|
|
return (1);
|
|
}
|
|
|
|
int
|
|
cyattach_common(cy_iobase, cy_align)
|
|
cy_addr cy_iobase;
|
|
int cy_align;
|
|
{
|
|
int adapter;
|
|
int cyu;
|
|
u_char firmware_version;
|
|
cy_addr iobase;
|
|
int minorbase;
|
|
int ncyu;
|
|
int unit;
|
|
|
|
adapter = cy_total_devices;
|
|
if ((u_int)adapter >= NCY) {
|
|
printf(
|
|
"cy%d: can't attach adapter: insufficient cy devices configured\n",
|
|
adapter);
|
|
return (-1);
|
|
}
|
|
ncyu = cy_units(cy_iobase, cy_align);
|
|
if (ncyu == 0)
|
|
return (-1);
|
|
cy_nr_cd1400s[adapter] = ncyu;
|
|
cy_total_devices++;
|
|
|
|
unit = adapter * CY_MAX_PORTS;
|
|
for (cyu = 0; cyu < ncyu; ++cyu) {
|
|
int cdu;
|
|
|
|
iobase = (cy_addr) (cy_iobase
|
|
+ (cy_chip_offset[cyu] << cy_align));
|
|
firmware_version = cd_inb(iobase, CD1400_GFRCR, cy_align);
|
|
|
|
/* Set up a receive timeout period of than 1+ ms. */
|
|
cd_outb(iobase, CD1400_PPR, cy_align,
|
|
howmany(CY_CLOCK(firmware_version)
|
|
/ CD1400_PPR_PRESCALER, 1000));
|
|
|
|
for (cdu = 0; cdu < CD1400_NO_OF_CHANNELS; ++cdu, ++unit) {
|
|
struct com_s *com;
|
|
int s;
|
|
|
|
com = malloc(sizeof *com, M_DEVBUF, M_NOWAIT | M_ZERO);
|
|
if (com == NULL)
|
|
break;
|
|
com->unit = unit;
|
|
com->gfrcr_image = firmware_version;
|
|
if (CY_RTS_DTR_SWAPPED(firmware_version)) {
|
|
com->mcr_dtr = MCR_RTS;
|
|
com->mcr_rts = MCR_DTR;
|
|
com->mcr_rts_reg = CD1400_MSVR2;
|
|
} else {
|
|
com->mcr_dtr = MCR_DTR;
|
|
com->mcr_rts = MCR_RTS;
|
|
com->mcr_rts_reg = CD1400_MSVR1;
|
|
}
|
|
com->dtr_wait = 3 * hz;
|
|
com->obufs[0].l_head = com->obuf1;
|
|
com->obufs[1].l_head = com->obuf2;
|
|
|
|
com->cy_align = cy_align;
|
|
com->cy_iobase = cy_iobase;
|
|
com->iobase = iobase;
|
|
com->car = ~CD1400_CAR_CHAN;
|
|
|
|
/*
|
|
* We don't use all the flags from <sys/ttydefaults.h> since they
|
|
* are only relevant for logins. It's important to have echo off
|
|
* initially so that the line doesn't start blathering before the
|
|
* echo flag can be turned off.
|
|
*/
|
|
com->it_in.c_iflag = 0;
|
|
com->it_in.c_oflag = 0;
|
|
com->it_in.c_cflag = TTYDEF_CFLAG;
|
|
com->it_in.c_lflag = 0;
|
|
if (unit == comconsole) {
|
|
com->it_in.c_iflag = TTYDEF_IFLAG;
|
|
com->it_in.c_oflag = TTYDEF_OFLAG;
|
|
com->it_in.c_cflag = TTYDEF_CFLAG | CLOCAL;
|
|
com->it_in.c_lflag = TTYDEF_LFLAG;
|
|
com->lt_out.c_cflag = com->lt_in.c_cflag = CLOCAL;
|
|
}
|
|
if (siosetwater(com, com->it_in.c_ispeed) != 0) {
|
|
free(com, M_DEVBUF);
|
|
return (0);
|
|
}
|
|
termioschars(&com->it_in);
|
|
com->it_in.c_ispeed = com->it_in.c_ospeed = comdefaultrate;
|
|
com->it_out = com->it_in;
|
|
|
|
s = spltty();
|
|
com_addr(unit) = com;
|
|
splx(s);
|
|
|
|
if (sio_ih == NULL) {
|
|
swi_add(&tty_ithd, "tty:cy", siopoll, NULL, SWI_TTY, 0,
|
|
&sio_ih);
|
|
}
|
|
minorbase = UNIT_TO_MINOR(unit);
|
|
make_dev(&sio_cdevsw, minorbase,
|
|
UID_ROOT, GID_WHEEL, 0600, "ttyc%r%r", adapter,
|
|
unit % CY_MAX_PORTS);
|
|
make_dev(&sio_cdevsw, minorbase | CONTROL_INIT_STATE,
|
|
UID_ROOT, GID_WHEEL, 0600, "ttyic%r%r", adapter,
|
|
unit % CY_MAX_PORTS);
|
|
make_dev(&sio_cdevsw, minorbase | CONTROL_LOCK_STATE,
|
|
UID_ROOT, GID_WHEEL, 0600, "ttylc%r%r", adapter,
|
|
unit % CY_MAX_PORTS);
|
|
make_dev(&sio_cdevsw, minorbase | CALLOUT_MASK,
|
|
UID_UUCP, GID_DIALER, 0660, "cuac%r%r", adapter,
|
|
unit % CY_MAX_PORTS);
|
|
make_dev(&sio_cdevsw, minorbase | CALLOUT_MASK | CONTROL_INIT_STATE,
|
|
UID_UUCP, GID_DIALER, 0660, "cuaic%r%r", adapter,
|
|
unit % CY_MAX_PORTS);
|
|
make_dev(&sio_cdevsw, minorbase | CALLOUT_MASK | CONTROL_LOCK_STATE,
|
|
UID_UUCP, GID_DIALER, 0660, "cualc%r%r", adapter,
|
|
unit % CY_MAX_PORTS);
|
|
}
|
|
}
|
|
|
|
/* ensure an edge for the next interrupt */
|
|
cy_outb(cy_iobase, CY_CLEAR_INTR, cy_align, 0);
|
|
|
|
return (adapter);
|
|
}
|
|
|
|
static int
|
|
sioopen(dev, flag, mode, td)
|
|
dev_t dev;
|
|
int flag;
|
|
int mode;
|
|
struct thread *td;
|
|
{
|
|
struct com_s *com;
|
|
int error;
|
|
int mynor;
|
|
int s;
|
|
struct tty *tp;
|
|
int unit;
|
|
|
|
mynor = minor(dev);
|
|
unit = MINOR_TO_UNIT(mynor);
|
|
if ((u_int) unit >= NSIO || (com = com_addr(unit)) == NULL)
|
|
return (ENXIO);
|
|
if (mynor & CONTROL_MASK)
|
|
return (0);
|
|
tp = dev->si_tty = com->tp = ttymalloc(com->tp);
|
|
s = spltty();
|
|
/*
|
|
* We jump to this label after all non-interrupted sleeps to pick
|
|
* up any changes of the device state.
|
|
*/
|
|
open_top:
|
|
while (com->state & CS_DTR_OFF) {
|
|
error = tsleep(&com->dtr_wait, TTIPRI | PCATCH, "cydtr", 0);
|
|
if (error != 0)
|
|
goto out;
|
|
}
|
|
if (tp->t_state & TS_ISOPEN) {
|
|
/*
|
|
* The device is open, so everything has been initialized.
|
|
* Handle conflicts.
|
|
*/
|
|
if (mynor & CALLOUT_MASK) {
|
|
if (!com->active_out) {
|
|
error = EBUSY;
|
|
goto out;
|
|
}
|
|
} else {
|
|
if (com->active_out) {
|
|
if (flag & O_NONBLOCK) {
|
|
error = EBUSY;
|
|
goto out;
|
|
}
|
|
error = tsleep(&com->active_out,
|
|
TTIPRI | PCATCH, "cybi", 0);
|
|
if (error != 0)
|
|
goto out;
|
|
goto open_top;
|
|
}
|
|
}
|
|
if (tp->t_state & TS_XCLUDE &&
|
|
suser_td(td)) {
|
|
error = EBUSY;
|
|
goto out;
|
|
}
|
|
} else {
|
|
/*
|
|
* The device isn't open, so there are no conflicts.
|
|
* Initialize it. Initialization is done twice in many
|
|
* cases: to preempt sleeping callin opens if we are
|
|
* callout, and to complete a callin open after DCD rises.
|
|
*/
|
|
tp->t_oproc = comstart;
|
|
tp->t_stop = comstop;
|
|
tp->t_param = comparam;
|
|
tp->t_dev = dev;
|
|
tp->t_termios = mynor & CALLOUT_MASK
|
|
? com->it_out : com->it_in;
|
|
|
|
/* Encode per-board unit in LIVR for access in intr routines. */
|
|
cd_setreg(com, CD1400_LIVR,
|
|
(unit & CD1400_xIVR_CHAN) << CD1400_xIVR_CHAN_SHIFT);
|
|
|
|
(void)commctl(com, TIOCM_DTR | TIOCM_RTS, DMSET);
|
|
#if 0
|
|
com->poll = com->no_irq;
|
|
com->poll_output = com->loses_outints;
|
|
#endif
|
|
++com->wopeners;
|
|
error = comparam(tp, &tp->t_termios);
|
|
--com->wopeners;
|
|
if (error != 0)
|
|
goto out;
|
|
#if 0
|
|
if (com->hasfifo) {
|
|
/*
|
|
* (Re)enable and flush fifos.
|
|
*
|
|
* Certain SMC chips cause problems if the fifos
|
|
* are enabled while input is ready. Turn off the
|
|
* fifo if necessary to clear the input. We test
|
|
* the input ready bit after enabling the fifos
|
|
* since we've already enabled them in comparam()
|
|
* and to handle races between enabling and fresh
|
|
* input.
|
|
*/
|
|
while (TRUE) {
|
|
outb(iobase + com_fifo,
|
|
FIFO_RCV_RST | FIFO_XMT_RST
|
|
| com->fifo_image);
|
|
DELAY(100);
|
|
if (!(inb(com->line_status_port) & LSR_RXRDY))
|
|
break;
|
|
outb(iobase + com_fifo, 0);
|
|
DELAY(100);
|
|
(void) inb(com->data_port);
|
|
}
|
|
}
|
|
|
|
critical_enter();
|
|
COM_LOCK();
|
|
(void) inb(com->line_status_port);
|
|
(void) inb(com->data_port);
|
|
com->prev_modem_status = com->last_modem_status
|
|
= inb(com->modem_status_port);
|
|
outb(iobase + com_ier, IER_ERXRDY | IER_ETXRDY | IER_ERLS
|
|
| IER_EMSC);
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
#else /* !0 */
|
|
/*
|
|
* Flush fifos. This requires a full channel reset which
|
|
* also disables the transmitter and receiver. Recover
|
|
* from this.
|
|
*/
|
|
cd1400_channel_cmd(com,
|
|
CD1400_CCR_CMDRESET | CD1400_CCR_CHANRESET);
|
|
cd1400_channel_cmd(com, com->channel_control);
|
|
|
|
critical_enter();
|
|
COM_LOCK();
|
|
com->prev_modem_status = com->last_modem_status
|
|
= cd_getreg(com, CD1400_MSVR2);
|
|
cd_setreg(com, CD1400_SRER,
|
|
com->intr_enable
|
|
= CD1400_SRER_MDMCH | CD1400_SRER_RXDATA);
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
#endif /* 0 */
|
|
/*
|
|
* Handle initial DCD. Callout devices get a fake initial
|
|
* DCD (trapdoor DCD). If we are callout, then any sleeping
|
|
* callin opens get woken up and resume sleeping on "cybi"
|
|
* instead of "cydcd".
|
|
*/
|
|
/*
|
|
* XXX `mynor & CALLOUT_MASK' should be
|
|
* `tp->t_cflag & (SOFT_CARRIER | TRAPDOOR_CARRIER) where
|
|
* TRAPDOOR_CARRIER is the default initial state for callout
|
|
* devices and SOFT_CARRIER is like CLOCAL except it hides
|
|
* the true carrier.
|
|
*/
|
|
if (com->prev_modem_status & MSR_DCD || mynor & CALLOUT_MASK)
|
|
(*linesw[tp->t_line].l_modem)(tp, 1);
|
|
}
|
|
/*
|
|
* Wait for DCD if necessary.
|
|
*/
|
|
if (!(tp->t_state & TS_CARR_ON) && !(mynor & CALLOUT_MASK)
|
|
&& !(tp->t_cflag & CLOCAL) && !(flag & O_NONBLOCK)) {
|
|
++com->wopeners;
|
|
error = tsleep(TSA_CARR_ON(tp), TTIPRI | PCATCH, "cydcd", 0);
|
|
--com->wopeners;
|
|
if (error != 0)
|
|
goto out;
|
|
goto open_top;
|
|
}
|
|
error = (*linesw[tp->t_line].l_open)(dev, tp);
|
|
disc_optim(tp, &tp->t_termios, com);
|
|
if (tp->t_state & TS_ISOPEN && mynor & CALLOUT_MASK)
|
|
com->active_out = TRUE;
|
|
siosettimeout();
|
|
out:
|
|
splx(s);
|
|
if (!(tp->t_state & TS_ISOPEN) && com->wopeners == 0)
|
|
comhardclose(com);
|
|
return (error);
|
|
}
|
|
|
|
static int
|
|
sioclose(dev, flag, mode, td)
|
|
dev_t dev;
|
|
int flag;
|
|
int mode;
|
|
struct thread *td;
|
|
{
|
|
struct com_s *com;
|
|
int mynor;
|
|
int s;
|
|
struct tty *tp;
|
|
|
|
mynor = minor(dev);
|
|
if (mynor & CONTROL_MASK)
|
|
return (0);
|
|
com = com_addr(MINOR_TO_UNIT(mynor));
|
|
tp = com->tp;
|
|
s = spltty();
|
|
cd_etc(com, CD1400_ETC_STOPBREAK);
|
|
(*linesw[tp->t_line].l_close)(tp, flag);
|
|
disc_optim(tp, &tp->t_termios, com);
|
|
comstop(tp, FREAD | FWRITE);
|
|
comhardclose(com);
|
|
ttyclose(tp);
|
|
siosettimeout();
|
|
splx(s);
|
|
#ifdef broken /* session holds a ref to the tty; can't deallocate */
|
|
ttyfree(tp);
|
|
com->tp = NULL;
|
|
#endif
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
comhardclose(com)
|
|
struct com_s *com;
|
|
{
|
|
cy_addr iobase;
|
|
int s;
|
|
struct tty *tp;
|
|
int unit;
|
|
|
|
unit = com->unit;
|
|
iobase = com->iobase;
|
|
s = spltty();
|
|
#if 0
|
|
com->poll = FALSE;
|
|
com->poll_output = FALSE;
|
|
#endif
|
|
com->do_timestamp = 0;
|
|
#if 0
|
|
outb(iobase + com_cfcr, com->cfcr_image &= ~CFCR_SBREAK);
|
|
#else
|
|
/* XXX */
|
|
critical_enter();
|
|
COM_LOCK();
|
|
com->etc = ETC_NONE;
|
|
cd_setreg(com, CD1400_COR2, com->cor[1] &= ~CD1400_COR2_ETC);
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
cd1400_channel_cmd(com, CD1400_CCR_CMDRESET | CD1400_CCR_FTF);
|
|
#endif
|
|
|
|
{
|
|
#if 0
|
|
outb(iobase + com_ier, 0);
|
|
#else
|
|
critical_enter();
|
|
COM_LOCK();
|
|
cd_setreg(com, CD1400_SRER, com->intr_enable = 0);
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
#endif
|
|
tp = com->tp;
|
|
if ((tp->t_cflag & HUPCL)
|
|
/*
|
|
* XXX we will miss any carrier drop between here and the
|
|
* next open. Perhaps we should watch DCD even when the
|
|
* port is closed; it is not sufficient to check it at
|
|
* the next open because it might go up and down while
|
|
* we're not watching.
|
|
*/
|
|
|| (!com->active_out
|
|
&& !(com->prev_modem_status & MSR_DCD)
|
|
&& !(com->it_in.c_cflag & CLOCAL))
|
|
|| !(tp->t_state & TS_ISOPEN)) {
|
|
(void)commctl(com, TIOCM_DTR, DMBIC);
|
|
|
|
/* Disable receiver (leave transmitter enabled). */
|
|
com->channel_control = CD1400_CCR_CMDCHANCTL
|
|
| CD1400_CCR_XMTEN
|
|
| CD1400_CCR_RCVDIS;
|
|
cd1400_channel_cmd(com, com->channel_control);
|
|
|
|
if (com->dtr_wait != 0 && !(com->state & CS_DTR_OFF)) {
|
|
timeout(siodtrwakeup, com, com->dtr_wait);
|
|
com->state |= CS_DTR_OFF;
|
|
}
|
|
}
|
|
}
|
|
#if 0
|
|
if (com->hasfifo) {
|
|
/*
|
|
* Disable fifos so that they are off after controlled
|
|
* reboots. Some BIOSes fail to detect 16550s when the
|
|
* fifos are enabled.
|
|
*/
|
|
outb(iobase + com_fifo, 0);
|
|
}
|
|
#endif
|
|
com->active_out = FALSE;
|
|
wakeup(&com->active_out);
|
|
wakeup(TSA_CARR_ON(tp)); /* restart any wopeners */
|
|
splx(s);
|
|
}
|
|
|
|
static int
|
|
siowrite(dev, uio, flag)
|
|
dev_t dev;
|
|
struct uio *uio;
|
|
int flag;
|
|
{
|
|
int mynor;
|
|
struct tty *tp;
|
|
int unit;
|
|
|
|
mynor = minor(dev);
|
|
if (mynor & CONTROL_MASK)
|
|
return (ENODEV);
|
|
|
|
unit = MINOR_TO_UNIT(mynor);
|
|
tp = com_addr(unit)->tp;
|
|
/*
|
|
* (XXX) We disallow virtual consoles if the physical console is
|
|
* a serial port. This is in case there is a display attached that
|
|
* is not the console. In that situation we don't need/want the X
|
|
* server taking over the console.
|
|
*/
|
|
if (constty != NULL && unit == comconsole)
|
|
constty = NULL;
|
|
#ifdef Smarts
|
|
/* XXX duplicate ttwrite(), but without so much output processing on
|
|
* CR & LF chars. Hardly worth the effort, given that high-throughput
|
|
* sessions are raw anyhow.
|
|
*/
|
|
#else
|
|
return ((*linesw[tp->t_line].l_write)(tp, uio, flag));
|
|
#endif
|
|
}
|
|
|
|
static void
|
|
siodtrwakeup(chan)
|
|
void *chan;
|
|
{
|
|
struct com_s *com;
|
|
|
|
com = (struct com_s *)chan;
|
|
com->state &= ~CS_DTR_OFF;
|
|
wakeup(&com->dtr_wait);
|
|
}
|
|
|
|
/*
|
|
* This function:
|
|
* a) needs to be called with COM_LOCK() held, and
|
|
* b) needs to return with COM_LOCK() held.
|
|
*/
|
|
static void
|
|
sioinput(com)
|
|
struct com_s *com;
|
|
{
|
|
u_char *buf;
|
|
int incc;
|
|
u_char line_status;
|
|
int recv_data;
|
|
struct tty *tp;
|
|
|
|
buf = com->ibuf;
|
|
tp = com->tp;
|
|
if (!(tp->t_state & TS_ISOPEN)) {
|
|
com_events -= (com->iptr - com->ibuf);
|
|
com->iptr = com->ibuf;
|
|
return;
|
|
}
|
|
if (tp->t_state & TS_CAN_BYPASS_L_RINT) {
|
|
/*
|
|
* Avoid the grotesquely inefficient lineswitch routine
|
|
* (ttyinput) in "raw" mode. It usually takes about 450
|
|
* instructions (that's without canonical processing or echo!).
|
|
* slinput is reasonably fast (usually 40 instructions plus
|
|
* call overhead).
|
|
*/
|
|
|
|
do {
|
|
/*
|
|
* This may look odd, but it is using save-and-enable
|
|
* semantics instead of the save-and-disable semantics
|
|
* that are used everywhere else.
|
|
*/
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
incc = com->iptr - buf;
|
|
if (tp->t_rawq.c_cc + incc > tp->t_ihiwat
|
|
&& (com->state & CS_RTS_IFLOW
|
|
|| tp->t_iflag & IXOFF)
|
|
&& !(tp->t_state & TS_TBLOCK))
|
|
ttyblock(tp);
|
|
com->delta_error_counts[CE_TTY_BUF_OVERFLOW]
|
|
+= b_to_q((char *)buf, incc, &tp->t_rawq);
|
|
buf += incc;
|
|
tk_nin += incc;
|
|
tk_rawcc += incc;
|
|
tp->t_rawcc += incc;
|
|
ttwakeup(tp);
|
|
if (tp->t_state & TS_TTSTOP
|
|
&& (tp->t_iflag & IXANY
|
|
|| tp->t_cc[VSTART] == tp->t_cc[VSTOP])) {
|
|
tp->t_state &= ~TS_TTSTOP;
|
|
tp->t_lflag &= ~FLUSHO;
|
|
comstart(tp);
|
|
}
|
|
critical_enter();
|
|
COM_LOCK();
|
|
} while (buf < com->iptr);
|
|
} else {
|
|
do {
|
|
/*
|
|
* This may look odd, but it is using save-and-enable
|
|
* semantics instead of the save-and-disable semantics
|
|
* that are used everywhere else.
|
|
*/
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
line_status = buf[com->ierroff];
|
|
recv_data = *buf++;
|
|
if (line_status
|
|
& (LSR_BI | LSR_FE | LSR_OE | LSR_PE)) {
|
|
if (line_status & LSR_BI)
|
|
recv_data |= TTY_BI;
|
|
if (line_status & LSR_FE)
|
|
recv_data |= TTY_FE;
|
|
if (line_status & LSR_OE)
|
|
recv_data |= TTY_OE;
|
|
if (line_status & LSR_PE)
|
|
recv_data |= TTY_PE;
|
|
}
|
|
(*linesw[tp->t_line].l_rint)(recv_data, tp);
|
|
critical_enter();
|
|
COM_LOCK();
|
|
} while (buf < com->iptr);
|
|
}
|
|
com_events -= (com->iptr - com->ibuf);
|
|
com->iptr = com->ibuf;
|
|
|
|
/*
|
|
* There is now room for another low-level buffer full of input,
|
|
* so enable RTS if it is now disabled and there is room in the
|
|
* high-level buffer.
|
|
*/
|
|
if ((com->state & CS_RTS_IFLOW) && !(com->mcr_image & com->mcr_rts) &&
|
|
!(tp->t_state & TS_TBLOCK))
|
|
#if 0
|
|
outb(com->modem_ctl_port, com->mcr_image |= MCR_RTS);
|
|
#else
|
|
cd_setreg(com, com->mcr_rts_reg,
|
|
com->mcr_image |= com->mcr_rts);
|
|
#endif
|
|
}
|
|
|
|
void
|
|
siointr(unit)
|
|
int unit;
|
|
{
|
|
int baseu;
|
|
int cy_align;
|
|
cy_addr cy_iobase;
|
|
int cyu;
|
|
cy_addr iobase;
|
|
u_char status;
|
|
|
|
COM_LOCK(); /* XXX could this be placed down lower in the loop? */
|
|
|
|
baseu = unit * CY_MAX_PORTS;
|
|
cy_align = com_addr(baseu)->cy_align;
|
|
cy_iobase = com_addr(baseu)->cy_iobase;
|
|
|
|
/* check each CD1400 in turn */
|
|
for (cyu = 0; cyu < cy_nr_cd1400s[unit]; ++cyu) {
|
|
iobase = (cy_addr) (cy_iobase
|
|
+ (cy_chip_offset[cyu] << cy_align));
|
|
/* poll to see if it has any work */
|
|
status = cd_inb(iobase, CD1400_SVRR, cy_align);
|
|
if (status == 0)
|
|
continue;
|
|
#ifdef CyDebug
|
|
++cy_svrr_probes;
|
|
#endif
|
|
/* service requests as appropriate, giving priority to RX */
|
|
if (status & CD1400_SVRR_RXRDY) {
|
|
struct com_s *com;
|
|
u_int count;
|
|
u_char *ioptr;
|
|
u_char line_status;
|
|
u_char recv_data;
|
|
u_char serv_type;
|
|
#ifdef PollMode
|
|
u_char save_rir;
|
|
#endif
|
|
|
|
#ifdef PollMode
|
|
save_rir = cd_inb(iobase, CD1400_RIR, cy_align);
|
|
|
|
/* enter rx service */
|
|
cd_outb(iobase, CD1400_CAR, cy_align, save_rir);
|
|
com_addr(baseu + cyu * CD1400_NO_OF_CHANNELS)->car
|
|
= save_rir & CD1400_CAR_CHAN;
|
|
|
|
serv_type = cd_inb(iobase, CD1400_RIVR, cy_align);
|
|
com = com_addr(baseu
|
|
+ ((serv_type >> CD1400_xIVR_CHAN_SHIFT)
|
|
& CD1400_xIVR_CHAN));
|
|
#else
|
|
/* ack receive service */
|
|
serv_type = cy_inb(iobase, CY8_SVCACKR, cy_align);
|
|
|
|
com = com_addr(baseu +
|
|
+ ((serv_type >> CD1400_xIVR_CHAN_SHIFT)
|
|
& CD1400_xIVR_CHAN));
|
|
#endif
|
|
|
|
if (serv_type & CD1400_RIVR_EXCEPTION) {
|
|
++com->recv_exception;
|
|
line_status = cd_inb(iobase, CD1400_RDSR, cy_align);
|
|
/* break/unnattached error bits or real input? */
|
|
recv_data = cd_inb(iobase, CD1400_RDSR, cy_align);
|
|
#ifndef SOFT_HOTCHAR
|
|
if (line_status & CD1400_RDSR_SPECIAL
|
|
&& com->hotchar != 0)
|
|
swi_sched(sio_ih, 0);
|
|
|
|
#endif
|
|
#if 1 /* XXX "intelligent" PFO error handling would break O error handling */
|
|
if (line_status & (LSR_PE|LSR_FE|LSR_BI)) {
|
|
/*
|
|
Don't store PE if IGNPAR and BI if IGNBRK,
|
|
this hack allows "raw" tty optimization
|
|
works even if IGN* is set.
|
|
*/
|
|
if ( com->tp == NULL
|
|
|| !(com->tp->t_state & TS_ISOPEN)
|
|
|| ((line_status & (LSR_PE|LSR_FE))
|
|
&& (com->tp->t_iflag & IGNPAR))
|
|
|| ((line_status & LSR_BI)
|
|
&& (com->tp->t_iflag & IGNBRK)))
|
|
goto cont;
|
|
if ( (line_status & (LSR_PE|LSR_FE))
|
|
&& (com->tp->t_state & TS_CAN_BYPASS_L_RINT)
|
|
&& ((line_status & LSR_FE)
|
|
|| ((line_status & LSR_PE)
|
|
&& (com->tp->t_iflag & INPCK))))
|
|
recv_data = 0;
|
|
}
|
|
#endif /* 1 */
|
|
++com->bytes_in;
|
|
#ifdef SOFT_HOTCHAR
|
|
if (com->hotchar != 0 && recv_data == com->hotchar)
|
|
swi_sched(sio_ih, 0);
|
|
#endif
|
|
ioptr = com->iptr;
|
|
if (ioptr >= com->ibufend)
|
|
CE_RECORD(com, CE_INTERRUPT_BUF_OVERFLOW);
|
|
else {
|
|
if (com->do_timestamp)
|
|
microtime(&com->timestamp);
|
|
++com_events;
|
|
ioptr[0] = recv_data;
|
|
ioptr[com->ierroff] = line_status;
|
|
com->iptr = ++ioptr;
|
|
if (ioptr == com->ihighwater
|
|
&& com->state & CS_RTS_IFLOW)
|
|
#if 0
|
|
outb(com->modem_ctl_port,
|
|
com->mcr_image &= ~MCR_RTS);
|
|
#else
|
|
cd_outb(iobase, com->mcr_rts_reg,
|
|
cy_align,
|
|
com->mcr_image &=
|
|
~com->mcr_rts);
|
|
#endif
|
|
if (line_status & LSR_OE)
|
|
CE_RECORD(com, CE_OVERRUN);
|
|
}
|
|
goto cont;
|
|
} else {
|
|
int ifree;
|
|
|
|
count = cd_inb(iobase, CD1400_RDCR, cy_align);
|
|
if (!count)
|
|
goto cont;
|
|
com->bytes_in += count;
|
|
ioptr = com->iptr;
|
|
ifree = com->ibufend - ioptr;
|
|
if (count > ifree) {
|
|
count -= ifree;
|
|
com_events += ifree;
|
|
if (ifree != 0) {
|
|
if (com->do_timestamp)
|
|
microtime(&com->timestamp);
|
|
do {
|
|
recv_data = cd_inb(iobase,
|
|
CD1400_RDSR,
|
|
cy_align);
|
|
#ifdef SOFT_HOTCHAR
|
|
if (com->hotchar != 0
|
|
&& recv_data
|
|
== com->hotchar)
|
|
swi_sched(sio_ih, 0);
|
|
#endif
|
|
ioptr[0] = recv_data;
|
|
ioptr[com->ierroff] = 0;
|
|
++ioptr;
|
|
} while (--ifree != 0);
|
|
}
|
|
com->delta_error_counts
|
|
[CE_INTERRUPT_BUF_OVERFLOW] += count;
|
|
do {
|
|
recv_data = cd_inb(iobase, CD1400_RDSR,
|
|
cy_align);
|
|
#ifdef SOFT_HOTCHAR
|
|
if (com->hotchar != 0
|
|
&& recv_data == com->hotchar)
|
|
swi_sched(sio_ih, 0);
|
|
#endif
|
|
} while (--count != 0);
|
|
} else {
|
|
if (com->do_timestamp)
|
|
microtime(&com->timestamp);
|
|
if (ioptr <= com->ihighwater
|
|
&& ioptr + count > com->ihighwater
|
|
&& com->state & CS_RTS_IFLOW)
|
|
#if 0
|
|
outb(com->modem_ctl_port,
|
|
com->mcr_image &= ~MCR_RTS);
|
|
#else
|
|
cd_outb(iobase, com->mcr_rts_reg,
|
|
cy_align,
|
|
com->mcr_image
|
|
&= ~com->mcr_rts);
|
|
#endif
|
|
com_events += count;
|
|
do {
|
|
recv_data = cd_inb(iobase, CD1400_RDSR,
|
|
cy_align);
|
|
#ifdef SOFT_HOTCHAR
|
|
if (com->hotchar != 0
|
|
&& recv_data == com->hotchar)
|
|
swi_sched(sio_ih, 0);
|
|
#endif
|
|
ioptr[0] = recv_data;
|
|
ioptr[com->ierroff] = 0;
|
|
++ioptr;
|
|
} while (--count != 0);
|
|
}
|
|
com->iptr = ioptr;
|
|
}
|
|
cont:
|
|
|
|
/* terminate service context */
|
|
#ifdef PollMode
|
|
cd_outb(iobase, CD1400_RIR, cy_align,
|
|
save_rir
|
|
& ~(CD1400_RIR_RDIREQ | CD1400_RIR_RBUSY));
|
|
#else
|
|
cd_outb(iobase, CD1400_EOSRR, cy_align, 0);
|
|
#endif
|
|
}
|
|
if (status & CD1400_SVRR_MDMCH) {
|
|
struct com_s *com;
|
|
u_char modem_status;
|
|
#ifdef PollMode
|
|
u_char save_mir;
|
|
#else
|
|
u_char vector;
|
|
#endif
|
|
|
|
#ifdef PollMode
|
|
save_mir = cd_inb(iobase, CD1400_MIR, cy_align);
|
|
|
|
/* enter modem service */
|
|
cd_outb(iobase, CD1400_CAR, cy_align, save_mir);
|
|
com_addr(baseu + cyu * CD1400_NO_OF_CHANNELS)->car
|
|
= save_mir & CD1400_CAR_CHAN;
|
|
|
|
com = com_addr(baseu + cyu * CD1400_NO_OF_CHANNELS
|
|
+ (save_mir & CD1400_MIR_CHAN));
|
|
#else
|
|
/* ack modem service */
|
|
vector = cy_inb(iobase, CY8_SVCACKM, cy_align);
|
|
|
|
com = com_addr(baseu
|
|
+ ((vector >> CD1400_xIVR_CHAN_SHIFT)
|
|
& CD1400_xIVR_CHAN));
|
|
#endif
|
|
++com->mdm;
|
|
modem_status = cd_inb(iobase, CD1400_MSVR2, cy_align);
|
|
if (modem_status != com->last_modem_status) {
|
|
if (com->do_dcd_timestamp
|
|
&& !(com->last_modem_status & MSR_DCD)
|
|
&& modem_status & MSR_DCD)
|
|
microtime(&com->dcd_timestamp);
|
|
|
|
/*
|
|
* Schedule high level to handle DCD changes. Note
|
|
* that we don't use the delta bits anywhere. Some
|
|
* UARTs mess them up, and it's easy to remember the
|
|
* previous bits and calculate the delta.
|
|
*/
|
|
com->last_modem_status = modem_status;
|
|
if (!(com->state & CS_CHECKMSR)) {
|
|
com_events += LOTS_OF_EVENTS;
|
|
com->state |= CS_CHECKMSR;
|
|
swi_sched(sio_ih, 0);
|
|
}
|
|
|
|
#ifdef SOFT_CTS_OFLOW
|
|
/* handle CTS change immediately for crisp flow ctl */
|
|
if (com->state & CS_CTS_OFLOW) {
|
|
if (modem_status & MSR_CTS) {
|
|
com->state |= CS_ODEVREADY;
|
|
if (com->state >= (CS_BUSY | CS_TTGO
|
|
| CS_ODEVREADY)
|
|
&& !(com->intr_enable
|
|
& CD1400_SRER_TXRDY))
|
|
cd_outb(iobase, CD1400_SRER,
|
|
cy_align,
|
|
com->intr_enable
|
|
= com->intr_enable
|
|
& ~CD1400_SRER_TXMPTY
|
|
| CD1400_SRER_TXRDY);
|
|
} else {
|
|
com->state &= ~CS_ODEVREADY;
|
|
if (com->intr_enable
|
|
& CD1400_SRER_TXRDY)
|
|
cd_outb(iobase, CD1400_SRER,
|
|
cy_align,
|
|
com->intr_enable
|
|
= com->intr_enable
|
|
& ~CD1400_SRER_TXRDY
|
|
| CD1400_SRER_TXMPTY);
|
|
}
|
|
}
|
|
#endif
|
|
}
|
|
|
|
/* terminate service context */
|
|
#ifdef PollMode
|
|
cd_outb(iobase, CD1400_MIR, cy_align,
|
|
save_mir
|
|
& ~(CD1400_MIR_RDIREQ | CD1400_MIR_RBUSY));
|
|
#else
|
|
cd_outb(iobase, CD1400_EOSRR, cy_align, 0);
|
|
#endif
|
|
}
|
|
if (status & CD1400_SVRR_TXRDY) {
|
|
struct com_s *com;
|
|
#ifdef PollMode
|
|
u_char save_tir;
|
|
#else
|
|
u_char vector;
|
|
#endif
|
|
|
|
#ifdef PollMode
|
|
save_tir = cd_inb(iobase, CD1400_TIR, cy_align);
|
|
|
|
/* enter tx service */
|
|
cd_outb(iobase, CD1400_CAR, cy_align, save_tir);
|
|
com_addr(baseu + cyu * CD1400_NO_OF_CHANNELS)->car
|
|
= save_tir & CD1400_CAR_CHAN;
|
|
|
|
com = com_addr(baseu
|
|
+ cyu * CD1400_NO_OF_CHANNELS
|
|
+ (save_tir & CD1400_TIR_CHAN));
|
|
#else
|
|
/* ack transmit service */
|
|
vector = cy_inb(iobase, CY8_SVCACKT, cy_align);
|
|
|
|
com = com_addr(baseu
|
|
+ ((vector >> CD1400_xIVR_CHAN_SHIFT)
|
|
& CD1400_xIVR_CHAN));
|
|
#endif
|
|
|
|
if (com->etc != ETC_NONE) {
|
|
if (com->intr_enable & CD1400_SRER_TXRDY) {
|
|
/*
|
|
* Here due to sloppy SRER_TXRDY
|
|
* enabling. Ignore. Come back when
|
|
* tx is empty.
|
|
*/
|
|
cd_outb(iobase, CD1400_SRER, cy_align,
|
|
com->intr_enable
|
|
= (com->intr_enable
|
|
& ~CD1400_SRER_TXRDY)
|
|
| CD1400_SRER_TXMPTY);
|
|
goto terminate_tx_service;
|
|
}
|
|
switch (com->etc) {
|
|
case CD1400_ETC_SENDBREAK:
|
|
case CD1400_ETC_STOPBREAK:
|
|
/*
|
|
* Start the command. Come back on
|
|
* next tx empty interrupt, hopefully
|
|
* after command has been executed.
|
|
*/
|
|
cd_outb(iobase, CD1400_COR2, cy_align,
|
|
com->cor[1] |= CD1400_COR2_ETC);
|
|
cd_outb(iobase, CD1400_TDR, cy_align,
|
|
CD1400_ETC_CMD);
|
|
cd_outb(iobase, CD1400_TDR, cy_align,
|
|
com->etc);
|
|
if (com->etc == CD1400_ETC_SENDBREAK)
|
|
com->etc = ETC_BREAK_STARTING;
|
|
else
|
|
com->etc = ETC_BREAK_ENDING;
|
|
goto terminate_tx_service;
|
|
case ETC_BREAK_STARTING:
|
|
/*
|
|
* BREAK is now on. Continue with
|
|
* SRER_TXMPTY processing, hopefully
|
|
* don't come back.
|
|
*/
|
|
com->etc = ETC_BREAK_STARTED;
|
|
break;
|
|
case ETC_BREAK_STARTED:
|
|
/*
|
|
* Came back due to sloppy SRER_TXMPTY
|
|
* enabling. Hope again.
|
|
*/
|
|
break;
|
|
case ETC_BREAK_ENDING:
|
|
/*
|
|
* BREAK is now off. Continue with
|
|
* SRER_TXMPTY processing and don't
|
|
* come back. The SWI handler will
|
|
* restart tx interrupts if necessary.
|
|
*/
|
|
cd_outb(iobase, CD1400_COR2, cy_align,
|
|
com->cor[1]
|
|
&= ~CD1400_COR2_ETC);
|
|
com->etc = ETC_BREAK_ENDED;
|
|
if (!(com->state & CS_ODONE)) {
|
|
com_events += LOTS_OF_EVENTS;
|
|
com->state |= CS_ODONE;
|
|
swi_sched(sio_ih, 0);
|
|
}
|
|
break;
|
|
case ETC_BREAK_ENDED:
|
|
/*
|
|
* Shouldn't get here. Hope again.
|
|
*/
|
|
break;
|
|
}
|
|
}
|
|
if (com->intr_enable & CD1400_SRER_TXMPTY) {
|
|
if (!(com->extra_state & CSE_ODONE)) {
|
|
com_events += LOTS_OF_EVENTS;
|
|
com->extra_state |= CSE_ODONE;
|
|
swi_sched(sio_ih, 0);
|
|
}
|
|
cd_outb(iobase, CD1400_SRER, cy_align,
|
|
com->intr_enable
|
|
&= ~CD1400_SRER_TXMPTY);
|
|
goto terminate_tx_service;
|
|
}
|
|
if (com->state >= (CS_BUSY | CS_TTGO | CS_ODEVREADY)) {
|
|
u_char *ioptr;
|
|
u_int ocount;
|
|
|
|
ioptr = com->obufq.l_head;
|
|
ocount = com->obufq.l_tail - ioptr;
|
|
if (ocount > CD1400_TX_FIFO_SIZE)
|
|
ocount = CD1400_TX_FIFO_SIZE;
|
|
com->bytes_out += ocount;
|
|
do
|
|
cd_outb(iobase, CD1400_TDR, cy_align,
|
|
*ioptr++);
|
|
while (--ocount != 0);
|
|
com->obufq.l_head = ioptr;
|
|
if (ioptr >= com->obufq.l_tail) {
|
|
struct lbq *qp;
|
|
|
|
qp = com->obufq.l_next;
|
|
qp->l_queued = FALSE;
|
|
qp = qp->l_next;
|
|
if (qp != NULL) {
|
|
com->obufq.l_head = qp->l_head;
|
|
com->obufq.l_tail = qp->l_tail;
|
|
com->obufq.l_next = qp;
|
|
} else {
|
|
/* output just completed */
|
|
com->state &= ~CS_BUSY;
|
|
|
|
/*
|
|
* The setting of CSE_ODONE may be
|
|
* stale here. We currently only
|
|
* use it when CS_BUSY is set, and
|
|
* fixing it when we clear CS_BUSY
|
|
* is easiest.
|
|
*/
|
|
if (com->extra_state & CSE_ODONE) {
|
|
com_events -= LOTS_OF_EVENTS;
|
|
com->extra_state &= ~CSE_ODONE;
|
|
}
|
|
|
|
cd_outb(iobase, CD1400_SRER, cy_align,
|
|
com->intr_enable
|
|
= (com->intr_enable
|
|
& ~CD1400_SRER_TXRDY)
|
|
| CD1400_SRER_TXMPTY);
|
|
}
|
|
if (!(com->state & CS_ODONE)) {
|
|
com_events += LOTS_OF_EVENTS;
|
|
com->state |= CS_ODONE;
|
|
|
|
/* handle at high level ASAP */
|
|
swi_sched(sio_ih, 0);
|
|
}
|
|
}
|
|
}
|
|
|
|
/* terminate service context */
|
|
terminate_tx_service:
|
|
#ifdef PollMode
|
|
cd_outb(iobase, CD1400_TIR, cy_align,
|
|
save_tir
|
|
& ~(CD1400_TIR_RDIREQ | CD1400_TIR_RBUSY));
|
|
#else
|
|
cd_outb(iobase, CD1400_EOSRR, cy_align, 0);
|
|
#endif
|
|
}
|
|
}
|
|
|
|
/* ensure an edge for the next interrupt */
|
|
cy_outb(cy_iobase, CY_CLEAR_INTR, cy_align, 0);
|
|
|
|
swi_sched(sio_ih, 0);
|
|
|
|
COM_UNLOCK();
|
|
}
|
|
|
|
#if 0
|
|
static void
|
|
siointr1(com)
|
|
struct com_s *com;
|
|
{
|
|
}
|
|
#endif
|
|
|
|
static int
|
|
sioioctl(dev, cmd, data, flag, td)
|
|
dev_t dev;
|
|
u_long cmd;
|
|
caddr_t data;
|
|
int flag;
|
|
struct thread *td;
|
|
{
|
|
struct com_s *com;
|
|
int error;
|
|
int mynor;
|
|
int s;
|
|
struct tty *tp;
|
|
#if defined(COMPAT_43) || defined(COMPAT_SUNOS)
|
|
int oldcmd;
|
|
struct termios term;
|
|
#endif
|
|
|
|
mynor = minor(dev);
|
|
com = com_addr(MINOR_TO_UNIT(mynor));
|
|
if (mynor & CONTROL_MASK) {
|
|
struct termios *ct;
|
|
|
|
switch (mynor & CONTROL_MASK) {
|
|
case CONTROL_INIT_STATE:
|
|
ct = mynor & CALLOUT_MASK ? &com->it_out : &com->it_in;
|
|
break;
|
|
case CONTROL_LOCK_STATE:
|
|
ct = mynor & CALLOUT_MASK ? &com->lt_out : &com->lt_in;
|
|
break;
|
|
default:
|
|
return (ENODEV); /* /dev/nodev */
|
|
}
|
|
switch (cmd) {
|
|
case TIOCSETA:
|
|
error = suser_td(td);
|
|
if (error != 0)
|
|
return (error);
|
|
*ct = *(struct termios *)data;
|
|
return (0);
|
|
case TIOCGETA:
|
|
*(struct termios *)data = *ct;
|
|
return (0);
|
|
case TIOCGETD:
|
|
*(int *)data = TTYDISC;
|
|
return (0);
|
|
case TIOCGWINSZ:
|
|
bzero(data, sizeof(struct winsize));
|
|
return (0);
|
|
default:
|
|
return (ENOTTY);
|
|
}
|
|
}
|
|
tp = com->tp;
|
|
#if defined(COMPAT_43) || defined(COMPAT_SUNOS)
|
|
term = tp->t_termios;
|
|
oldcmd = cmd;
|
|
error = ttsetcompat(tp, &cmd, data, &term);
|
|
if (error != 0)
|
|
return (error);
|
|
if (cmd != oldcmd)
|
|
data = (caddr_t)&term;
|
|
#endif
|
|
if (cmd == TIOCSETA || cmd == TIOCSETAW || cmd == TIOCSETAF) {
|
|
int cc;
|
|
struct termios *dt = (struct termios *)data;
|
|
struct termios *lt = mynor & CALLOUT_MASK
|
|
? &com->lt_out : &com->lt_in;
|
|
|
|
dt->c_iflag = (tp->t_iflag & lt->c_iflag)
|
|
| (dt->c_iflag & ~lt->c_iflag);
|
|
dt->c_oflag = (tp->t_oflag & lt->c_oflag)
|
|
| (dt->c_oflag & ~lt->c_oflag);
|
|
dt->c_cflag = (tp->t_cflag & lt->c_cflag)
|
|
| (dt->c_cflag & ~lt->c_cflag);
|
|
dt->c_lflag = (tp->t_lflag & lt->c_lflag)
|
|
| (dt->c_lflag & ~lt->c_lflag);
|
|
for (cc = 0; cc < NCCS; ++cc)
|
|
if (lt->c_cc[cc] != 0)
|
|
dt->c_cc[cc] = tp->t_cc[cc];
|
|
if (lt->c_ispeed != 0)
|
|
dt->c_ispeed = tp->t_ispeed;
|
|
if (lt->c_ospeed != 0)
|
|
dt->c_ospeed = tp->t_ospeed;
|
|
}
|
|
error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, td);
|
|
if (error != ENOIOCTL)
|
|
return (error);
|
|
s = spltty();
|
|
error = ttioctl(tp, cmd, data, flag);
|
|
disc_optim(tp, &tp->t_termios, com);
|
|
if (error != ENOIOCTL) {
|
|
splx(s);
|
|
return (error);
|
|
}
|
|
switch (cmd) {
|
|
case TIOCSBRK:
|
|
#if 0
|
|
outb(iobase + com_cfcr, com->cfcr_image |= CFCR_SBREAK);
|
|
#else
|
|
cd_etc(com, CD1400_ETC_SENDBREAK);
|
|
#endif
|
|
break;
|
|
case TIOCCBRK:
|
|
#if 0
|
|
outb(iobase + com_cfcr, com->cfcr_image &= ~CFCR_SBREAK);
|
|
#else
|
|
cd_etc(com, CD1400_ETC_STOPBREAK);
|
|
#endif
|
|
break;
|
|
case TIOCSDTR:
|
|
(void)commctl(com, TIOCM_DTR, DMBIS);
|
|
break;
|
|
case TIOCCDTR:
|
|
(void)commctl(com, TIOCM_DTR, DMBIC);
|
|
break;
|
|
/*
|
|
* XXX should disallow changing MCR_RTS if CS_RTS_IFLOW is set. The
|
|
* changes get undone on the next call to comparam().
|
|
*/
|
|
case TIOCMSET:
|
|
(void)commctl(com, *(int *)data, DMSET);
|
|
break;
|
|
case TIOCMBIS:
|
|
(void)commctl(com, *(int *)data, DMBIS);
|
|
break;
|
|
case TIOCMBIC:
|
|
(void)commctl(com, *(int *)data, DMBIC);
|
|
break;
|
|
case TIOCMGET:
|
|
*(int *)data = commctl(com, 0, DMGET);
|
|
break;
|
|
case TIOCMSDTRWAIT:
|
|
/* must be root since the wait applies to following logins */
|
|
error = suser_td(td);
|
|
if (error != 0) {
|
|
splx(s);
|
|
return (error);
|
|
}
|
|
com->dtr_wait = *(int *)data * hz / 100;
|
|
break;
|
|
case TIOCMGDTRWAIT:
|
|
*(int *)data = com->dtr_wait * 100 / hz;
|
|
break;
|
|
case TIOCTIMESTAMP:
|
|
com->do_timestamp = TRUE;
|
|
*(struct timeval *)data = com->timestamp;
|
|
break;
|
|
case TIOCDCDTIMESTAMP:
|
|
com->do_dcd_timestamp = TRUE;
|
|
*(struct timeval *)data = com->dcd_timestamp;
|
|
break;
|
|
default:
|
|
splx(s);
|
|
return (ENOTTY);
|
|
}
|
|
splx(s);
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
siopoll(void *arg)
|
|
{
|
|
int unit;
|
|
|
|
#ifdef CyDebug
|
|
++cy_timeouts;
|
|
#endif
|
|
if (com_events == 0)
|
|
return;
|
|
repeat:
|
|
for (unit = 0; unit < NSIO; ++unit) {
|
|
struct com_s *com;
|
|
int incc;
|
|
struct tty *tp;
|
|
|
|
com = com_addr(unit);
|
|
if (com == NULL)
|
|
continue;
|
|
tp = com->tp;
|
|
if (tp == NULL) {
|
|
/*
|
|
* XXX forget any events related to closed devices
|
|
* (actually never opened devices) so that we don't
|
|
* loop.
|
|
*/
|
|
critical_enter();
|
|
COM_LOCK();
|
|
incc = com->iptr - com->ibuf;
|
|
com->iptr = com->ibuf;
|
|
if (com->state & CS_CHECKMSR) {
|
|
incc += LOTS_OF_EVENTS;
|
|
com->state &= ~CS_CHECKMSR;
|
|
}
|
|
com_events -= incc;
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
if (incc != 0)
|
|
log(LOG_DEBUG,
|
|
"sio%d: %d events for device with no tp\n",
|
|
unit, incc);
|
|
continue;
|
|
}
|
|
if (com->iptr != com->ibuf) {
|
|
critical_enter();
|
|
COM_LOCK();
|
|
sioinput(com);
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
}
|
|
if (com->state & CS_CHECKMSR) {
|
|
u_char delta_modem_status;
|
|
|
|
critical_enter();
|
|
COM_LOCK();
|
|
sioinput(com);
|
|
delta_modem_status = com->last_modem_status
|
|
^ com->prev_modem_status;
|
|
com->prev_modem_status = com->last_modem_status;
|
|
com_events -= LOTS_OF_EVENTS;
|
|
com->state &= ~CS_CHECKMSR;
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
if (delta_modem_status & MSR_DCD)
|
|
(*linesw[tp->t_line].l_modem)
|
|
(tp, com->prev_modem_status & MSR_DCD);
|
|
}
|
|
if (com->extra_state & CSE_ODONE) {
|
|
critical_enter();
|
|
COM_LOCK();
|
|
com_events -= LOTS_OF_EVENTS;
|
|
com->extra_state &= ~CSE_ODONE;
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
if (!(com->state & CS_BUSY)) {
|
|
tp->t_state &= ~TS_BUSY;
|
|
ttwwakeup(com->tp);
|
|
}
|
|
if (com->etc != ETC_NONE) {
|
|
if (com->etc == ETC_BREAK_ENDED)
|
|
com->etc = ETC_NONE;
|
|
wakeup(&com->etc);
|
|
}
|
|
}
|
|
if (com->state & CS_ODONE) {
|
|
critical_enter();
|
|
COM_LOCK();
|
|
com_events -= LOTS_OF_EVENTS;
|
|
com->state &= ~CS_ODONE;
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
(*linesw[tp->t_line].l_start)(tp);
|
|
}
|
|
if (com_events == 0)
|
|
break;
|
|
}
|
|
if (com_events >= LOTS_OF_EVENTS)
|
|
goto repeat;
|
|
}
|
|
|
|
static int
|
|
comparam(tp, t)
|
|
struct tty *tp;
|
|
struct termios *t;
|
|
{
|
|
int bits;
|
|
int cflag;
|
|
struct com_s *com;
|
|
u_char cor_change;
|
|
u_long cy_clock;
|
|
int idivisor;
|
|
int iflag;
|
|
int iprescaler;
|
|
int itimeout;
|
|
int odivisor;
|
|
int oprescaler;
|
|
u_char opt;
|
|
int s;
|
|
int unit;
|
|
|
|
/* do historical conversions */
|
|
if (t->c_ispeed == 0)
|
|
t->c_ispeed = t->c_ospeed;
|
|
|
|
unit = DEV_TO_UNIT(tp->t_dev);
|
|
com = com_addr(unit);
|
|
|
|
/* check requested parameters */
|
|
cy_clock = CY_CLOCK(com->gfrcr_image);
|
|
idivisor = comspeed(t->c_ispeed, cy_clock, &iprescaler);
|
|
if (idivisor < 0)
|
|
return (EINVAL);
|
|
odivisor = comspeed(t->c_ospeed, cy_clock, &oprescaler);
|
|
if (odivisor < 0)
|
|
return (EINVAL);
|
|
|
|
/* parameters are OK, convert them to the com struct and the device */
|
|
s = spltty();
|
|
if (odivisor == 0)
|
|
(void)commctl(com, TIOCM_DTR, DMBIC); /* hang up line */
|
|
else
|
|
(void)commctl(com, TIOCM_DTR, DMBIS);
|
|
|
|
(void) siosetwater(com, t->c_ispeed);
|
|
|
|
/* XXX we don't actually change the speed atomically. */
|
|
|
|
if (idivisor != 0) {
|
|
cd_setreg(com, CD1400_RBPR, idivisor);
|
|
cd_setreg(com, CD1400_RCOR, iprescaler);
|
|
}
|
|
if (odivisor != 0) {
|
|
cd_setreg(com, CD1400_TBPR, odivisor);
|
|
cd_setreg(com, CD1400_TCOR, oprescaler);
|
|
}
|
|
|
|
/*
|
|
* channel control
|
|
* receiver enable
|
|
* transmitter enable (always set)
|
|
*/
|
|
cflag = t->c_cflag;
|
|
opt = CD1400_CCR_CMDCHANCTL | CD1400_CCR_XMTEN
|
|
| (cflag & CREAD ? CD1400_CCR_RCVEN : CD1400_CCR_RCVDIS);
|
|
if (opt != com->channel_control) {
|
|
com->channel_control = opt;
|
|
cd1400_channel_cmd(com, opt);
|
|
}
|
|
|
|
#ifdef Smarts
|
|
/* set special chars */
|
|
/* XXX if one is _POSIX_VDISABLE, can't use some others */
|
|
if (t->c_cc[VSTOP] != _POSIX_VDISABLE)
|
|
cd_setreg(com, CD1400_SCHR1, t->c_cc[VSTOP]);
|
|
if (t->c_cc[VSTART] != _POSIX_VDISABLE)
|
|
cd_setreg(com, CD1400_SCHR2, t->c_cc[VSTART]);
|
|
if (t->c_cc[VINTR] != _POSIX_VDISABLE)
|
|
cd_setreg(com, CD1400_SCHR3, t->c_cc[VINTR]);
|
|
if (t->c_cc[VSUSP] != _POSIX_VDISABLE)
|
|
cd_setreg(com, CD1400_SCHR4, t->c_cc[VSUSP]);
|
|
#endif
|
|
|
|
/*
|
|
* set channel option register 1 -
|
|
* parity mode
|
|
* stop bits
|
|
* char length
|
|
*/
|
|
opt = 0;
|
|
/* parity */
|
|
if (cflag & PARENB) {
|
|
if (cflag & PARODD)
|
|
opt |= CD1400_COR1_PARODD;
|
|
opt |= CD1400_COR1_PARNORMAL;
|
|
}
|
|
iflag = t->c_iflag;
|
|
if (!(iflag & INPCK))
|
|
opt |= CD1400_COR1_NOINPCK;
|
|
bits = 1 + 1;
|
|
/* stop bits */
|
|
if (cflag & CSTOPB) {
|
|
++bits;
|
|
opt |= CD1400_COR1_STOP2;
|
|
}
|
|
/* char length */
|
|
switch (cflag & CSIZE) {
|
|
case CS5:
|
|
bits += 5;
|
|
opt |= CD1400_COR1_CS5;
|
|
break;
|
|
case CS6:
|
|
bits += 6;
|
|
opt |= CD1400_COR1_CS6;
|
|
break;
|
|
case CS7:
|
|
bits += 7;
|
|
opt |= CD1400_COR1_CS7;
|
|
break;
|
|
default:
|
|
bits += 8;
|
|
opt |= CD1400_COR1_CS8;
|
|
break;
|
|
}
|
|
cor_change = 0;
|
|
if (opt != com->cor[0]) {
|
|
cor_change |= CD1400_CCR_COR1;
|
|
cd_setreg(com, CD1400_COR1, com->cor[0] = opt);
|
|
}
|
|
|
|
/*
|
|
* Set receive time-out period, normally to max(one char time, 5 ms).
|
|
*/
|
|
if (t->c_ispeed == 0)
|
|
itimeout = cd_getreg(com, CD1400_RTPR);
|
|
else {
|
|
itimeout = (1000 * bits + t->c_ispeed - 1) / t->c_ispeed;
|
|
#ifdef SOFT_HOTCHAR
|
|
#define MIN_RTP 1
|
|
#else
|
|
#define MIN_RTP 5
|
|
#endif
|
|
if (itimeout < MIN_RTP)
|
|
itimeout = MIN_RTP;
|
|
}
|
|
if (!(t->c_lflag & ICANON) && t->c_cc[VMIN] != 0 && t->c_cc[VTIME] != 0
|
|
&& t->c_cc[VTIME] * 10 > itimeout)
|
|
itimeout = t->c_cc[VTIME] * 10;
|
|
if (itimeout > 255)
|
|
itimeout = 255;
|
|
cd_setreg(com, CD1400_RTPR, itimeout);
|
|
|
|
/*
|
|
* set channel option register 2 -
|
|
* flow control
|
|
*/
|
|
opt = 0;
|
|
#ifdef Smarts
|
|
if (iflag & IXANY)
|
|
opt |= CD1400_COR2_IXANY;
|
|
if (iflag & IXOFF)
|
|
opt |= CD1400_COR2_IXOFF;
|
|
#endif
|
|
#ifndef SOFT_CTS_OFLOW
|
|
if (cflag & CCTS_OFLOW)
|
|
opt |= CD1400_COR2_CCTS_OFLOW;
|
|
#endif
|
|
critical_enter();
|
|
COM_LOCK();
|
|
if (opt != com->cor[1]) {
|
|
cor_change |= CD1400_CCR_COR2;
|
|
cd_setreg(com, CD1400_COR2, com->cor[1] = opt);
|
|
}
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
|
|
/*
|
|
* set channel option register 3 -
|
|
* receiver FIFO interrupt threshold
|
|
* flow control
|
|
*/
|
|
opt = RxFifoThreshold;
|
|
#ifdef Smarts
|
|
if (t->c_lflag & ICANON)
|
|
opt |= CD1400_COR3_SCD34; /* detect INTR & SUSP chars */
|
|
if (iflag & IXOFF)
|
|
/* detect and transparently handle START and STOP chars */
|
|
opt |= CD1400_COR3_FCT | CD1400_COR3_SCD12;
|
|
#endif
|
|
if (opt != com->cor[2]) {
|
|
cor_change |= CD1400_CCR_COR3;
|
|
cd_setreg(com, CD1400_COR3, com->cor[2] = opt);
|
|
}
|
|
|
|
/* notify the CD1400 if COR1-3 have changed */
|
|
if (cor_change)
|
|
cd1400_channel_cmd(com, CD1400_CCR_CMDCORCHG | cor_change);
|
|
|
|
/*
|
|
* set channel option register 4 -
|
|
* CR/NL processing
|
|
* break processing
|
|
* received exception processing
|
|
*/
|
|
opt = 0;
|
|
if (iflag & IGNCR)
|
|
opt |= CD1400_COR4_IGNCR;
|
|
#ifdef Smarts
|
|
/*
|
|
* we need a new ttyinput() for this, as we don't want to
|
|
* have ICRNL && INLCR being done in both layers, or to have
|
|
* synchronisation problems
|
|
*/
|
|
if (iflag & ICRNL)
|
|
opt |= CD1400_COR4_ICRNL;
|
|
if (iflag & INLCR)
|
|
opt |= CD1400_COR4_INLCR;
|
|
#endif
|
|
if (iflag & IGNBRK)
|
|
opt |= CD1400_COR4_IGNBRK | CD1400_COR4_NOBRKINT;
|
|
/*
|
|
* The `-ignbrk -brkint parmrk' case is not handled by the hardware,
|
|
* so only tell the hardware about -brkint if -parmrk.
|
|
*/
|
|
if (!(iflag & (BRKINT | PARMRK)))
|
|
opt |= CD1400_COR4_NOBRKINT;
|
|
#if 0
|
|
/* XXX using this "intelligence" breaks reporting of overruns. */
|
|
if (iflag & IGNPAR)
|
|
opt |= CD1400_COR4_PFO_DISCARD;
|
|
else {
|
|
if (iflag & PARMRK)
|
|
opt |= CD1400_COR4_PFO_ESC;
|
|
else
|
|
opt |= CD1400_COR4_PFO_NUL;
|
|
}
|
|
#else
|
|
opt |= CD1400_COR4_PFO_EXCEPTION;
|
|
#endif
|
|
cd_setreg(com, CD1400_COR4, opt);
|
|
|
|
/*
|
|
* set channel option register 5 -
|
|
*/
|
|
opt = 0;
|
|
if (iflag & ISTRIP)
|
|
opt |= CD1400_COR5_ISTRIP;
|
|
if (t->c_iflag & IEXTEN)
|
|
/* enable LNEXT (e.g. ctrl-v quoting) handling */
|
|
opt |= CD1400_COR5_LNEXT;
|
|
#ifdef Smarts
|
|
if (t->c_oflag & ONLCR)
|
|
opt |= CD1400_COR5_ONLCR;
|
|
if (t->c_oflag & OCRNL)
|
|
opt |= CD1400_COR5_OCRNL;
|
|
#endif
|
|
cd_setreg(com, CD1400_COR5, opt);
|
|
|
|
/*
|
|
* We always generate modem status change interrupts for CD changes.
|
|
* Among other things, this is necessary to track TS_CARR_ON for
|
|
* pstat to print even when the driver doesn't care. CD changes
|
|
* should be rare so interrupts for them are not worth extra code to
|
|
* avoid. We avoid interrupts for other modem status changes (except
|
|
* for CTS changes when SOFT_CTS_OFLOW is configured) since this is
|
|
* simplest and best.
|
|
*/
|
|
|
|
/*
|
|
* set modem change option register 1
|
|
* generate modem interrupts on which 1 -> 0 input transitions
|
|
* also controls auto-DTR output flow-control, which we don't use
|
|
*/
|
|
opt = CD1400_MCOR1_CDzd;
|
|
#ifdef SOFT_CTS_OFLOW
|
|
if (cflag & CCTS_OFLOW)
|
|
opt |= CD1400_MCOR1_CTSzd;
|
|
#endif
|
|
cd_setreg(com, CD1400_MCOR1, opt);
|
|
|
|
/*
|
|
* set modem change option register 2
|
|
* generate modem interrupts on specific 0 -> 1 input transitions
|
|
*/
|
|
opt = CD1400_MCOR2_CDod;
|
|
#ifdef SOFT_CTS_OFLOW
|
|
if (cflag & CCTS_OFLOW)
|
|
opt |= CD1400_MCOR2_CTSod;
|
|
#endif
|
|
cd_setreg(com, CD1400_MCOR2, opt);
|
|
|
|
/*
|
|
* XXX should have done this long ago, but there is too much state
|
|
* to change all atomically.
|
|
*/
|
|
critical_enter();
|
|
COM_LOCK();
|
|
|
|
com->state &= ~CS_TTGO;
|
|
if (!(tp->t_state & TS_TTSTOP))
|
|
com->state |= CS_TTGO;
|
|
if (cflag & CRTS_IFLOW) {
|
|
com->state |= CS_RTS_IFLOW;
|
|
/*
|
|
* If CS_RTS_IFLOW just changed from off to on, the change
|
|
* needs to be propagated to MCR_RTS. This isn't urgent,
|
|
* so do it later by calling comstart() instead of repeating
|
|
* a lot of code from comstart() here.
|
|
*/
|
|
} else if (com->state & CS_RTS_IFLOW) {
|
|
com->state &= ~CS_RTS_IFLOW;
|
|
/*
|
|
* CS_RTS_IFLOW just changed from on to off. Force MCR_RTS
|
|
* on here, since comstart() won't do it later.
|
|
*/
|
|
#if 0
|
|
outb(com->modem_ctl_port, com->mcr_image |= MCR_RTS);
|
|
#else
|
|
cd_setreg(com, com->mcr_rts_reg,
|
|
com->mcr_image |= com->mcr_rts);
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* Set up state to handle output flow control.
|
|
* XXX - worth handling MDMBUF (DCD) flow control at the lowest level?
|
|
* Now has 10+ msec latency, while CTS flow has 50- usec latency.
|
|
*/
|
|
com->state |= CS_ODEVREADY;
|
|
#ifdef SOFT_CTS_OFLOW
|
|
com->state &= ~CS_CTS_OFLOW;
|
|
if (cflag & CCTS_OFLOW) {
|
|
com->state |= CS_CTS_OFLOW;
|
|
if (!(com->last_modem_status & MSR_CTS))
|
|
com->state &= ~CS_ODEVREADY;
|
|
}
|
|
#endif
|
|
/* XXX shouldn't call functions while intrs are disabled. */
|
|
disc_optim(tp, t, com);
|
|
#if 0
|
|
/*
|
|
* Recover from fiddling with CS_TTGO. We used to call siointr1()
|
|
* unconditionally, but that defeated the careful discarding of
|
|
* stale input in sioopen().
|
|
*/
|
|
if (com->state >= (CS_BUSY | CS_TTGO))
|
|
siointr1(com);
|
|
#endif
|
|
if (com->state >= (CS_BUSY | CS_TTGO | CS_ODEVREADY)) {
|
|
if (!(com->intr_enable & CD1400_SRER_TXRDY))
|
|
cd_setreg(com, CD1400_SRER,
|
|
com->intr_enable
|
|
= (com->intr_enable & ~CD1400_SRER_TXMPTY)
|
|
| CD1400_SRER_TXRDY);
|
|
} else {
|
|
if (com->intr_enable & CD1400_SRER_TXRDY)
|
|
cd_setreg(com, CD1400_SRER,
|
|
com->intr_enable
|
|
= (com->intr_enable & ~CD1400_SRER_TXRDY)
|
|
| CD1400_SRER_TXMPTY);
|
|
}
|
|
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
splx(s);
|
|
comstart(tp);
|
|
if (com->ibufold != NULL) {
|
|
free(com->ibufold, M_DEVBUF);
|
|
com->ibufold = NULL;
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
siosetwater(com, speed)
|
|
struct com_s *com;
|
|
speed_t speed;
|
|
{
|
|
int cp4ticks;
|
|
u_char *ibuf;
|
|
int ibufsize;
|
|
struct tty *tp;
|
|
|
|
/*
|
|
* Make the buffer size large enough to handle a softtty interrupt
|
|
* latency of about 2 ticks without loss of throughput or data
|
|
* (about 3 ticks if input flow control is not used or not honoured,
|
|
* but a bit less for CS5-CS7 modes).
|
|
*/
|
|
cp4ticks = speed / 10 / hz * 4;
|
|
for (ibufsize = 128; ibufsize < cp4ticks;)
|
|
ibufsize <<= 1;
|
|
if (ibufsize == com->ibufsize) {
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Allocate input buffer. The extra factor of 2 in the size is
|
|
* to allow for an error byte for each input byte.
|
|
*/
|
|
ibuf = malloc(2 * ibufsize, M_DEVBUF, M_NOWAIT);
|
|
if (ibuf == NULL) {
|
|
return (ENOMEM);
|
|
}
|
|
|
|
/* Initialize non-critical variables. */
|
|
com->ibufold = com->ibuf;
|
|
com->ibufsize = ibufsize;
|
|
tp = com->tp;
|
|
if (tp != NULL) {
|
|
tp->t_ififosize = 2 * ibufsize;
|
|
tp->t_ispeedwat = (speed_t)-1;
|
|
tp->t_ospeedwat = (speed_t)-1;
|
|
}
|
|
|
|
/*
|
|
* Read current input buffer, if any. Continue with interrupts
|
|
* disabled.
|
|
*/
|
|
critical_enter();
|
|
COM_LOCK();
|
|
if (com->iptr != com->ibuf)
|
|
sioinput(com);
|
|
|
|
/*-
|
|
* Initialize critical variables, including input buffer watermarks.
|
|
* The external device is asked to stop sending when the buffer
|
|
* exactly reaches high water, or when the high level requests it.
|
|
* The high level is notified immediately (rather than at a later
|
|
* clock tick) when this watermark is reached.
|
|
* The buffer size is chosen so the watermark should almost never
|
|
* be reached.
|
|
* The low watermark is invisibly 0 since the buffer is always
|
|
* emptied all at once.
|
|
*/
|
|
com->iptr = com->ibuf = ibuf;
|
|
com->ibufend = ibuf + ibufsize;
|
|
com->ierroff = ibufsize;
|
|
com->ihighwater = ibuf + 3 * ibufsize / 4;
|
|
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
comstart(tp)
|
|
struct tty *tp;
|
|
{
|
|
struct com_s *com;
|
|
int s;
|
|
#ifdef CyDebug
|
|
bool_t started;
|
|
#endif
|
|
int unit;
|
|
|
|
unit = DEV_TO_UNIT(tp->t_dev);
|
|
com = com_addr(unit);
|
|
s = spltty();
|
|
|
|
#ifdef CyDebug
|
|
++com->start_count;
|
|
started = FALSE;
|
|
#endif
|
|
|
|
critical_enter();
|
|
COM_LOCK();
|
|
if (tp->t_state & TS_TTSTOP) {
|
|
com->state &= ~CS_TTGO;
|
|
if (com->intr_enable & CD1400_SRER_TXRDY)
|
|
cd_setreg(com, CD1400_SRER,
|
|
com->intr_enable
|
|
= (com->intr_enable & ~CD1400_SRER_TXRDY)
|
|
| CD1400_SRER_TXMPTY);
|
|
} else {
|
|
com->state |= CS_TTGO;
|
|
if (com->state >= (CS_BUSY | CS_TTGO | CS_ODEVREADY)
|
|
&& !(com->intr_enable & CD1400_SRER_TXRDY))
|
|
cd_setreg(com, CD1400_SRER,
|
|
com->intr_enable
|
|
= (com->intr_enable & ~CD1400_SRER_TXMPTY)
|
|
| CD1400_SRER_TXRDY);
|
|
}
|
|
if (tp->t_state & TS_TBLOCK) {
|
|
if (com->mcr_image & com->mcr_rts && com->state & CS_RTS_IFLOW)
|
|
#if 0
|
|
outb(com->modem_ctl_port, com->mcr_image &= ~MCR_RTS);
|
|
#else
|
|
cd_setreg(com, com->mcr_rts_reg,
|
|
com->mcr_image &= ~com->mcr_rts);
|
|
#endif
|
|
} else {
|
|
if (!(com->mcr_image & com->mcr_rts)
|
|
&& com->iptr < com->ihighwater
|
|
&& com->state & CS_RTS_IFLOW)
|
|
#if 0
|
|
outb(com->modem_ctl_port, com->mcr_image |= MCR_RTS);
|
|
#else
|
|
cd_setreg(com, com->mcr_rts_reg,
|
|
com->mcr_image |= com->mcr_rts);
|
|
#endif
|
|
}
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
if (tp->t_state & (TS_TIMEOUT | TS_TTSTOP)) {
|
|
ttwwakeup(tp);
|
|
splx(s);
|
|
return;
|
|
}
|
|
if (tp->t_outq.c_cc != 0) {
|
|
struct lbq *qp;
|
|
struct lbq *next;
|
|
|
|
if (!com->obufs[0].l_queued) {
|
|
#ifdef CyDebug
|
|
started = TRUE;
|
|
#endif
|
|
com->obufs[0].l_tail
|
|
= com->obuf1 + q_to_b(&tp->t_outq, com->obuf1,
|
|
sizeof com->obuf1);
|
|
com->obufs[0].l_next = NULL;
|
|
com->obufs[0].l_queued = TRUE;
|
|
critical_enter();
|
|
COM_LOCK();
|
|
if (com->state & CS_BUSY) {
|
|
qp = com->obufq.l_next;
|
|
while ((next = qp->l_next) != NULL)
|
|
qp = next;
|
|
qp->l_next = &com->obufs[0];
|
|
} else {
|
|
com->obufq.l_head = com->obufs[0].l_head;
|
|
com->obufq.l_tail = com->obufs[0].l_tail;
|
|
com->obufq.l_next = &com->obufs[0];
|
|
com->state |= CS_BUSY;
|
|
if (com->state >= (CS_BUSY | CS_TTGO
|
|
| CS_ODEVREADY))
|
|
cd_setreg(com, CD1400_SRER,
|
|
com->intr_enable
|
|
= (com->intr_enable
|
|
& ~CD1400_SRER_TXMPTY)
|
|
| CD1400_SRER_TXRDY);
|
|
}
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
}
|
|
if (tp->t_outq.c_cc != 0 && !com->obufs[1].l_queued) {
|
|
#ifdef CyDebug
|
|
started = TRUE;
|
|
#endif
|
|
com->obufs[1].l_tail
|
|
= com->obuf2 + q_to_b(&tp->t_outq, com->obuf2,
|
|
sizeof com->obuf2);
|
|
com->obufs[1].l_next = NULL;
|
|
com->obufs[1].l_queued = TRUE;
|
|
critical_enter();
|
|
COM_LOCK();
|
|
if (com->state & CS_BUSY) {
|
|
qp = com->obufq.l_next;
|
|
while ((next = qp->l_next) != NULL)
|
|
qp = next;
|
|
qp->l_next = &com->obufs[1];
|
|
} else {
|
|
com->obufq.l_head = com->obufs[1].l_head;
|
|
com->obufq.l_tail = com->obufs[1].l_tail;
|
|
com->obufq.l_next = &com->obufs[1];
|
|
com->state |= CS_BUSY;
|
|
if (com->state >= (CS_BUSY | CS_TTGO
|
|
| CS_ODEVREADY))
|
|
cd_setreg(com, CD1400_SRER,
|
|
com->intr_enable
|
|
= (com->intr_enable
|
|
& ~CD1400_SRER_TXMPTY)
|
|
| CD1400_SRER_TXRDY);
|
|
}
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
}
|
|
tp->t_state |= TS_BUSY;
|
|
}
|
|
#ifdef CyDebug
|
|
if (started)
|
|
++com->start_real;
|
|
#endif
|
|
#if 0
|
|
critical_enter();
|
|
COM_LOCK();
|
|
if (com->state >= (CS_BUSY | CS_TTGO))
|
|
siointr1(com); /* fake interrupt to start output */
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
#endif
|
|
ttwwakeup(tp);
|
|
splx(s);
|
|
}
|
|
|
|
static void
|
|
comstop(tp, rw)
|
|
struct tty *tp;
|
|
int rw;
|
|
{
|
|
struct com_s *com;
|
|
bool_t wakeup_etc;
|
|
|
|
com = com_addr(DEV_TO_UNIT(tp->t_dev));
|
|
wakeup_etc = FALSE;
|
|
critical_enter();
|
|
COM_LOCK();
|
|
if (rw & FWRITE) {
|
|
com->obufs[0].l_queued = FALSE;
|
|
com->obufs[1].l_queued = FALSE;
|
|
if (com->extra_state & CSE_ODONE) {
|
|
com_events -= LOTS_OF_EVENTS;
|
|
com->extra_state &= ~CSE_ODONE;
|
|
if (com->etc != ETC_NONE) {
|
|
if (com->etc == ETC_BREAK_ENDED)
|
|
com->etc = ETC_NONE;
|
|
wakeup_etc = TRUE;
|
|
}
|
|
}
|
|
com->tp->t_state &= ~TS_BUSY;
|
|
if (com->state & CS_ODONE)
|
|
com_events -= LOTS_OF_EVENTS;
|
|
com->state &= ~(CS_ODONE | CS_BUSY);
|
|
}
|
|
if (rw & FREAD) {
|
|
/* XXX no way to reset only input fifo. */
|
|
com_events -= (com->iptr - com->ibuf);
|
|
com->iptr = com->ibuf;
|
|
}
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
if (wakeup_etc)
|
|
wakeup(&com->etc);
|
|
if (rw & FWRITE && com->etc == ETC_NONE)
|
|
cd1400_channel_cmd(com, CD1400_CCR_CMDRESET | CD1400_CCR_FTF);
|
|
comstart(tp);
|
|
}
|
|
|
|
static int
|
|
commctl(com, bits, how)
|
|
struct com_s *com;
|
|
int bits;
|
|
int how;
|
|
{
|
|
int mcr;
|
|
int msr;
|
|
|
|
if (how == DMGET) {
|
|
if (com->channel_control & CD1400_CCR_RCVEN)
|
|
bits |= TIOCM_LE;
|
|
mcr = com->mcr_image;
|
|
if (mcr & com->mcr_dtr)
|
|
bits |= TIOCM_DTR;
|
|
if (mcr & com->mcr_rts)
|
|
/* XXX wired on for Cyclom-8Ys */
|
|
bits |= TIOCM_RTS;
|
|
|
|
/*
|
|
* We must read the modem status from the hardware because
|
|
* we don't generate modem status change interrupts for all
|
|
* changes, so com->prev_modem_status is not guaranteed to
|
|
* be up to date. This is safe, unlike for sio, because
|
|
* reading the status register doesn't clear pending modem
|
|
* status change interrupts.
|
|
*/
|
|
msr = cd_getreg(com, CD1400_MSVR2);
|
|
|
|
if (msr & MSR_CTS)
|
|
bits |= TIOCM_CTS;
|
|
if (msr & MSR_DCD)
|
|
bits |= TIOCM_CD;
|
|
if (msr & MSR_DSR)
|
|
bits |= TIOCM_DSR;
|
|
if (msr & MSR_RI)
|
|
/* XXX not connected except for Cyclom-16Y? */
|
|
bits |= TIOCM_RI;
|
|
return (bits);
|
|
}
|
|
mcr = 0;
|
|
if (bits & TIOCM_DTR)
|
|
mcr |= com->mcr_dtr;
|
|
if (bits & TIOCM_RTS)
|
|
mcr |= com->mcr_rts;
|
|
critical_enter();
|
|
COM_LOCK();
|
|
switch (how) {
|
|
case DMSET:
|
|
com->mcr_image = mcr;
|
|
cd_setreg(com, CD1400_MSVR1, mcr);
|
|
cd_setreg(com, CD1400_MSVR2, mcr);
|
|
break;
|
|
case DMBIS:
|
|
com->mcr_image = mcr = com->mcr_image | mcr;
|
|
cd_setreg(com, CD1400_MSVR1, mcr);
|
|
cd_setreg(com, CD1400_MSVR2, mcr);
|
|
break;
|
|
case DMBIC:
|
|
com->mcr_image = mcr = com->mcr_image & ~mcr;
|
|
cd_setreg(com, CD1400_MSVR1, mcr);
|
|
cd_setreg(com, CD1400_MSVR2, mcr);
|
|
break;
|
|
}
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
siosettimeout()
|
|
{
|
|
struct com_s *com;
|
|
bool_t someopen;
|
|
int unit;
|
|
|
|
/*
|
|
* Set our timeout period to 1 second if no polled devices are open.
|
|
* Otherwise set it to max(1/200, 1/hz).
|
|
* Enable timeouts iff some device is open.
|
|
*/
|
|
untimeout(comwakeup, (void *)NULL, sio_timeout_handle);
|
|
sio_timeout = hz;
|
|
someopen = FALSE;
|
|
for (unit = 0; unit < NSIO; ++unit) {
|
|
com = com_addr(unit);
|
|
if (com != NULL && com->tp != NULL
|
|
&& com->tp->t_state & TS_ISOPEN) {
|
|
someopen = TRUE;
|
|
#if 0
|
|
if (com->poll || com->poll_output) {
|
|
sio_timeout = hz > 200 ? hz / 200 : 1;
|
|
break;
|
|
}
|
|
#endif
|
|
}
|
|
}
|
|
if (someopen) {
|
|
sio_timeouts_until_log = hz / sio_timeout;
|
|
sio_timeout_handle = timeout(comwakeup, (void *)NULL,
|
|
sio_timeout);
|
|
} else {
|
|
/* Flush error messages, if any. */
|
|
sio_timeouts_until_log = 1;
|
|
comwakeup((void *)NULL);
|
|
untimeout(comwakeup, (void *)NULL, sio_timeout_handle);
|
|
}
|
|
}
|
|
|
|
static void
|
|
comwakeup(chan)
|
|
void *chan;
|
|
{
|
|
struct com_s *com;
|
|
int unit;
|
|
|
|
sio_timeout_handle = timeout(comwakeup, (void *)NULL, sio_timeout);
|
|
|
|
#if 0
|
|
/*
|
|
* Recover from lost output interrupts.
|
|
* Poll any lines that don't use interrupts.
|
|
*/
|
|
for (unit = 0; unit < NSIO; ++unit) {
|
|
com = com_addr(unit);
|
|
if (com != NULL
|
|
&& (com->state >= (CS_BUSY | CS_TTGO) || com->poll)) {
|
|
critical_enter();
|
|
COM_LOCK();
|
|
siointr1(com);
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
}
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* Check for and log errors, but not too often.
|
|
*/
|
|
if (--sio_timeouts_until_log > 0)
|
|
return;
|
|
sio_timeouts_until_log = hz / sio_timeout;
|
|
for (unit = 0; unit < NSIO; ++unit) {
|
|
int errnum;
|
|
|
|
com = com_addr(unit);
|
|
if (com == NULL)
|
|
continue;
|
|
for (errnum = 0; errnum < CE_NTYPES; ++errnum) {
|
|
u_int delta;
|
|
u_long total;
|
|
|
|
critical_enter();
|
|
COM_LOCK();
|
|
delta = com->delta_error_counts[errnum];
|
|
com->delta_error_counts[errnum] = 0;
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
if (delta == 0)
|
|
continue;
|
|
total = com->error_counts[errnum] += delta;
|
|
log(LOG_ERR, "cy%d: %u more %s%s (total %lu)\n",
|
|
unit, delta, error_desc[errnum],
|
|
delta == 1 ? "" : "s", total);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void
|
|
disc_optim(tp, t, com)
|
|
struct tty *tp;
|
|
struct termios *t;
|
|
struct com_s *com;
|
|
{
|
|
#ifndef SOFT_HOTCHAR
|
|
u_char opt;
|
|
#endif
|
|
|
|
/*
|
|
* XXX can skip a lot more cases if Smarts. Maybe
|
|
* (IGNCR | ISTRIP | IXON) in c_iflag. But perhaps we
|
|
* shouldn't skip if (TS_CNTTB | TS_LNCH) is set in t_state.
|
|
*/
|
|
if (!(t->c_iflag & (ICRNL | IGNCR | IMAXBEL | INLCR | ISTRIP | IXON))
|
|
&& (!(t->c_iflag & BRKINT) || (t->c_iflag & IGNBRK))
|
|
&& (!(t->c_iflag & PARMRK)
|
|
|| (t->c_iflag & (IGNPAR | IGNBRK)) == (IGNPAR | IGNBRK))
|
|
&& !(t->c_lflag & (ECHO | ICANON | IEXTEN | ISIG | PENDIN))
|
|
&& linesw[tp->t_line].l_rint == ttyinput)
|
|
tp->t_state |= TS_CAN_BYPASS_L_RINT;
|
|
else
|
|
tp->t_state &= ~TS_CAN_BYPASS_L_RINT;
|
|
com->hotchar = linesw[tp->t_line].l_hotchar;
|
|
#ifndef SOFT_HOTCHAR
|
|
opt = com->cor[2] & ~CD1400_COR3_SCD34;
|
|
if (com->hotchar != 0) {
|
|
cd_setreg(com, CD1400_SCHR3, com->hotchar);
|
|
cd_setreg(com, CD1400_SCHR4, com->hotchar);
|
|
opt |= CD1400_COR3_SCD34;
|
|
}
|
|
if (opt != com->cor[2]) {
|
|
cd_setreg(com, CD1400_COR3, com->cor[2] = opt);
|
|
cd1400_channel_cmd(com, CD1400_CCR_CMDCORCHG | CD1400_CCR_COR3);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
#ifdef Smarts
|
|
/* standard line discipline input routine */
|
|
int
|
|
cyinput(c, tp)
|
|
int c;
|
|
struct tty *tp;
|
|
{
|
|
/* XXX duplicate ttyinput(), but without the IXOFF/IXON/ISTRIP/IPARMRK
|
|
* bits, as they are done by the CD1400. Hardly worth the effort,
|
|
* given that high-throughput sessions are raw anyhow.
|
|
*/
|
|
}
|
|
#endif /* Smarts */
|
|
|
|
static int
|
|
comspeed(speed, cy_clock, prescaler_io)
|
|
speed_t speed;
|
|
u_long cy_clock;
|
|
int *prescaler_io;
|
|
{
|
|
int actual;
|
|
int error;
|
|
int divider;
|
|
int prescaler;
|
|
int prescaler_unit;
|
|
|
|
if (speed == 0)
|
|
return (0);
|
|
if (speed < 0 || speed > 150000)
|
|
return (-1);
|
|
|
|
/* determine which prescaler to use */
|
|
for (prescaler_unit = 4, prescaler = 2048; prescaler_unit;
|
|
prescaler_unit--, prescaler >>= 2) {
|
|
if (cy_clock / prescaler / speed > 63)
|
|
break;
|
|
}
|
|
|
|
divider = (cy_clock / prescaler * 2 / speed + 1) / 2; /* round off */
|
|
if (divider > 255)
|
|
divider = 255;
|
|
actual = cy_clock/prescaler/divider;
|
|
|
|
/* 10 times error in percent: */
|
|
error = ((actual - (long)speed) * 2000 / (long)speed + 1) / 2;
|
|
|
|
/* 3.0% max error tolerance */
|
|
if (error < -30 || error > 30)
|
|
return (-1);
|
|
|
|
#if 0
|
|
printf("prescaler = %d (%d)\n", prescaler, prescaler_unit);
|
|
printf("divider = %d (%x)\n", divider, divider);
|
|
printf("actual = %d\n", actual);
|
|
printf("error = %d\n", error);
|
|
#endif
|
|
|
|
*prescaler_io = prescaler_unit;
|
|
return (divider);
|
|
}
|
|
|
|
static void
|
|
cd1400_channel_cmd(com, cmd)
|
|
struct com_s *com;
|
|
int cmd;
|
|
{
|
|
cd1400_channel_cmd_wait(com);
|
|
cd_setreg(com, CD1400_CCR, cmd);
|
|
cd1400_channel_cmd_wait(com);
|
|
}
|
|
|
|
static void
|
|
cd1400_channel_cmd_wait(com)
|
|
struct com_s *com;
|
|
{
|
|
struct timeval start;
|
|
struct timeval tv;
|
|
long usec;
|
|
|
|
if (cd_getreg(com, CD1400_CCR) == 0)
|
|
return;
|
|
microtime(&start);
|
|
for (;;) {
|
|
if (cd_getreg(com, CD1400_CCR) == 0)
|
|
return;
|
|
microtime(&tv);
|
|
usec = 1000000 * (tv.tv_sec - start.tv_sec) +
|
|
tv.tv_usec - start.tv_usec;
|
|
if (usec >= 5000) {
|
|
log(LOG_ERR,
|
|
"cy%d: channel command timeout (%ld usec)\n",
|
|
com->unit, usec);
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
static void
|
|
cd_etc(com, etc)
|
|
struct com_s *com;
|
|
int etc;
|
|
{
|
|
|
|
/*
|
|
* We can't change the hardware's ETC state while there are any
|
|
* characters in the tx fifo, since those characters would be
|
|
* interpreted as commands! Unputting characters from the fifo
|
|
* is difficult, so we wait up to 12 character times for the fifo
|
|
* to drain. The command will be delayed for up to 2 character
|
|
* times for the tx to become empty. Unputting characters from
|
|
* the tx holding and shift registers is impossible, so we wait
|
|
* for the tx to become empty so that the command is sure to be
|
|
* executed soon after we issue it.
|
|
*/
|
|
critical_enter();
|
|
COM_LOCK();
|
|
if (com->etc == etc)
|
|
goto wait;
|
|
if ((etc == CD1400_ETC_SENDBREAK
|
|
&& (com->etc == ETC_BREAK_STARTING
|
|
|| com->etc == ETC_BREAK_STARTED))
|
|
|| (etc == CD1400_ETC_STOPBREAK
|
|
&& (com->etc == ETC_BREAK_ENDING || com->etc == ETC_BREAK_ENDED
|
|
|| com->etc == ETC_NONE))) {
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
return;
|
|
}
|
|
com->etc = etc;
|
|
cd_setreg(com, CD1400_SRER,
|
|
com->intr_enable
|
|
= (com->intr_enable & ~CD1400_SRER_TXRDY) | CD1400_SRER_TXMPTY);
|
|
wait:
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
while (com->etc == etc
|
|
&& tsleep(&com->etc, TTIPRI | PCATCH, "cyetc", 0) == 0)
|
|
continue;
|
|
}
|
|
|
|
static int
|
|
cd_getreg(com, reg)
|
|
struct com_s *com;
|
|
int reg;
|
|
{
|
|
struct com_s *basecom;
|
|
u_char car;
|
|
int cy_align;
|
|
register_t eflags;
|
|
cy_addr iobase;
|
|
int val;
|
|
|
|
basecom = com_addr(com->unit & ~(CD1400_NO_OF_CHANNELS - 1));
|
|
car = com->unit & CD1400_CAR_CHAN;
|
|
cy_align = com->cy_align;
|
|
iobase = com->iobase;
|
|
eflags = read_eflags();
|
|
critical_enter();
|
|
if (eflags & PSL_I)
|
|
COM_LOCK();
|
|
if (basecom->car != car)
|
|
cd_outb(iobase, CD1400_CAR, cy_align, basecom->car = car);
|
|
val = cd_inb(iobase, reg, cy_align);
|
|
if (eflags & PSL_I)
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
return (val);
|
|
}
|
|
|
|
static void
|
|
cd_setreg(com, reg, val)
|
|
struct com_s *com;
|
|
int reg;
|
|
int val;
|
|
{
|
|
struct com_s *basecom;
|
|
u_char car;
|
|
int cy_align;
|
|
register_t eflags;
|
|
cy_addr iobase;
|
|
|
|
basecom = com_addr(com->unit & ~(CD1400_NO_OF_CHANNELS - 1));
|
|
car = com->unit & CD1400_CAR_CHAN;
|
|
cy_align = com->cy_align;
|
|
iobase = com->iobase;
|
|
eflags = read_eflags();
|
|
critical_enter();
|
|
if (eflags & PSL_I)
|
|
COM_LOCK();
|
|
if (basecom->car != car)
|
|
cd_outb(iobase, CD1400_CAR, cy_align, basecom->car = car);
|
|
cd_outb(iobase, reg, cy_align, val);
|
|
if (eflags & PSL_I)
|
|
COM_UNLOCK();
|
|
critical_exit();
|
|
}
|
|
|
|
#ifdef CyDebug
|
|
/* useful in ddb */
|
|
void
|
|
cystatus(unit)
|
|
int unit;
|
|
{
|
|
struct com_s *com;
|
|
cy_addr iobase;
|
|
u_int ocount;
|
|
struct tty *tp;
|
|
|
|
com = com_addr(unit);
|
|
printf("info for channel %d\n", unit);
|
|
printf("------------------\n");
|
|
printf("total cyclom service probes:\t%d\n", cy_svrr_probes);
|
|
printf("calls to upper layer:\t\t%d\n", cy_timeouts);
|
|
if (com == NULL)
|
|
return;
|
|
iobase = com->iobase;
|
|
printf("\n");
|
|
printf("cd1400 base address:\\tt%p\n", iobase);
|
|
printf("saved channel_control:\t\t0x%02x\n", com->channel_control);
|
|
printf("saved cor1-3:\t\t\t0x%02x 0x%02x 0x%02x\n",
|
|
com->cor[0], com->cor[1], com->cor[2]);
|
|
printf("service request enable reg:\t0x%02x (0x%02x cached)\n",
|
|
cd_getreg(com, CD1400_SRER), com->intr_enable);
|
|
printf("service request register:\t0x%02x\n",
|
|
cd_inb(iobase, CD1400_SVRR, com->cy_align));
|
|
printf("modem status:\t\t\t0x%02x (0x%02x cached)\n",
|
|
cd_getreg(com, CD1400_MSVR2), com->prev_modem_status);
|
|
printf("rx/tx/mdm interrupt registers:\t0x%02x 0x%02x 0x%02x\n",
|
|
cd_inb(iobase, CD1400_RIR, com->cy_align),
|
|
cd_inb(iobase, CD1400_TIR, com->cy_align),
|
|
cd_inb(iobase, CD1400_MIR, com->cy_align));
|
|
printf("\n");
|
|
printf("com state:\t\t\t0x%02x\n", com->state);
|
|
printf("calls to comstart():\t\t%d (%d useful)\n",
|
|
com->start_count, com->start_real);
|
|
printf("rx buffer chars free:\t\t%d\n", com->iptr - com->ibuf);
|
|
ocount = 0;
|
|
if (com->obufs[0].l_queued)
|
|
ocount += com->obufs[0].l_tail - com->obufs[0].l_head;
|
|
if (com->obufs[1].l_queued)
|
|
ocount += com->obufs[1].l_tail - com->obufs[1].l_head;
|
|
printf("tx buffer chars:\t\t%u\n", ocount);
|
|
printf("received chars:\t\t\t%d\n", com->bytes_in);
|
|
printf("received exceptions:\t\t%d\n", com->recv_exception);
|
|
printf("modem signal deltas:\t\t%d\n", com->mdm);
|
|
printf("transmitted chars:\t\t%d\n", com->bytes_out);
|
|
printf("\n");
|
|
tp = com->tp;
|
|
if (tp != NULL) {
|
|
printf("tty state:\t\t\t0x%08x\n", tp->t_state);
|
|
printf(
|
|
"upper layer queue lengths:\t%d raw, %d canon, %d output\n",
|
|
tp->t_rawq.c_cc, tp->t_canq.c_cc, tp->t_outq.c_cc);
|
|
} else
|
|
printf("tty state:\t\t\tclosed\n");
|
|
}
|
|
#endif /* CyDebug */
|