#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: addcom_isa.c,v 1.23 2021/08/07 16:19:12 thorpej Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/termios.h>
#include <sys/bus.h>
#include <sys/intr.h>
#include <dev/ic/comreg.h>
#include <dev/ic/comvar.h>
#include <dev/isa/isavar.h>
#include <dev/isa/com_multi.h>
#define NSLAVES 8
#define STATUS_IOADDR 0x420
#define STATUS_SIZE 8
struct addcom_softc {
void *sc_ih;
bus_space_tag_t sc_iot;
int sc_iobase;
int sc_alive;
void *sc_slaves[NSLAVES];
bus_space_handle_t sc_slaveioh[NSLAVES];
bus_space_handle_t sc_statusioh;
};
#define SLAVE_IOBASE_OFFSET 0x108
static int slave_iobases[8] = {
0x108,
0x110,
0x118,
0x120,
0x128,
0x130,
0x200,
0x208
};
int addcomprobe(device_t, cfdata_t, void *);
void addcomattach(device_t, device_t, void *);
int addcomintr(void *);
CFATTACH_DECL_NEW(addcom_isa, sizeof(struct addcom_softc),
addcomprobe, addcomattach, NULL, NULL);
int
addcomprobe(device_t parent, cfdata_t self, void *aux)
{
struct isa_attach_args *ia = aux;
bus_space_tag_t iot = ia->ia_iot;
bus_space_handle_t ioh;
int i, iobase, rv = 1;
if (ia->ia_nio < 1)
return (0);
if (ia->ia_nirq < 1)
return (0);
if (ISA_DIRECT_CONFIG(ia))
return (0);
if (ia->ia_io[0].ir_addr == ISA_UNKNOWN_PORT)
return (0);
if (ia->ia_irq[0].ir_irq == ISA_UNKNOWN_IRQ)
return (0);
iobase = ia->ia_io[0].ir_addr;
if (com_is_console(iot, iobase, 0))
goto checkmappings;
if (bus_space_map(iot, iobase, COM_NPORTS, 0, &ioh)) {
rv = 0;
goto out;
}
rv = comprobe1(iot, ioh);
bus_space_unmap(iot, ioh, COM_NPORTS);
if (rv == 0)
goto out;
checkmappings:
for (i = 1; i < NSLAVES; i++) {
iobase += slave_iobases[i] - slave_iobases[i - 1];
if (com_is_console(iot, iobase, 0))
continue;
if (bus_space_map(iot, iobase, COM_NPORTS, 0, &ioh)) {
rv = 0;
goto out;
}
bus_space_unmap(iot, ioh, COM_NPORTS);
}
out:
if (rv) {
ia->ia_nio = 1;
ia->ia_io[0].ir_size = NSLAVES * COM_NPORTS;
ia->ia_nirq = 1;
ia->ia_niomem = 0;
ia->ia_ndrq = 0;
}
return (rv);
}
void
addcomattach(device_t parent, device_t self, void *aux)
{
struct addcom_softc *sc = device_private(self);
struct isa_attach_args *ia = aux;
struct commulti_attach_args ca;
bus_space_tag_t iot = ia->ia_iot;
int i, iobase;
printf("\n");
sc->sc_iot = ia->ia_iot;
sc->sc_iobase = ia->ia_io[0].ir_addr;
if (bus_space_map(iot, STATUS_IOADDR, STATUS_SIZE,
0, &sc->sc_statusioh)) {
aprint_error_dev(self, "can't map status space\n");
return;
}
for (i = 0; i < NSLAVES; i++) {
iobase = sc->sc_iobase
+ slave_iobases[i]
- SLAVE_IOBASE_OFFSET;
if (!com_is_console(iot, iobase, &sc->sc_slaveioh[i]) &&
bus_space_map(iot, iobase, COM_NPORTS, 0,
&sc->sc_slaveioh[i])) {
aprint_error_dev(self,
"can't map i/o space for slave %d\n", i);
return;
}
}
for (i = 0; i < NSLAVES; i++) {
ca.ca_slave = i;
ca.ca_iot = sc->sc_iot;
ca.ca_ioh = sc->sc_slaveioh[i];
ca.ca_iobase = sc->sc_iobase
+ slave_iobases[i]
- SLAVE_IOBASE_OFFSET;
ca.ca_noien = 0;
sc->sc_slaves[i] = config_found(self, &ca, commultiprint,
CFARGS_NONE);
if (sc->sc_slaves[i] != NULL)
sc->sc_alive |= 1 << i;
}
sc->sc_ih = isa_intr_establish(ia->ia_ic, ia->ia_irq[0].ir_irq,
IST_EDGE, IPL_SERIAL, addcomintr, sc);
}
int
addcomintr(void *arg)
{
struct addcom_softc *sc = arg;
bus_space_tag_t iot = sc->sc_iot;
int alive = sc->sc_alive;
int bits;
bits = bus_space_read_1(iot, sc->sc_statusioh, 0) & alive;
if (bits == 0)
return (0);
for (;;) {
#define TRY(n) \
if (bits & (1 << (n))) \
comintr(sc->sc_slaves[n]);
TRY(0);
TRY(1);
TRY(2);
TRY(3);
TRY(4);
TRY(5);
TRY(6);
TRY(7);
#undef TRY
bits = bus_space_read_1(iot, sc->sc_statusioh, 0) & alive;
if (bits == 0)
return (1);
}
}