#include "locators.h"
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: wdc_obio.c,v 1.8 2022/02/12 02:40:28 riastradh Exp $");
#include <sys/param.h>
#include <sys/cpu.h>
#include <sys/device.h>
#include <sys/tty.h>
#include "ioconf.h"
#include <sys/intr.h>
#include <sys/bus.h>
#include <powerpc/booke/cpuvar.h>
#include <dev/ic/wdcreg.h>
#include <dev/ata/atavar.h>
#include <dev/ic/wdcvar.h>
struct wdc_obio_softc {
struct wdc_softc sc_wdcdev;
struct ata_channel *wdc_chanlist[1];
struct ata_channel ata_channel;
struct wdc_regs wdc_regs;
void *sc_ih;
};
#define WDC_OBIO_AUXREG_OFFSET (WDC_NREG + 6)
static int wdc_obio_match(device_t, cfdata_t, void *);
static void wdc_obio_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(wdc_obio, sizeof(struct wdc_obio_softc),
wdc_obio_match, wdc_obio_attach, NULL, NULL);
static bool
wdc_obio_initregmap(struct wdc_regs *wdr, bus_space_tag_t bst,
bus_addr_t addr, bus_size_t size)
{
int error;
wdr->cmd_iot = bst;
wdr->ctl_iot = bst;
error = bus_space_map(wdr->cmd_iot, addr, size, 0, &wdr->cmd_baseioh);
if (error) {
wdr->cmd_baseioh = 0;
return false;
}
for (u_int i = 0; i < WDC_NREG; i++) {
if (bus_space_subregion(wdr->cmd_iot, wdr->cmd_baseioh,
i, (i == 0) ? 2 : 1, &wdr->cmd_iohs[i])) {
return false;
}
}
if (bus_space_subregion(wdr->ctl_iot, wdr->cmd_baseioh,
WDC_OBIO_AUXREG_OFFSET, 1, &wdr->ctl_ioh)) {
return false;
}
return true;
}
static int
wdc_obio_match(device_t parent, cfdata_t cf, void *aux)
{
struct generic_attach_args * const ga = aux;
bus_size_t size = ga->ga_size;
struct wdc_regs wdr;
int rv = 0;
if (ga->ga_addr == OBIOCF_ADDR_DEFAULT)
return 0;
if (size == OBIOCF_SIZE_DEFAULT || size > PAGE_SIZE)
size = 2 * WDC_NREG;
memset(&wdr, 0, sizeof(wdr));
if (wdc_obio_initregmap(&wdr, ga->ga_bst, ga->ga_addr, size)) {
wdc_init_shadow_regs(&wdr);
rv = wdcprobe(&wdr);
bus_space_unmap(wdr.cmd_iot, wdr.cmd_baseioh, size);
}
return rv;
}
static void
wdc_obio_attach(device_t parent, device_t self, void *aux)
{
struct wdc_obio_softc *sc = device_private(self);
struct wdc_regs * const wdr = &sc->wdc_regs;
struct generic_attach_args * const ga = aux;
bus_size_t size = ga->ga_size;
if (size == OBIOCF_SIZE_DEFAULT || size > PAGE_SIZE)
size = 2 * WDC_NREG;
sc->sc_wdcdev.sc_atac.atac_dev = self;
sc->sc_wdcdev.regs = wdr;
if (!wdc_obio_initregmap(wdr, ga->ga_bst, ga->ga_addr, size)) {
aprint_error(": couldn't map registers\n");
return;
}
sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_DATA16;
sc->sc_wdcdev.sc_atac.atac_pio_cap = 0;
sc->wdc_chanlist[0] = &sc->ata_channel;
sc->sc_wdcdev.sc_atac.atac_channels = sc->wdc_chanlist;
sc->sc_wdcdev.sc_atac.atac_nchannels = 1;
sc->sc_wdcdev.wdc_maxdrives = 2;
sc->ata_channel.ch_channel = 0;
sc->ata_channel.ch_atac = &sc->sc_wdcdev.sc_atac;
wdc_init_shadow_regs(wdr);
if (ga->ga_irq != OBIOCF_IRQ_DEFAULT) {
sc->sc_ih = intr_establish(ga->ga_irq, IPL_BIO, IST_EDGE,
wdcintr, &sc->ata_channel);
aprint_normal(": interrupting at irq %d\n", ga->ga_irq);
} else {
sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_NOIRQ;
aprint_normal(": using polled I/O\n");
}
wdcattach(&sc->ata_channel);
}