#include "opt_comconsole.h"
#include "opt_ddb.h"
#include "opt_sio.h"
#include "use_pci.h"
#include "use_puc.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/reboot.h>
#include <sys/malloc.h>
#include <sys/tty.h>
#include <sys/ttydefaults.h>
#include <sys/proc.h>
#include <sys/caps.h>
#include <sys/module.h>
#include <sys/conf.h>
#include <sys/dkstat.h>
#include <sys/fcntl.h>
#include <sys/interrupt.h>
#include <sys/kernel.h>
#include <sys/syslog.h>
#include <sys/sysctl.h>
#include <sys/bus.h>
#include <sys/rman.h>
#include <sys/timepps.h>
#include <sys/thread2.h>
#include <sys/devfs.h>
#include <sys/consio.h>
#include <machine/limits.h>
#include <bus/isa/isareg.h>
#include <bus/isa/isavar.h>
#if NPCI > 0
#include <bus/pci/pcireg.h>
#include <bus/pci/pcivar.h>
#endif
#if NPUC > 0
#include <dev/misc/puc/pucvar.h>
#endif
#include <machine/lock.h>
#include <machine/clock.h>
#include "sioreg.h"
#include "sio_private.h"
#ifdef COM_ESP
#include "../ic_layer/esp.h"
#endif
#define LOTS_OF_EVENTS 64
#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_TO_UNIT(mynor) ((((mynor) & ~0xffffU) >> (8 + 3)) \
| ((mynor) & 0x1f))
#define UNIT_TO_MINOR(unit) ((((unit) & ~0x1fU) << (8 + 3)) \
| ((unit) & 0x1f))
#define com_scr 7
#define sio_getreg(com, off) \
(bus_space_read_1((com)->bst, (com)->bsh, (off)))
#define sio_setreg(com, off, value) \
(bus_space_write_1((com)->bst, (com)->bsh, (off), (value)))
#define CS_BUSY 0x80
#define CS_TTGO 0x40
#define CS_ODEVREADY 0x20
#define CS_CHECKMSR 1
#define CS_CTS_OFLOW 2
#define CS_DTR_OFF 0x10
#define CS_ODONE 4
#define CS_RTS_IFLOW 8
#define CSE_BUSYCHECK 1
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",
};
#ifdef COM_ESP
static int espattach (struct com_s *com, Port_t esp_port);
#endif
static int sio_isa_attach (device_t dev);
static timeout_t siobusycheck;
static u_int siodivisor (u_long rclk, speed_t speed);
static timeout_t siodtrwakeup;
static void comhardclose (struct com_s *com);
static void sioinput (struct com_s *com);
static void siointr1 (struct com_s *com);
static void siointr (void *arg);
static int commctl (struct com_s *com, int bits, int how);
static int comparam (struct tty *tp, struct termios *t);
static inthand2_t siopoll;
static int sio_isa_probe (device_t dev);
static void siosettimeout (void);
static int siosetwater (struct com_s *com, speed_t speed);
static void comstart (struct tty *tp);
static void comstop (struct tty *tp, int rw);
static timeout_t comwakeup;
static void disc_optim (struct tty *tp, struct termios *t,
struct com_s *com);
static void siocntxwait (Port_t iobase);
#if NPCI > 0
static int sio_pci_attach (device_t dev);
static void sio_pci_kludge_unit (device_t dev);
static int sio_pci_probe (device_t dev);
#endif
#if NPUC > 0
static int sio_puc_attach (device_t dev);
static int sio_puc_probe (device_t dev);
#endif
static char driver_name[] = "sio";
devclass_t sio_devclass;
#define com_addr(unit) ((struct com_s *) \
devclass_get_softc(sio_devclass, unit))
static device_method_t sio_isa_methods[] = {
DEVMETHOD(device_probe, sio_isa_probe),
DEVMETHOD(device_attach, sio_isa_attach),
DEVMETHOD_END
};
static driver_t sio_isa_driver = {
driver_name,
sio_isa_methods,
sizeof(struct com_s),
};
#if NPCI > 0
static device_method_t sio_pci_methods[] = {
DEVMETHOD(device_probe, sio_pci_probe),
DEVMETHOD(device_attach, sio_pci_attach),
DEVMETHOD_END
};
static driver_t sio_pci_driver = {
driver_name,
sio_pci_methods,
sizeof(struct com_s),
};
#endif
#if NPUC > 0
static device_method_t sio_puc_methods[] = {
DEVMETHOD(device_probe, sio_puc_probe),
DEVMETHOD(device_attach, sio_puc_attach),
DEVMETHOD_END
};
static driver_t sio_puc_driver = {
driver_name,
sio_puc_methods,
sizeof(struct com_s),
};
#endif
static d_open_t sioopen;
static d_close_t sioclose;
static d_read_t sioread;
static d_write_t siowrite;
static d_ioctl_t sioioctl;
static struct dev_ops sio_ops = {
{ driver_name, 0, D_TTY },
.d_open = sioopen,
.d_close = sioclose,
.d_read = sioread,
.d_write = siowrite,
.d_ioctl = sioioctl,
.d_kqfilter = ttykqfilter,
.d_revoke = ttyrevoke
};
int comconsole = -1;
static volatile speed_t comdefaultrate = CONSPEED;
static u_long comdefaultrclk = DEFAULT_RCLK;
SYSCTL_ULONG(_machdep, OID_AUTO, conrclk, CTLFLAG_RW, &comdefaultrclk, 0, "");
static Port_t siocniobase;
static int siocnunit;
static Port_t siogdbiobase;
static int siogdbunit = -1;
static bool_t sio_registered;
static int sio_timeout;
static int sio_timeouts_until_log;
static struct callout sio_timeout_handle;
static int sio_numunits;
#ifdef COM_ESP
static Port_t likely_com_ports[] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, };
static Port_t likely_esp_ports[] = { 0x140, 0x180, 0x280, 0 };
#endif
static int
sysctl_machdep_comdefaultrate(SYSCTL_HANDLER_ARGS)
{
int error;
speed_t newspeed;
struct com_s *com;
struct tty *tp;
lwkt_gettoken(&tty_token);
newspeed = comdefaultrate;
error = sysctl_handle_opaque(oidp, &newspeed, sizeof newspeed, req);
if (error || !req->newptr) {
lwkt_reltoken(&tty_token);
return (error);
}
comdefaultrate = newspeed;
if (comconsole < 0) {
lwkt_reltoken(&tty_token);
return (0);
}
com = com_addr(comconsole);
if (com == NULL) {
lwkt_reltoken(&tty_token);
return (ENXIO);
}
com->it_in.c_ispeed = com->it_in.c_ospeed =
com->lt_in.c_ispeed = com->lt_in.c_ospeed =
com->it_out.c_ispeed = com->it_out.c_ospeed =
com->lt_out.c_ispeed = com->lt_out.c_ospeed = comdefaultrate;
tp = com->tp;
if (tp && (tp->t_state & TS_ISOPEN)) {
tp->t_termios.c_ispeed =
tp->t_termios.c_ospeed = comdefaultrate;
crit_enter();
error = comparam(tp, &tp->t_termios);
crit_exit();
}
lwkt_reltoken(&tty_token);
return error;
}
SYSCTL_PROC(_machdep, OID_AUTO, conspeed, CTLTYPE_INT | CTLFLAG_RW,
0, 0, sysctl_machdep_comdefaultrate, "I", "");
#if NPCI > 0
struct pci_ids {
u_int32_t type;
const char *desc;
int rid;
};
static struct pci_ids pci_ids[] = {
{ 0x100812b9, "3COM PCI FaxModem", 0x10 },
{ 0x2000131f, "CyberSerial (1-port) 16550", 0x10 },
{ 0x01101407, "Koutech IOFLEX-2S PCI Dual Port Serial", 0x10 },
{ 0x01111407, "Koutech IOFLEX-2S PCI Dual Port Serial", 0x10 },
{ 0x048011c1, "Lucent kermit based PCI Modem", 0x14 },
{ 0x95211415, "Oxford Semiconductor PCI Dual Port Serial", 0x10 },
{ 0x7101135e, "SeaLevel Ultra 530.PCI Single Port Serial", 0x18 },
{ 0x0000151f, "SmartLink 5634PCV SurfRider", 0x10 },
{ 0x98459710, "Netmos Nm9845 PCI Bridge with Dual UART", 0x10 },
{ 0x99229710, "MCS9922 PCIe Multi-I/O Controller", 0x10 },
{ 0x8c3d8086, "Intel Lynx Point KT Controller", 0x10 },
{ 0x9c3d8086, "Intel Lynx Point-LP HECI KT", 0x10 },
{ 0x8cbd8086, "Intel Wildcat Point KT Controller", 0x10 },
{ 0x9cbd8086, "Intel Wildcat Point-LP KT Controller", 0x10 },
{ 0x00000000, NULL, 0 }
};
static int
sio_pci_attach(device_t dev)
{
u_int32_t type;
struct pci_ids *id;
type = pci_get_devid(dev);
id = pci_ids;
while (id->type && id->type != type)
id++;
if (id->desc == NULL)
return (ENXIO);
sio_pci_kludge_unit(dev);
return (sioattach(dev, id->rid, 0UL));
}
static void
sio_pci_kludge_unit(device_t dev)
{
devclass_t dc;
int err;
int start;
int unit;
unit = 0;
start = 0;
while (resource_int_value("sio", unit, "port", &start) == 0 &&
start > 0)
unit++;
if (device_get_unit(dev) < unit) {
dc = device_get_devclass(dev);
while (devclass_get_device(dc, unit))
unit++;
device_printf(dev, "moving to sio%d\n", unit);
err = device_set_unit(dev, unit);
if (err)
device_printf(dev, "error moving device %d\n", err);
}
}
static int
sio_pci_probe(device_t dev)
{
u_int32_t type;
struct pci_ids *id;
type = pci_get_devid(dev);
id = pci_ids;
while (id->type && id->type != type)
id++;
if (id->desc == NULL)
return (ENXIO);
device_set_desc(dev, id->desc);
return (sioprobe(dev, id->rid, 0UL));
}
#endif
#if NPUC > 0
static int
sio_puc_attach(device_t dev)
{
uintptr_t rclk;
if (BUS_READ_IVAR(device_get_parent(dev), dev, PUC_IVAR_FREQ,
&rclk) != 0)
rclk = DEFAULT_RCLK;
return (sioattach(dev, 0, rclk));
}
static int
sio_puc_probe(device_t dev)
{
uintptr_t rclk;
if (BUS_READ_IVAR(device_get_parent(dev), dev, PUC_IVAR_FREQ,
&rclk) != 0)
rclk = DEFAULT_RCLK;
return (sioprobe(dev, 0, rclk));
}
#endif
static struct isa_pnp_id sio_ids[] = {
{0x0005d041, "Standard PC COM port"},
{0x0105d041, "16550A-compatible COM port"},
{0x0205d041, "Multiport serial device (non-intelligent 16550)"},
{0x1005d041, "Generic IRDA-compatible device"},
{0x1105d041, "Generic IRDA-compatible device"},
{0x12206804, NULL},
{0x7602a904, NULL},
{0x00007905, NULL},
{0x21107905, NULL},
{0x01405407, NULL},
{0x56039008, NULL},
{0x56159008, NULL},
{0x36339008, NULL},
{0x0014490a, NULL},
{0x0015490a, NULL},
{0x0034490a, NULL},
{0x0094490a, NULL},
{0x00b4490a, NULL},
{0x0030320d, NULL},
{0x0100440e, NULL},
{0x01308c0e, NULL},
{0x36033610, NULL},
{0x01009416, NULL},
{0x0000aa1a, NULL},
{0x1200c31e, NULL},
{0x0303c31e, NULL},
{0x0505c31e, NULL},
{0x0116c31e, NULL},
{0x0050c31e, NULL},
{0x3800f91e, NULL},
{0x9062f91e, NULL},
{0x8100e425, NULL},
{0x21002534, NULL},
{0x0000f435, NULL},
{0x5015f435, NULL},
{0xf015f435, NULL},
{0x6045f435, NULL},
{0x61e7a338, NULL},
{0x08804f3f, NULL},
{0x0f804f3f, NULL},
{0x39804f3f, NULL},
{0x00914f3f, NULL},
{0x3024a341, NULL},
{0x1000eb49, NULL},
{0x1200b23d, NULL},
{0x5002734a, NULL},
{0x6202734a, NULL},
{0x1010104d, NULL},
{0xc100ad4d, NULL},
{0x9012b04e, NULL},
{0x1013b04e, NULL},
{0x8013b04e, NULL},
{0x8113b04e, NULL},
{0x5016b04e, NULL},
{0x7016b04e, NULL},
{0x7420b04e, NULL},
{0x8020b04e, NULL},
{0x8420b04e, NULL},
{0x7121b04e, NULL},
{0x8024b04e, NULL},
{0x01007256, NULL},
{0x02007256, NULL},
{0x04007256, NULL},
{0x06007256, NULL},
{0x11007256, NULL},
{0x01017256, NULL},
{0x30207256, NULL},
{0x50207256, NULL},
{0x70207256, NULL},
{0x30307256, NULL},
{0x31307256, NULL},
{0x50307256, NULL},
{0x70307256, NULL},
{0x90307256, NULL},
{0x70917256, NULL},
{0x90917256, NULL},
{0x0300695c, NULL},
{0x01a0896a, NULL},
{0x61f7896a, NULL},
{0}
};
static int
sio_isa_probe(device_t dev)
{
if (ISA_PNP_PROBE(device_get_parent(dev), dev, sio_ids) == ENXIO)
return (ENXIO);
return (sioprobe(dev, 0, 0UL));
}
int
sioprobe(device_t dev, int xrid, u_long rclk)
{
#if 0
static bool_t already_init;
device_t xdev;
#endif
struct com_s *com;
u_int divisor;
bool_t failures[10];
int fn;
device_t idev;
Port_t iobase;
intrmask_t irqmap[4];
intrmask_t irqs;
u_char mcr_image;
int result;
u_long xirq;
u_int flags = device_get_flags(dev);
int rid;
struct resource *port;
rid = xrid;
port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
0, ~0, IO_COMSIZE, RF_ACTIVE);
if (!port)
return (ENXIO);
lwkt_gettoken(&tty_token);
com = device_get_softc(dev);
com->bst = rman_get_bustag(port);
com->bsh = rman_get_bushandle(port);
if (rclk == 0)
rclk = DEFAULT_RCLK;
com->rclk = rclk;
#if 0
if (!already_init) {
device_t *devs;
int count, i, xioport;
devclass_get_devices(sio_devclass, &devs, &count);
for (i = 0; i < count; i++) {
xdev = devs[i];
if (device_is_enabled(xdev) &&
bus_get_resource(xdev, SYS_RES_IOPORT, 0, &xioport,
NULL) == 0)
outb(xioport + com_mcr, 0);
}
kfree(devs, M_TEMP);
already_init = TRUE;
}
#endif
if (COM_LLCONSOLE(flags)) {
kprintf("sio%d: reserved for low-level i/o\n",
device_get_unit(dev));
bus_release_resource(dev, SYS_RES_IOPORT, rid, port);
lwkt_reltoken(&tty_token);
return (ENXIO);
}
idev = dev;
mcr_image = MCR_IENABLE;
#ifdef COM_MULTIPORT
if (COM_ISMULTIPORT(flags)) {
Port_t xiobase;
u_long io;
idev = devclass_get_device(sio_devclass, COM_MPMASTER(flags));
if (idev == NULL) {
kprintf("sio%d: master device %d not configured\n",
device_get_unit(dev), COM_MPMASTER(flags));
idev = dev;
}
if (!COM_NOTAST4(flags)) {
if (bus_get_resource(idev, SYS_RES_IOPORT, 0, &io,
NULL) == 0) {
xiobase = io;
if (bus_get_resource(idev, SYS_RES_IRQ, 0,
NULL, NULL) == 0)
outb(xiobase + com_scr, 0x80);
else
outb(xiobase + com_scr, 0);
}
mcr_image = 0;
}
}
#endif
if (bus_get_resource(idev, SYS_RES_IRQ, 0, NULL, NULL) != 0)
mcr_image = 0;
bzero(failures, sizeof failures);
iobase = rman_get_start(port);
com_lock();
if (COM_TI16754(flags)) {
u_char cfcr, efr;
cfcr = sio_getreg(com, com_cfcr);
sio_setreg(com, com_cfcr, CFCR_EFR_ENABLE);
efr = sio_getreg(com, com_efr);
sio_setreg(com, com_efr, efr | EFR_EFE);
sio_setreg(com, com_cfcr, (cfcr != CFCR_EFR_ENABLE) ? cfcr : 0);
sio_setreg(com, com_mcr,
sio_getreg(com, com_mcr) & ~MCR_PRESCALE);
sio_setreg(com, com_cfcr, CFCR_EFR_ENABLE);
sio_setreg(com, com_efr, efr);
sio_setreg(com, com_cfcr, cfcr);
}
if (iobase == siocniobase) {
DELAY((16 + 1) * 1000000 / (comdefaultrate / 10));
} else {
sio_setreg(com, com_cfcr, CFCR_DLAB | CFCR_8BITS);
divisor = siodivisor(rclk, SIO_TEST_SPEED);
sio_setreg(com, com_dlbl, divisor & 0xff);
sio_setreg(com, com_dlbh, divisor >> 8);
sio_setreg(com, com_cfcr, CFCR_8BITS);
DELAY((16 + 1) * 1000000 / (SIO_TEST_SPEED / 10));
}
for (fn = 0; fn < 256; ++fn) {
if ((sio_getreg(com, com_lsr) & LSR_RXRDY) == 0)
break;
(void)sio_getreg(com, com_data);
}
if (fn == 256) {
com_unlock();
lwkt_reltoken(&tty_token);
kprintf("sio%d: can't drain, serial port might "
"not exist, disabling\n", device_get_unit(dev));
com->flags &= ~0x30;
resource_set_int("sio", device_get_unit(dev), "disabled", 1);
return (ENXIO);
}
sio_setreg(com, com_mcr, mcr_image);
sio_setreg(com, com_ier, 0);
DELAY(1000);
irqmap[0] = isa_irq_pending();
sio_setreg(com, com_mcr, mcr_image | MCR_LOOPBACK);
sio_setreg(com, com_ier, IER_ETXRDY);
sio_setreg(com, com_data, 0);
DELAY((1 + 2) * 1000000 / (SIO_TEST_SPEED / 10));
sio_setreg(com, com_mcr, mcr_image);
if (COM_NOPROBE(flags)) {
for (fn = 0; fn < 2; fn ++) {
DELAY(10000);
failures[6] = sio_getreg(com, com_iir);
}
result = 0;
if (failures[6] & IIR_TXRDY) {
sio_setreg(com, com_ier, 0);
if (sio_getreg(com, com_iir) & IIR_NOPEND) {
SET_FLAG(dev, COM_C_IIR_TXRDYBUG);
} else {
result = ENXIO;
sio_setreg(com, com_mcr, 0);
}
} else {
CLR_FLAG(dev, COM_C_IIR_TXRDYBUG);
}
sio_setreg(com, com_ier, 0);
sio_setreg(com, com_cfcr, CFCR_8BITS);
com_unlock();
bus_release_resource(dev, SYS_RES_IOPORT, rid, port);
lwkt_reltoken(&tty_token);
return (iobase == siocniobase ? 0 : result);
}
failures[0] = sio_getreg(com, com_cfcr) - CFCR_8BITS;
failures[1] = sio_getreg(com, com_ier) - IER_ETXRDY;
failures[2] = sio_getreg(com, com_mcr) - mcr_image;
DELAY(10000);
irqmap[1] = isa_irq_pending();
failures[4] = (sio_getreg(com, com_iir) & IIR_IMASK) - IIR_TXRDY;
DELAY(1000);
irqmap[2] = isa_irq_pending();
failures[6] = (sio_getreg(com, com_iir) & IIR_IMASK) - IIR_NOPEND;
sio_setreg(com, com_ier, 0);
sio_setreg(com, com_cfcr, CFCR_8BITS);
failures[7] = sio_getreg(com, com_ier);
DELAY(1000);
irqmap[3] = isa_irq_pending();
failures[9] = (sio_getreg(com, com_iir) & IIR_IMASK) - IIR_NOPEND;
com_unlock();
irqs = irqmap[1] & ~irqmap[0];
if (bus_get_resource(idev, SYS_RES_IRQ, 0, &xirq, NULL) == 0 &&
((1 << xirq) & irqs) == 0)
kprintf(
"sio%d: configured irq %ld not in bitmap of probed irqs %#x\n",
device_get_unit(dev), xirq, irqs);
if (bootverbose)
kprintf("sio%d: irq maps: %#x %#x %#x %#x\n",
device_get_unit(dev),
irqmap[0], irqmap[1], irqmap[2], irqmap[3]);
result = 0;
for (fn = 0; fn < sizeof failures; ++fn)
if (failures[fn]) {
sio_setreg(com, com_mcr, 0);
result = ENXIO;
if (bootverbose) {
kprintf("sio%d: probe failed test(s):",
device_get_unit(dev));
for (fn = 0; fn < sizeof failures; ++fn)
if (failures[fn])
kprintf(" %d", fn);
kprintf("\n");
}
break;
}
bus_release_resource(dev, SYS_RES_IOPORT, rid, port);
lwkt_reltoken(&tty_token);
return (iobase == siocniobase ? 0 : result);
}
#ifdef COM_ESP
static int
espattach(struct com_s *com, Port_t esp_port)
{
u_char dips;
u_char val;
if ((inb(esp_port) & 0xf3) == 0) {
kprintf(" port 0x%x is not an ESP board?\n", esp_port);
return (0);
}
lwkt_gettoken(&tty_token);
outb(esp_port + ESP_CMD1, ESP_GETDIPS);
dips = inb(esp_port + ESP_STATUS1);
if (rman_get_start(com->ioportres) == likely_com_ports[dips & 0x03])
kprintf(" : ESP");
else {
kprintf(" esp_port has com %d\n", dips & 0x03);
lwkt_reltoken(&tty_token);
return (0);
}
outb(esp_port + ESP_CMD1, ESP_GETTEST);
val = inb(esp_port + ESP_STATUS1);
val = inb(esp_port + ESP_STATUS2);
if ((val & 0x70) < 0x20) {
kprintf("-old (%o)", val & 0x70);
lwkt_reltoken(&tty_token);
return (0);
}
if ((dips & 0x80) == 0) {
kprintf(" slave");
lwkt_reltoken(&tty_token);
return (0);
}
com->esp = TRUE;
com->esp_port = esp_port;
lwkt_reltoken(&tty_token);
return (1);
}
#endif
static int
sio_isa_attach(device_t dev)
{
return (sioattach(dev, 0, 0UL));
}
int
sioattach(device_t dev, int xrid, u_long rclk)
{
struct com_s *com;
#ifdef COM_ESP
Port_t *espp;
#endif
Port_t iobase;
int minorbase;
int unit;
u_int flags;
int rid;
struct resource *port;
int ret;
char tbuf[MAKEDEV_MINNBUF];
char *unit_in_base32;
static int did_init;
lwkt_gettoken(&tty_token);
if (did_init == 0) {
did_init = 1;
callout_init_mp(&sio_timeout_handle);
}
rid = xrid;
port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
0, ~0, IO_COMSIZE, RF_ACTIVE);
if (!port) {
lwkt_reltoken(&tty_token);
return (ENXIO);
}
iobase = rman_get_start(port);
unit = device_get_unit(dev);
com = device_get_softc(dev);
flags = device_get_flags(dev);
if (unit >= sio_numunits)
sio_numunits = unit + 1;
bzero(com, sizeof *com);
com->unit = unit;
com->ioportres = port;
com->bst = rman_get_bustag(port);
com->bsh = rman_get_bushandle(port);
com->cfcr_image = CFCR_8BITS;
com->dtr_wait = 3 * hz;
callout_init_mp(&com->dtr_ch);
callout_init_mp(&com->busy_ch);
com->loses_outints = COM_LOSESOUTINTS(flags) != 0;
com->no_irq = bus_get_resource(dev, SYS_RES_IRQ, 0, NULL, NULL) != 0;
com->tx_fifo_size = 1;
com->obufs[0].l_head = com->obuf1;
com->obufs[1].l_head = com->obuf2;
com->data_port = iobase + com_data;
com->int_id_port = iobase + com_iir;
com->modem_ctl_port = iobase + com_mcr;
com->mcr_image = inb(com->modem_ctl_port);
com->line_status_port = iobase + com_lsr;
com->modem_status_port = iobase + com_msr;
com->intr_ctl_port = iobase + com_ier;
if (rclk == 0)
rclk = DEFAULT_RCLK;
com->rclk = rclk;
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;
com->lt_out.c_ispeed = com->lt_out.c_ospeed =
com->lt_in.c_ispeed = com->lt_in.c_ospeed =
com->it_in.c_ispeed = com->it_in.c_ospeed = comdefaultrate;
} else
com->it_in.c_ispeed = com->it_in.c_ospeed = TTYDEF_SPEED;
if (siosetwater(com, com->it_in.c_ispeed) != 0) {
if (iobase != siocniobase)
bus_release_resource(dev, SYS_RES_IOPORT, rid, port);
lwkt_reltoken(&tty_token);
return (ENOMEM);
}
termioschars(&com->it_in);
com->it_out = com->it_in;
kprintf("sio%d: type", unit);
#ifdef COM_MULTIPORT
if (!COM_ISMULTIPORT(flags) && !COM_IIR_TXRDYBUG(flags))
#else
if (!COM_IIR_TXRDYBUG(flags))
#endif
{
u_char scr;
u_char scr1;
u_char scr2;
scr = sio_getreg(com, com_scr);
sio_setreg(com, com_scr, 0xa5);
scr1 = sio_getreg(com, com_scr);
sio_setreg(com, com_scr, 0x5a);
scr2 = sio_getreg(com, com_scr);
sio_setreg(com, com_scr, scr);
if (scr1 != 0xa5 || scr2 != 0x5a) {
kprintf(" 8250");
goto determined_type;
}
}
sio_setreg(com, com_fifo, FIFO_ENABLE | FIFO_RX_HIGH);
DELAY(100);
com->st16650a = 0;
switch (inb(com->int_id_port) & IIR_FIFO_MASK) {
case FIFO_RX_LOW:
kprintf(" 16450");
break;
case FIFO_RX_MEDL:
kprintf(" 16450?");
break;
case FIFO_RX_MEDH:
kprintf(" 16550?");
break;
case FIFO_RX_HIGH:
if (COM_NOFIFO(flags)) {
kprintf(" 16550A fifo disabled");
} else {
com->hasfifo = TRUE;
if (COM_ST16650A(flags)) {
com->st16650a = 1;
com->tx_fifo_size = 32;
kprintf(" ST16650A");
} else if (COM_TI16754(flags)) {
com->tx_fifo_size = 64;
kprintf(" TI16754");
} else {
com->tx_fifo_size = COM_FIFOSIZE(flags);
kprintf(" 16550A");
}
}
#ifdef COM_ESP
for (espp = likely_esp_ports; *espp != 0; espp++)
if (espattach(com, *espp)) {
com->tx_fifo_size = 1024;
break;
}
#endif
if (!com->st16650a && !COM_TI16754(flags)) {
if (!com->tx_fifo_size)
com->tx_fifo_size = 16;
else
kprintf(" lookalike with %d bytes FIFO",
com->tx_fifo_size);
}
break;
}
#ifdef COM_ESP
if (com->esp) {
outb(com->esp_port + ESP_CMD1, ESP_SETMODE);
outb(com->esp_port + ESP_CMD2, ESP_MODE_RTS | ESP_MODE_FIFO);
outb(com->esp_port + ESP_CMD1, ESP_SETFLOWTYPE);
outb(com->esp_port + ESP_CMD2, ESP_FLOW_RTS);
outb(com->esp_port + ESP_CMD2, ESP_FLOW_CTS);
outb(com->esp_port + ESP_CMD1, ESP_SETRXFLOW);
outb(com->esp_port + ESP_CMD2, HIBYTE(768));
outb(com->esp_port + ESP_CMD2, LOBYTE(768));
outb(com->esp_port + ESP_CMD2, HIBYTE(512));
outb(com->esp_port + ESP_CMD2, LOBYTE(512));
}
#endif
sio_setreg(com, com_fifo, 0);
determined_type: ;
#ifdef COM_MULTIPORT
if (COM_ISMULTIPORT(flags)) {
device_t masterdev;
com->multiport = TRUE;
kprintf(" (multiport");
if (unit == COM_MPMASTER(flags))
kprintf(" master");
kprintf(")");
masterdev = devclass_get_device(sio_devclass,
COM_MPMASTER(flags));
com->no_irq = (masterdev == NULL || bus_get_resource(masterdev,
SYS_RES_IRQ, 0, NULL, NULL) != 0);
}
#endif
if (unit == comconsole)
kprintf(", console");
if (COM_IIR_TXRDYBUG(flags))
kprintf(" with a bogus IIR_TXRDY register");
kprintf("\n");
if (!sio_registered) {
register_swi_mp(SWI_TTY, siopoll, NULL,
"swi_siopoll", NULL, -1);
sio_registered = TRUE;
}
minorbase = UNIT_TO_MINOR(unit);
unit_in_base32 = makedev_unit_b32(tbuf, unit);
make_dev(&sio_ops, minorbase,
UID_ROOT, GID_WHEEL, 0600, "ttyd%s", unit_in_base32);
make_dev(&sio_ops, minorbase | CONTROL_INIT_STATE,
UID_ROOT, GID_WHEEL, 0600, "ttyid%s", unit_in_base32);
make_dev(&sio_ops, minorbase | CONTROL_LOCK_STATE,
UID_ROOT, GID_WHEEL, 0600, "ttyld%s", unit_in_base32);
make_dev(&sio_ops, minorbase | CALLOUT_MASK,
UID_UUCP, GID_DIALER, 0660, "cuaa%s", unit_in_base32);
make_dev(&sio_ops, minorbase | CALLOUT_MASK | CONTROL_INIT_STATE,
UID_UUCP, GID_DIALER, 0660, "cuaia%s", unit_in_base32);
make_dev(&sio_ops, minorbase | CALLOUT_MASK | CONTROL_LOCK_STATE,
UID_UUCP, GID_DIALER, 0660, "cuala%s", unit_in_base32);
com->flags = flags;
com->pps.ppscap = PPS_CAPTUREASSERT | PPS_CAPTURECLEAR;
pps_init(&com->pps);
rid = 0;
com->irqres = bus_alloc_resource(dev, SYS_RES_IRQ, &rid, 0ul, ~0ul, 1,
RF_ACTIVE);
if (com->irqres) {
ret = BUS_SETUP_INTR(device_get_parent(dev), dev,
com->irqres, INTR_MPSAFE, siointr, com,
&com->cookie, NULL, NULL);
if (ret)
device_printf(dev, "could not activate interrupt\n");
#if defined(DDB)
if (ret == 0 && unit == comconsole &&
(break_to_debugger || alt_break_to_debugger)) {
inb(siocniobase + com_data);
outb(siocniobase + com_ier,
IER_ERXRDY | IER_ERLS | IER_EMSC);
}
#endif
}
lwkt_reltoken(&tty_token);
return (0);
}
static int
sioopen(struct dev_open_args *ap)
{
cdev_t dev = ap->a_head.a_dev;
struct com_s *com;
int error;
int mynor;
struct tty *tp;
int unit;
mynor = minor(dev);
unit = MINOR_TO_UNIT(mynor);
com = com_addr(unit);
if (com == NULL)
return (ENXIO);
if (com->gone)
return (ENXIO);
if (mynor & CONTROL_MASK)
return (0);
lwkt_gettoken(&tty_token);
tp = ttymalloc(&com->tp);
dev->si_tty = tp;
crit_enter();
open_top:
while (com->state & CS_DTR_OFF) {
error = tsleep(&com->dtr_wait, PCATCH, "siodtr", 0);
if (com_addr(unit) == NULL) {
crit_exit();
lwkt_reltoken(&tty_token);
return (ENXIO);
}
if (error != 0 || com->gone)
goto out;
}
if (tp->t_state & TS_ISOPEN) {
if (mynor & CALLOUT_MASK) {
if (!com->active_out) {
error = EBUSY;
goto out;
}
} else {
if (com->active_out) {
if (ap->a_oflags & O_NONBLOCK) {
error = EBUSY;
goto out;
}
error = tsleep(&com->active_out,
PCATCH, "siobi", 0);
if (com_addr(unit) == NULL) {
crit_exit();
lwkt_reltoken(&tty_token);
return (ENXIO);
}
if (error != 0 || com->gone)
goto out;
goto open_top;
}
}
if ((tp->t_state & TS_XCLUDE) &&
caps_priv_check(ap->a_cred, SYSCAP_RESTRICTEDROOT))
{
error = EBUSY;
goto out;
}
} else {
tp->t_oproc = comstart;
tp->t_param = comparam;
tp->t_stop = comstop;
tp->t_dev = dev;
tp->t_termios = mynor & CALLOUT_MASK
? com->it_out : com->it_in;
(void)commctl(com, TIOCM_DTR | TIOCM_RTS, DMSET);
com->poll = com->no_irq;
com->poll_output = com->loses_outints;
++com->wopeners;
error = comparam(tp, &tp->t_termios);
--com->wopeners;
if (error != 0)
goto out;
if (com->hasfifo) {
while (TRUE) {
sio_setreg(com, com_fifo,
FIFO_RCV_RST | FIFO_XMT_RST
| com->fifo_image);
DELAY(50);
if (!(inb(com->line_status_port) & LSR_RXRDY))
break;
sio_setreg(com, com_fifo, 0);
DELAY(50);
(void) inb(com->data_port);
}
}
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);
if (COM_IIR_TXRDYBUG(com->flags)) {
outb(com->intr_ctl_port, IER_ERXRDY | IER_ERLS
| IER_EMSC);
} else {
outb(com->intr_ctl_port, IER_ERXRDY | IER_ETXRDY
| IER_ERLS | IER_EMSC);
}
com_unlock();
if (com->prev_modem_status & MSR_DCD || mynor & CALLOUT_MASK)
(*linesw[tp->t_line].l_modem)(tp, 1);
}
if (!(tp->t_state & TS_CARR_ON) && !(mynor & CALLOUT_MASK)
&& !(tp->t_cflag & CLOCAL) && !(ap->a_oflags & O_NONBLOCK)) {
++com->wopeners;
error = tsleep(TSA_CARR_ON(tp), PCATCH, "siodcd", 0);
if (com_addr(unit) == NULL) {
crit_exit();
lwkt_reltoken(&tty_token);
return (ENXIO);
}
--com->wopeners;
if (error != 0 || com->gone)
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:
crit_exit();
if (!(tp->t_state & TS_ISOPEN) && com->wopeners == 0)
comhardclose(com);
lwkt_reltoken(&tty_token);
return (error);
}
static int
sioclose(struct dev_close_args *ap)
{
cdev_t dev = ap->a_head.a_dev;
struct com_s *com;
int mynor;
struct tty *tp;
mynor = minor(dev);
if (mynor & CONTROL_MASK)
return (0);
lwkt_gettoken(&tty_token);
com = com_addr(MINOR_TO_UNIT(mynor));
if (com == NULL) {
lwkt_reltoken(&tty_token);
return (ENODEV);
}
tp = com->tp;
crit_enter();
(*linesw[tp->t_line].l_close)(tp, ap->a_fflag);
disc_optim(tp, &tp->t_termios, com);
comstop(tp, FREAD | FWRITE);
comhardclose(com);
ttyclose(tp);
siosettimeout();
crit_exit();
if (com->gone) {
kprintf("sio%d: gone\n", com->unit);
crit_enter();
if (com->ibuf != NULL)
kfree(com->ibuf, M_DEVBUF);
bzero(tp, sizeof *tp);
crit_exit();
}
lwkt_reltoken(&tty_token);
return (0);
}
static void
comhardclose(struct com_s *com)
{
struct tty *tp;
crit_enter();
lwkt_gettoken(&tty_token);
com->poll = FALSE;
com->poll_output = FALSE;
com->do_timestamp = FALSE;
com->do_dcd_timestamp = FALSE;
com->pps.ppsparam.mode = 0;
sio_setreg(com, com_cfcr, com->cfcr_image &= ~CFCR_SBREAK);
tp = com->tp;
#if defined(DDB)
if (com->unit != comconsole ||
(break_to_debugger == 0 && alt_break_to_debugger == 0))
#endif
{
sio_setreg(com, com_ier, 0);
if (tp->t_cflag & HUPCL
|| (!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);
if (com->dtr_wait != 0 && !(com->state & CS_DTR_OFF)) {
callout_reset(&com->dtr_ch, com->dtr_wait,
siodtrwakeup, com);
com->state |= CS_DTR_OFF;
}
}
}
if (com->hasfifo) {
sio_setreg(com, com_fifo, 0);
}
com->active_out = FALSE;
wakeup(&com->active_out);
wakeup(TSA_CARR_ON(tp));
lwkt_reltoken(&tty_token);
crit_exit();
}
static int
sioread(struct dev_read_args *ap)
{
cdev_t dev = ap->a_head.a_dev;
int mynor, ret;
struct com_s *com;
lwkt_gettoken(&tty_token);
mynor = minor(dev);
if (mynor & CONTROL_MASK) {
lwkt_reltoken(&tty_token);
return (ENODEV);
}
com = com_addr(MINOR_TO_UNIT(mynor));
if (com == NULL || com->gone) {
lwkt_reltoken(&tty_token);
return (ENODEV);
}
ret = ((*linesw[com->tp->t_line].l_read)(com->tp, ap->a_uio, ap->a_ioflag));
lwkt_reltoken(&tty_token);
return ret;
}
static int
siowrite(struct dev_write_args *ap)
{
cdev_t dev = ap->a_head.a_dev;
int mynor;
struct com_s *com;
int unit, ret;
lwkt_gettoken(&tty_token);
mynor = minor(dev);
if (mynor & CONTROL_MASK) {
lwkt_reltoken(&tty_token);
return (ENODEV);
}
unit = MINOR_TO_UNIT(mynor);
com = com_addr(unit);
if (com == NULL || com->gone) {
lwkt_reltoken(&tty_token);
return (ENODEV);
}
if (constty != NULL && unit == comconsole)
constty = NULL;
ret = ((*linesw[com->tp->t_line].l_write)(com->tp, ap->a_uio, ap->a_ioflag));
lwkt_reltoken(&tty_token);
return ret;
}
static void
siobusycheck(void *chan)
{
struct com_s *com;
lwkt_gettoken(&tty_token);
com = (struct com_s *)chan;
crit_enter();
if (com->state & CS_BUSY)
com->extra_state &= ~CSE_BUSYCHECK;
else if ((inb(com->line_status_port) & (LSR_TSRE | LSR_TXRDY))
== (LSR_TSRE | LSR_TXRDY)) {
com->tp->t_state &= ~TS_BUSY;
ttwwakeup(com->tp);
com->extra_state &= ~CSE_BUSYCHECK;
} else {
callout_reset(&com->busy_ch, hz / 100, siobusycheck, com);
}
crit_exit();
lwkt_reltoken(&tty_token);
}
static u_int
siodivisor(u_long rclk, speed_t speed)
{
long actual_speed;
u_int divisor;
int error;
if (speed == 0 || speed > ((speed_t)-1 - 1) / 8)
return (0);
divisor = (rclk / (8UL * speed) + 1) / 2;
if (divisor == 0 || divisor >= 65536)
return (0);
actual_speed = rclk / (16UL * divisor);
error = ((actual_speed - (long)speed) * 2000 / (long)speed + 1) / 2;
if (error < -30 || error > 30)
return (0);
return (divisor);
}
static void
siodtrwakeup(void *chan)
{
struct com_s *com;
lwkt_gettoken(&tty_token);
com = (struct com_s *)chan;
com->state &= ~CS_DTR_OFF;
wakeup(&com->dtr_wait);
lwkt_reltoken(&tty_token);
}
#define SIOCOPYSIZE 64
static void
sioinput(struct com_s *com)
{
u_char line_status;
int recv_data;
int incc;
int i;
struct tty *tp;
uint8_t buf[SIOCOPYSIZE];
tp = com->tp;
again:
if (!(tp->t_state & TS_ISOPEN) || !(tp->t_cflag & CREAD)) {
com->iptr = com->ibuf;
return;
}
incc = com->iptr - com->ibuf;
if (incc > SIOCOPYSIZE) {
bcopy(com->ibuf, buf, SIOCOPYSIZE);
bcopy(com->ibuf + SIOCOPYSIZE, com->ibuf, incc - SIOCOPYSIZE);
com->iptr = com->ibuf + incc - SIOCOPYSIZE;
incc = SIOCOPYSIZE;
} else {
bcopy(com->ibuf, buf, incc);
com->iptr = com->ibuf;
}
line_status = com->iptr[com->ierroff];
if ((com->state & CS_RTS_IFLOW) && !(com->mcr_image & MCR_RTS) &&
!(tp->t_state & TS_TBLOCK)) {
outb(com->modem_ctl_port, com->mcr_image |= MCR_RTS);
}
com_unlock();
for (i = 0; i < incc; ++i) {
recv_data = buf[i];
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);
line_status = 0;
}
com_lock();
if (com->iptr != com->ibuf)
goto again;
}
static void
siointr(void *arg)
{
lwkt_gettoken(&tty_token);
#ifndef COM_MULTIPORT
com_lock();
siointr1((struct com_s *) arg);
com_unlock();
#else
bool_t possibly_more_intrs;
int unit;
struct com_s *com;
com_lock();
do {
possibly_more_intrs = FALSE;
for (unit = 0; unit < sio_numunits; ++unit) {
com = com_addr(unit);
if (com != NULL
&& !com->gone
&& (inb(com->int_id_port) & IIR_IMASK)
!= IIR_NOPEND) {
siointr1(com);
possibly_more_intrs = TRUE;
}
}
} while (possibly_more_intrs);
com_unlock();
#endif
lwkt_reltoken(&tty_token);
}
static void
siointr1(struct com_s *com)
{
u_char line_status;
u_char modem_status;
u_char *ioptr;
u_char recv_data;
u_char int_ctl;
u_char int_ctl_new;
sysclock_t count;
int_ctl = inb(com->intr_ctl_port);
int_ctl_new = int_ctl;
while (!com->gone) {
if (com->pps.ppsparam.mode & PPS_CAPTUREBOTH) {
modem_status = inb(com->modem_status_port);
if ((modem_status ^ com->last_modem_status) & MSR_DCD) {
count = sys_cputimer->count();
pps_event(&com->pps, count,
(modem_status & MSR_DCD) ?
PPS_CAPTUREASSERT : PPS_CAPTURECLEAR);
}
}
line_status = inb(com->line_status_port);
while (line_status & LSR_RCV_MASK) {
if (!(line_status & LSR_RXRDY))
recv_data = 0;
else
recv_data = inb(com->data_port);
#if defined(DDB)
#define KEY_CRTLB 2
#define KEY_CR 13
#define KEY_TILDE 126
if (com->unit == comconsole && alt_break_to_debugger) {
static int brk_state1 = 0, brk_state2 = 0;
if (recv_data == KEY_CR) {
brk_state1 = recv_data;
brk_state2 = 0;
} else if (brk_state1 == KEY_CR && (recv_data == KEY_TILDE || recv_data == KEY_CRTLB)) {
if (recv_data == KEY_TILDE)
brk_state2 = recv_data;
else if (brk_state2 == KEY_TILDE && recv_data == KEY_CRTLB) {
com_unlock();
breakpoint();
com_lock();
brk_state1 = brk_state2 = 0;
goto cont;
} else
brk_state2 = 0;
} else
brk_state1 = 0;
}
#endif
if (line_status & (LSR_BI | LSR_FE | LSR_PE)) {
if (line_status & LSR_BI) {
#if defined(DDB)
if (com->unit == comconsole &&
break_to_debugger) {
com_unlock();
breakpoint();
com_lock();
goto cont;
}
#endif
if (com->tp == NULL
|| com->tp->t_iflag & IGNBRK)
goto cont;
} else {
if (com->tp == NULL
|| com->tp->t_iflag & IGNPAR)
goto cont;
}
if (com->tp->t_state & TS_CAN_BYPASS_L_RINT
&& (line_status & (LSR_BI | LSR_FE)
|| com->tp->t_iflag & INPCK))
recv_data = 0;
}
++com->bytes_in;
if (com->hotchar != 0 && recv_data == com->hotchar)
setsofttty();
ioptr = com->iptr;
if (ioptr >= com->ibufend) {
CE_RECORD(com, CE_INTERRUPT_BUF_OVERFLOW);
} else {
if (com->do_timestamp)
microtime(&com->timestamp);
schedsofttty();
#if 0
if (com->iptr - com->ibuf == 8)
setsofttty();
#endif
ioptr[0] = recv_data;
ioptr[com->ierroff] = line_status;
com->iptr = ++ioptr;
if (ioptr == com->ihighwater
&& com->state & CS_RTS_IFLOW)
outb(com->modem_ctl_port,
com->mcr_image &= ~MCR_RTS);
if (line_status & LSR_OE)
CE_RECORD(com, CE_OVERRUN);
}
cont:
line_status = inb(com->line_status_port) & 0x7F;
}
modem_status = inb(com->modem_status_port);
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);
com->last_modem_status = modem_status;
if (!(com->state & CS_CHECKMSR)) {
com->state |= CS_CHECKMSR;
setsofttty();
}
if (com->state & CS_CTS_OFLOW) {
if (modem_status & MSR_CTS)
com->state |= CS_ODEVREADY;
else
com->state &= ~CS_ODEVREADY;
}
}
if ((line_status & LSR_TXRDY)
&& com->state >= (CS_BUSY | CS_TTGO | CS_ODEVREADY)) {
ioptr = com->obufq.l_head;
if (com->tx_fifo_size > 1) {
u_int ocount;
ocount = com->obufq.l_tail - ioptr;
if (ocount > com->tx_fifo_size)
ocount = com->tx_fifo_size;
com->bytes_out += ocount;
do
outb(com->data_port, *ioptr++);
while (--ocount != 0);
} else {
outb(com->data_port, *ioptr++);
++com->bytes_out;
}
com->obufq.l_head = ioptr;
if (COM_IIR_TXRDYBUG(com->flags)) {
int_ctl_new = int_ctl | IER_ETXRDY;
}
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 {
if (COM_IIR_TXRDYBUG(com->flags)) {
int_ctl_new = int_ctl & ~IER_ETXRDY;
}
com->state &= ~CS_BUSY;
}
if (!(com->state & CS_ODONE)) {
com->state |= CS_ODONE;
setsofttty();
}
}
if (COM_IIR_TXRDYBUG(com->flags) && (int_ctl != int_ctl_new)) {
outb(com->intr_ctl_port, int_ctl_new);
}
}
#ifdef COM_MULTIPORT
return;
#else
if (inb(com->int_id_port) & IIR_NOPEND)
return;
#endif
}
}
static int
sioioctl(struct dev_ioctl_args *ap)
{
cdev_t dev = ap->a_head.a_dev;
caddr_t data = ap->a_data;
struct com_s *com;
int error;
int mynor;
struct tty *tp;
lwkt_gettoken(&tty_token);
mynor = minor(dev);
com = com_addr(MINOR_TO_UNIT(mynor));
if (com == NULL || com->gone) {
lwkt_reltoken(&tty_token);
return (ENODEV);
}
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:
lwkt_reltoken(&tty_token);
return (ENODEV);
}
switch (ap->a_cmd) {
case TIOCSETA:
error = caps_priv_check(ap->a_cred,
SYSCAP_RESTRICTEDROOT);
if (error != 0) {
lwkt_reltoken(&tty_token);
return (error);
}
*ct = *(struct termios *)data;
lwkt_reltoken(&tty_token);
return (0);
case TIOCGETA:
*(struct termios *)data = *ct;
lwkt_reltoken(&tty_token);
return (0);
case TIOCGETD:
*(int *)data = TTYDISC;
lwkt_reltoken(&tty_token);
return (0);
case TIOCGWINSZ:
bzero(data, sizeof(struct winsize));
lwkt_reltoken(&tty_token);
return (0);
default:
lwkt_reltoken(&tty_token);
return (ENOTTY);
}
}
tp = com->tp;
if (ap->a_cmd == TIOCSETA || ap->a_cmd == TIOCSETAW ||
ap->a_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, ap->a_cmd, data, ap->a_fflag, ap->a_cred);
if (error != ENOIOCTL) {
lwkt_reltoken(&tty_token);
return (error);
}
crit_enter();
error = ttioctl(tp, ap->a_cmd, data, ap->a_fflag);
disc_optim(tp, &tp->t_termios, com);
if (error != ENOIOCTL) {
crit_exit();
lwkt_reltoken(&tty_token);
return (error);
}
switch (ap->a_cmd) {
case TIOCSBRK:
sio_setreg(com, com_cfcr, com->cfcr_image |= CFCR_SBREAK);
break;
case TIOCCBRK:
sio_setreg(com, com_cfcr, com->cfcr_image &= ~CFCR_SBREAK);
break;
case TIOCSDTR:
(void)commctl(com, TIOCM_DTR, DMBIS);
break;
case TIOCCDTR:
(void)commctl(com, TIOCM_DTR, DMBIC);
break;
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:
error = caps_priv_check(ap->a_cred, SYSCAP_RESTRICTEDROOT);
if (error != 0) {
crit_exit();
lwkt_reltoken(&tty_token);
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:
crit_exit();
error = pps_ioctl(ap->a_cmd, data, &com->pps);
if (error == ENODEV)
error = ENOTTY;
lwkt_reltoken(&tty_token);
return (error);
}
crit_exit();
lwkt_reltoken(&tty_token);
return (0);
}
static void
siopoll(void *dummy, void *frame)
{
int unit;
int any;
lwkt_gettoken(&tty_token);
repeat:
any = 0;
for (unit = 0; unit < sio_numunits; ++unit) {
struct com_s *com;
int incc;
struct tty *tp;
com = com_addr(unit);
if (com == NULL)
continue;
tp = com->tp;
if (tp == NULL || com->gone) {
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_unlock();
continue;
}
if (com->iptr != com->ibuf) {
com_lock();
sioinput(com);
com_unlock();
any = 1;
}
if (com->state & CS_CHECKMSR) {
u_char delta_modem_status;
com_lock();
delta_modem_status = com->last_modem_status
^ com->prev_modem_status;
com->prev_modem_status = com->last_modem_status;
com->state &= ~CS_CHECKMSR;
com_unlock();
if (delta_modem_status)
any = 1;
if (delta_modem_status & MSR_DCD) {
(*linesw[tp->t_line].l_modem)
(tp, com->prev_modem_status & MSR_DCD);
}
}
if (com->state & CS_ODONE) {
com_lock();
com->state &= ~CS_ODONE;
com_unlock();
if (!(com->state & CS_BUSY)
&& !(com->extra_state & CSE_BUSYCHECK)) {
callout_reset(&com->busy_ch, hz / 100,
siobusycheck, com);
com->extra_state |= CSE_BUSYCHECK;
}
(*linesw[tp->t_line].l_start)(tp);
}
}
if (any)
goto repeat;
lwkt_reltoken(&tty_token);
}
static int
comparam(struct tty *tp, struct termios *t)
{
u_int cfcr;
int cflag;
struct com_s *com;
u_int divisor;
u_char dlbh;
u_char dlbl;
int unit;
unit = DEV_TO_UNIT(tp->t_dev);
com = com_addr(unit);
if (com == NULL) {
return (ENODEV);
}
if (t->c_ispeed == 0)
t->c_ispeed = t->c_ospeed;
if (t->c_ospeed == 0) {
divisor = 0;
} else {
if (t->c_ispeed != t->c_ospeed)
return (EINVAL);
divisor = siodivisor(com->rclk, t->c_ispeed);
if (divisor == 0)
return (EINVAL);
}
crit_enter();
if (divisor == 0)
(void)commctl(com, TIOCM_DTR, DMBIC);
else
(void)commctl(com, TIOCM_DTR, DMBIS);
cflag = t->c_cflag;
switch (cflag & CSIZE) {
case CS5:
cfcr = CFCR_5BITS;
break;
case CS6:
cfcr = CFCR_6BITS;
break;
case CS7:
cfcr = CFCR_7BITS;
break;
default:
cfcr = CFCR_8BITS;
break;
}
if (cflag & PARENB) {
cfcr |= CFCR_PENAB;
if (!(cflag & PARODD))
cfcr |= CFCR_PEVEN;
}
if (cflag & CSTOPB)
cfcr |= CFCR_STOPB;
if (com->hasfifo && divisor != 0) {
com->fifo_image = t->c_ospeed <= 4800
? FIFO_ENABLE : FIFO_ENABLE | FIFO_RX_MEDH;
#ifdef COM_ESP
if (com->esp)
com->fifo_image |= FIFO_DMA_MODE;
#endif
sio_setreg(com, com_fifo, com->fifo_image);
}
siocntxwait(com->bsh);
(void) siosetwater(com, t->c_ispeed);
if (divisor != 0) {
sio_setreg(com, com_cfcr, cfcr | CFCR_DLAB);
dlbl = divisor & 0xFF;
if (sio_getreg(com, com_dlbl) != dlbl)
sio_setreg(com, com_dlbl, dlbl);
dlbh = divisor >> 8;
if (sio_getreg(com, com_dlbh) != dlbh)
sio_setreg(com, com_dlbh, dlbh);
}
sio_setreg(com, com_cfcr, com->cfcr_image = cfcr);
if (!(tp->t_state & TS_TTSTOP))
com->state |= CS_TTGO;
if (cflag & CRTS_IFLOW) {
if (com->st16650a) {
sio_setreg(com, com_cfcr, 0xbf);
sio_setreg(com, com_fifo,
sio_getreg(com, com_fifo) | 0x40);
}
com->state |= CS_RTS_IFLOW;
} else if (com->state & CS_RTS_IFLOW) {
com->state &= ~CS_RTS_IFLOW;
outb(com->modem_ctl_port, com->mcr_image |= MCR_RTS);
if (com->st16650a) {
sio_setreg(com, com_cfcr, 0xbf);
sio_setreg(com, com_fifo,
sio_getreg(com, com_fifo) & ~0x40);
}
}
com->state |= CS_ODEVREADY;
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;
if (com->st16650a) {
sio_setreg(com, com_cfcr, 0xbf);
sio_setreg(com, com_fifo,
sio_getreg(com, com_fifo) | 0x80);
}
} else {
if (com->st16650a) {
sio_setreg(com, com_cfcr, 0xbf);
sio_setreg(com, com_fifo,
sio_getreg(com, com_fifo) & ~0x80);
}
}
sio_setreg(com, com_cfcr, com->cfcr_image);
disc_optim(tp, t, com);
if (com->state >= (CS_BUSY | CS_TTGO)) {
com_lock();
siointr1(com);
com_unlock();
}
crit_exit();
comstart(tp);
if (com->ibufold != NULL) {
kfree(com->ibufold, M_DEVBUF);
com->ibufold = NULL;
}
return (0);
}
static int
siosetwater(struct com_s *com, speed_t speed)
{
int cp4ticks;
u_char *ibuf;
int ibufsize;
struct tty *tp;
cp4ticks = speed / 10 / hz * 4;
for (ibufsize = 128; ibufsize < cp4ticks;)
ibufsize <<= 1;
if (ibufsize == com->ibufsize)
return (0);
ibuf = kmalloc(2 * ibufsize, M_DEVBUF, M_WAITOK | M_ZERO);
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;
}
com_lock();
if (com->iptr != com->ibuf)
sioinput(com);
com->iptr = com->ibuf = ibuf;
com->ibufend = ibuf + ibufsize;
com->ierroff = ibufsize;
com->ihighwater = ibuf + 3 * ibufsize / 4;
com_unlock();
return (0);
}
static void
comstart(struct tty *tp)
{
struct com_s *com;
int unit;
lwkt_gettoken(&tty_token);
unit = DEV_TO_UNIT(tp->t_dev);
com = com_addr(unit);
if (com == NULL) {
lwkt_reltoken(&tty_token);
return;
}
crit_enter();
com_lock();
if (tp->t_state & TS_TTSTOP)
com->state &= ~CS_TTGO;
else
com->state |= CS_TTGO;
if (tp->t_state & TS_TBLOCK) {
if (com->mcr_image & MCR_RTS && com->state & CS_RTS_IFLOW)
outb(com->modem_ctl_port, com->mcr_image &= ~MCR_RTS);
} else {
if (!(com->mcr_image & MCR_RTS) && com->iptr < com->ihighwater
&& com->state & CS_RTS_IFLOW)
outb(com->modem_ctl_port, com->mcr_image |= MCR_RTS);
}
com_unlock();
if (tp->t_state & (TS_TIMEOUT | TS_TTSTOP)) {
ttwwakeup(tp);
crit_exit();
lwkt_reltoken(&tty_token);
return;
}
if (tp->t_outq.c_cc != 0) {
struct lbq *qp;
struct lbq *next;
if (!com->obufs[0].l_queued) {
com->obufs[0].l_tail
= com->obuf1 + clist_qtob(&tp->t_outq, com->obuf1,
sizeof com->obuf1);
com->obufs[0].l_next = NULL;
com->obufs[0].l_queued = TRUE;
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;
}
com_unlock();
}
if (tp->t_outq.c_cc != 0 && !com->obufs[1].l_queued) {
com->obufs[1].l_tail
= com->obuf2 + clist_qtob(&tp->t_outq, com->obuf2,
sizeof com->obuf2);
com->obufs[1].l_next = NULL;
com->obufs[1].l_queued = TRUE;
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;
}
com_unlock();
}
tp->t_state |= TS_BUSY;
}
com_lock();
if (com->state >= (CS_BUSY | CS_TTGO))
siointr1(com);
com_unlock();
ttwwakeup(tp);
crit_exit();
lwkt_reltoken(&tty_token);
}
static void
comstop(struct tty *tp, int rw)
{
struct com_s *com;
lwkt_gettoken(&tty_token);
com = com_addr(DEV_TO_UNIT(tp->t_dev));
if (com == NULL || com->gone) {
lwkt_reltoken(&tty_token);
return;
}
com_lock();
if (rw & FWRITE) {
if (com->hasfifo)
#ifdef COM_ESP
if (!com->esp)
#endif
sio_setreg(com, com_fifo,
FIFO_XMT_RST | com->fifo_image);
com->obufs[0].l_queued = FALSE;
com->obufs[1].l_queued = FALSE;
com->state &= ~(CS_ODONE | CS_BUSY);
com->tp->t_state &= ~TS_BUSY;
}
if (rw & FREAD) {
if (com->hasfifo)
#ifdef COM_ESP
if (!com->esp)
#endif
sio_setreg(com, com_fifo,
FIFO_RCV_RST | com->fifo_image);
com->iptr = com->ibuf;
}
com_unlock();
comstart(tp);
lwkt_reltoken(&tty_token);
}
static int
commctl(struct com_s *com, int bits, int how)
{
int mcr;
int msr;
lwkt_gettoken(&tty_token);
if (how == DMGET) {
bits = TIOCM_LE;
mcr = com->mcr_image;
if (mcr & MCR_DTR)
bits |= TIOCM_DTR;
if (mcr & MCR_RTS)
bits |= TIOCM_RTS;
msr = com->prev_modem_status;
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 | MSR_TERI))
bits |= TIOCM_RI;
lwkt_reltoken(&tty_token);
return (bits);
}
mcr = 0;
if (bits & TIOCM_DTR)
mcr |= MCR_DTR;
if (bits & TIOCM_RTS)
mcr |= MCR_RTS;
if (com->gone) {
lwkt_reltoken(&tty_token);
return(0);
}
com_lock();
switch (how) {
case DMSET:
outb(com->modem_ctl_port,
com->mcr_image = mcr | (com->mcr_image & MCR_IENABLE));
break;
case DMBIS:
outb(com->modem_ctl_port, com->mcr_image |= mcr);
break;
case DMBIC:
outb(com->modem_ctl_port, com->mcr_image &= ~mcr);
break;
}
com_unlock();
lwkt_reltoken(&tty_token);
return (0);
}
static void
siosettimeout(void)
{
struct com_s *com;
bool_t someopen;
int unit;
ASSERT_LWKT_TOKEN_HELD(&tty_token);
callout_stop(&sio_timeout_handle);
sio_timeout = hz;
someopen = FALSE;
for (unit = 0; unit < sio_numunits; ++unit) {
com = com_addr(unit);
if (com != NULL && com->tp != NULL
&& com->tp->t_state & TS_ISOPEN && !com->gone) {
someopen = TRUE;
if (com->poll || com->poll_output) {
sio_timeout = hz > 200 ? hz / 200 : 1;
break;
}
}
}
if (someopen) {
sio_timeouts_until_log = hz / sio_timeout;
callout_reset(&sio_timeout_handle, sio_timeout,
comwakeup, NULL);
} else {
sio_timeouts_until_log = 1;
comwakeup(NULL);
callout_stop(&sio_timeout_handle);
}
}
static void
comwakeup(void *chan)
{
struct com_s *com;
int unit;
lwkt_gettoken(&tty_token);
callout_reset(&sio_timeout_handle, sio_timeout, comwakeup, NULL);
for (unit = 0; unit < sio_numunits; ++unit) {
com = com_addr(unit);
if (com != NULL && !com->gone
&& (com->state >= (CS_BUSY | CS_TTGO) || com->poll)) {
com_lock();
siointr1(com);
com_unlock();
}
}
if (--sio_timeouts_until_log > 0) {
lwkt_reltoken(&tty_token);
return;
}
sio_timeouts_until_log = hz / sio_timeout;
for (unit = 0; unit < sio_numunits; ++unit) {
int errnum;
com = com_addr(unit);
if (com == NULL)
continue;
if (com->gone)
continue;
for (errnum = 0; errnum < CE_NTYPES; ++errnum) {
u_int delta;
u_long total;
com_lock();
delta = com->delta_error_counts[errnum];
com->delta_error_counts[errnum] = 0;
com_unlock();
if (delta == 0)
continue;
total = com->error_counts[errnum] += delta;
log(LOG_ERR, "sio%d: %u more %s%s (total %lu)\n",
unit, delta, error_desc[errnum],
delta == 1 ? "" : "s", total);
}
}
lwkt_reltoken(&tty_token);
}
static void
disc_optim(struct tty *tp, struct termios *t, struct com_s *com)
{
lwkt_gettoken(&tty_token);
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;
lwkt_reltoken(&tty_token);
}
#include <sys/cons.h>
struct siocnstate {
u_char dlbl;
u_char dlbh;
u_char ier;
u_char cfcr;
u_char mcr;
};
static speed_t siocngetspeed (Port_t, u_long rclk);
#if 0
static void siocnclose (struct siocnstate *sp, Port_t iobase);
#endif
static void siocnopen (struct siocnstate *sp, Port_t iobase, int speed);
static cn_probe_t siocnprobe;
static cn_init_t siocninit;
static cn_init_fini_t siocninit_fini;
static cn_checkc_t siocncheckc;
static cn_getc_t siocngetc;
static cn_putc_t siocnputc;
#if defined(__i386__) || defined(__x86_64__)
CONS_DRIVER(sio, siocnprobe, siocninit, siocninit_fini,
NULL, siocngetc, siocncheckc, siocnputc, NULL, NULL);
#endif
#if defined(DDB)
#include <ddb/ddb.h>
#endif
static void
siocntxwait(Port_t iobase)
{
int timo;
timo = 100000;
while ((inb(iobase + com_lsr) & (LSR_TSRE | LSR_TXRDY))
!= (LSR_TSRE | LSR_TXRDY) && --timo != 0)
;
}
static speed_t
siocngetspeed(Port_t iobase, u_long rclk)
{
u_int divisor;
u_char dlbh;
u_char dlbl;
u_char cfcr;
cfcr = inb(iobase + com_cfcr);
outb(iobase + com_cfcr, CFCR_DLAB | cfcr);
dlbl = inb(iobase + com_dlbl);
dlbh = inb(iobase + com_dlbh);
outb(iobase + com_cfcr, cfcr);
divisor = dlbh << 8 | dlbl;
if (divisor == 0)
return (CONSPEED);
return (rclk / (16UL * divisor));
}
static void
siocnopen(struct siocnstate *sp, Port_t iobase, int speed)
{
u_int divisor;
u_char dlbh;
u_char dlbl;
sp->ier = inb(iobase + com_ier);
outb(iobase + com_ier, 0);
siocntxwait(iobase);
sp->cfcr = inb(iobase + com_cfcr);
outb(iobase + com_cfcr, CFCR_DLAB | CFCR_8BITS);
sp->dlbl = inb(iobase + com_dlbl);
sp->dlbh = inb(iobase + com_dlbh);
divisor = siodivisor(comdefaultrclk, speed);
dlbl = divisor & 0xFF;
if (sp->dlbl != dlbl)
outb(iobase + com_dlbl, dlbl);
dlbh = divisor >> 8;
if (sp->dlbh != dlbh)
outb(iobase + com_dlbh, dlbh);
outb(iobase + com_cfcr, CFCR_8BITS);
sp->mcr = inb(iobase + com_mcr);
outb(iobase + com_mcr, (sp->mcr & MCR_IENABLE) | MCR_DTR | MCR_RTS);
}
#if 0
static void
siocnclose(struct siocnstate *sp, Port_t iobase)
{
siocntxwait(iobase);
outb(iobase + com_cfcr, CFCR_DLAB | CFCR_8BITS);
if (sp->dlbl != inb(iobase + com_dlbl))
outb(iobase + com_dlbl, sp->dlbl);
if (sp->dlbh != inb(iobase + com_dlbh))
outb(iobase + com_dlbh, sp->dlbh);
outb(iobase + com_cfcr, sp->cfcr);
outb(iobase + com_mcr, sp->mcr | MCR_DTR | MCR_RTS);
outb(iobase + com_ier, sp->ier);
}
#endif
static void
siocnprobe(struct consdev *cp)
{
u_char cfcr;
u_int divisor;
int unit;
int fn;
struct siocnstate sp;
cp->cn_pri = CN_DEAD;
for (unit = 0; unit < 16; unit++) {
int flags;
int disabled;
if (!resource_int_value("sio", unit, "disabled", &disabled)) {
if (disabled)
continue;
}
if (resource_int_value("sio", unit, "flags", &flags))
continue;
if (COM_CONSOLE(flags) || COM_DEBUGGER(flags)) {
int port;
int baud;
Port_t iobase;
speed_t boot_speed;
struct com_s *com;
com = com_addr(unit);
if (resource_int_value("sio", unit, "port", &port)) {
if (com == NULL || com->ioportres == NULL)
continue;
port = rman_get_bushandle(com->ioportres);
}
if (resource_int_value("sio", unit, "baud", &baud) == 0)
boot_speed = baud;
else
boot_speed = 0;
iobase = port;
crit_enter();
if (boothowto & RB_SERIAL) {
if (boot_speed == 0) {
boot_speed = siocngetspeed(iobase,
comdefaultrclk);
}
if (boot_speed)
comdefaultrate = boot_speed;
}
if (boot_speed == 0)
boot_speed = comdefaultrate;
com_lock();
cfcr = inb(iobase + com_cfcr);
outb(iobase + com_cfcr, CFCR_DLAB | cfcr);
divisor = siodivisor(comdefaultrclk, boot_speed);
outb(iobase + com_dlbl, divisor & 0xff);
outb(iobase + com_dlbh, divisor >> 8);
outb(iobase + com_cfcr, cfcr);
for (fn = 0; fn < 256; ++fn) {
if ((inb(iobase + com_lsr) & LSR_RXRDY) == 0)
break;
(void)inb(iobase + com_data);
}
if (fn == 256) {
kprintf("sio%d: does not exist, "
"cannot make console\n", unit);
com_unlock();
crit_exit();
continue;
}
if (com) {
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;
com->lt_out.c_ispeed = com->lt_out.c_ospeed =
com->lt_in.c_ispeed = com->lt_in.c_ospeed =
com->it_in.c_ispeed = com->it_in.c_ospeed =
boot_speed;
}
siocnopen(&sp, iobase, boot_speed);
com_unlock();
crit_exit();
if (COM_CONSOLE(flags) && !COM_LLCONSOLE(flags)) {
cp->cn_probegood = 1;
cp->cn_private = (void *)(intptr_t)unit;
cp->cn_pri = (COM_FORCECONSOLE(flags)
|| ((boothowto & RB_SERIAL)) ?
CN_REMOTE : CN_NORMAL);
siocniobase = iobase;
siocnunit = unit;
}
if (COM_DEBUGGER(flags) && gdb_tab == NULL) {
kprintf("sio%d: gdb debugging port\n", unit);
siogdbiobase = iobase;
siogdbunit = unit;
#if defined(DDB)
cp->cn_gdbprivate = (void *)(intptr_t)unit;
gdb_tab = cp;
#endif
}
}
}
#if defined(__i386__) || defined(__x86_64__)
#if defined(DDB)
if (gdb_tab == NULL && (boothowto & RB_GDB)) {
kprintf("Warning: no GDB port specified. Defaulting to sio%d.\n",
siocnunit);
kprintf("Set flag 0x80 on desired GDB port in your\n");
kprintf("configuration file (currently sio only).\n");
siogdbiobase = siocniobase;
siogdbunit = siocnunit;
cp->cn_gdbprivate = (void *)(intptr_t)siocnunit;
gdb_tab = cp;
}
#endif
#endif
}
static void
siocninit(struct consdev *cp)
{
comconsole = (int)(intptr_t)cp->cn_private;
}
static void
siocninit_fini(struct consdev *cp)
{
cdev_t dev;
char tbuf[MAKEDEV_MINNBUF];
int unit;
if (cp->cn_probegood) {
unit = (int)(intptr_t)cp->cn_private;
dev = devfs_find_device_by_name("ttyd%s",
makedev_unit_b32(tbuf, unit));
KKASSERT(dev != NULL);
cp->cn_dev = dev;
}
}
static int
siocncheckc(void *private)
{
int c;
int unit = (int)(intptr_t)private;
Port_t iobase;
#if 0
struct siocnstate sp;
#endif
if (unit == siogdbunit)
iobase = siogdbiobase;
else
iobase = siocniobase;
crit_enter();
com_lock();
#if 0
siocnopen(&sp, iobase, comdefaultrate);
#endif
if (inb(iobase + com_lsr) & LSR_RXRDY)
c = inb(iobase + com_data);
else
c = -1;
#if 0
siocnclose(&sp, iobase);
#endif
com_unlock();
crit_exit();
return (c);
}
static int
siocngetc(void *private)
{
int c;
int unit = (int)(intptr_t)private;
Port_t iobase;
#if 0
struct siocnstate sp;
#endif
if (unit == siogdbunit)
iobase = siogdbiobase;
else
iobase = siocniobase;
crit_enter();
com_lock();
#if 0
siocnopen(&sp, iobase, comdefaultrate);
#endif
while (!(inb(iobase + com_lsr) & LSR_RXRDY))
;
c = inb(iobase + com_data);
#if 0
siocnclose(&sp, iobase);
#endif
com_unlock();
crit_exit();
return (c);
}
static void
siocnputc(void *private, int c)
{
int unit = (int)(intptr_t)private;
#if 0
struct siocnstate sp;
#endif
Port_t iobase;
if (unit == siogdbunit)
iobase = siogdbiobase;
else
iobase = siocniobase;
crit_enter();
com_lock();
#if 0
siocnopen(&sp, iobase, comdefaultrate);
#endif
siocntxwait(iobase);
outb(iobase + com_data, c);
#if 0
siocnclose(&sp, iobase);
#endif
com_unlock();
crit_exit();
}
DRIVER_MODULE(sio, isa, sio_isa_driver, sio_devclass, NULL, NULL);
DRIVER_MODULE(sio, acpi, sio_isa_driver, sio_devclass, NULL, NULL);
#if NPCI > 0
DRIVER_MODULE(sio, pci, sio_pci_driver, sio_devclass, NULL, NULL);
#endif
#if NPUC > 0
DRIVER_MODULE(sio, puc, sio_puc_driver, sio_devclass, NULL, NULL);
#endif
