#include <sys/cdefs.h>
#include <sys/systm.h>
#include <sys/types.h>
#include <sys/device.h>
#include <sys/bus.h>
#include <sys/conf.h>
#include <sys/kmem.h>
#include <machine/cpu.h>
#include <amiga/amiga/device.h>
#include <dev/ata/atavar.h>
#include <dev/ic/wdcvar.h>
#include <amiga/dev/zbusvar.h>
#include <amiga/dev/xsurfvar.h>
#define WDC_XSURF_CHANNELS 2
#define WDC_XSURF_CHANSIZE 0x30
#define WDC_XSURF_CHANOFF 0x2000
#define WDC_XSURF_ISR_OFF 0x7E
#define WDC_XSURF_ISR_HIGH 0x80
#define WDC_XSURF_OFF_DATA 0x0
#define WDC_XSURF_OFF_ERROR 0x6
#define WDC_XSURF_OFF_SECCNT 0xA
#define WDC_XSURF_OFF_SECTOR 0xE
#define WDC_XSURF_OFF_CYL_LO 0x12
#define WDC_XSURF_OFF_CYL_HI 0x16
#define WDC_XSURF_OFF_SDH 0x1A
#define WDC_XSURF_OFF_COMMAND 0x1E
struct wdc_xsurf_port {
struct ata_channel channel;
struct wdc_regs wdr;
};
struct wdc_xsurf_softc {
struct wdc_softc sc_wdcdev;
struct ata_channel *sc_chanarray[WDC_XSURF_CHANNELS];
struct wdc_xsurf_port sc_ports[WDC_XSURF_CHANNELS];
struct bus_space_tag sc_bst;
bus_space_tag_t sc_cmdt;
bus_space_handle_t sc_isrh;
struct isr sc_isr;
};
static int wdc_xsurf_match(device_t, cfdata_t, void *);
static void wdc_xsurf_attach(device_t, device_t, void *);
void wdc_xsurf_attach_channel(struct wdc_xsurf_softc *, int);
void wdc_xsurf_map_channel(struct wdc_xsurf_softc *, int);
int wdc_xsurf_intr(void *arg);
CFATTACH_DECL_NEW(wdc_xsurf, sizeof(struct wdc_xsurf_softc),
wdc_xsurf_match, wdc_xsurf_attach, NULL, NULL);
static const unsigned int wdc_xsurf_wdr_offsets[] = {
WDC_XSURF_OFF_DATA, WDC_XSURF_OFF_ERROR, WDC_XSURF_OFF_SECCNT,
WDC_XSURF_OFF_SECTOR, WDC_XSURF_OFF_CYL_LO, WDC_XSURF_OFF_CYL_HI,
WDC_XSURF_OFF_SDH, WDC_XSURF_OFF_COMMAND
};
static int
wdc_xsurf_match(device_t parent, cfdata_t cf, void *aux)
{
struct xsurfbus_attach_args *xsb_aa = aux;
if (strcmp(xsb_aa->xaa_name, "wdc_xsurf") != 0)
return 0;
return 1;
}
static void
wdc_xsurf_attach(device_t parent, device_t self, void *aux)
{
struct wdc_xsurf_softc *sc;
struct xsurfbus_attach_args *xsb_aa;
int i;
aprint_normal("\n");
aprint_naive("\n");
xsb_aa = aux;
sc = device_private(self);
sc->sc_bst.base = xsb_aa->xaa_base;
sc->sc_bst.absm = &amiga_bus_stride_1swap;
sc->sc_cmdt = &sc->sc_bst;
sc->sc_wdcdev.sc_atac.atac_pio_cap = 0;
sc->sc_wdcdev.sc_atac.atac_nchannels = WDC_XSURF_CHANNELS;
sc->sc_wdcdev.sc_atac.atac_dev = self;
sc->sc_wdcdev.sc_atac.atac_channels = sc->sc_chanarray;
sc->sc_wdcdev.sc_atac.atac_cap = ATAC_CAP_DATA16;
sc->sc_wdcdev.wdc_maxdrives = 2;
sc->sc_wdcdev.cap = WDC_CAPABILITY_NO_AUXCTL;
wdc_allocate_regs(&sc->sc_wdcdev);
for (i = 0; i < WDC_XSURF_CHANNELS; i++) {
wdc_xsurf_attach_channel(sc, i);
}
bus_space_map(sc->sc_cmdt, WDC_XSURF_ISR_OFF,
1, 0, &sc->sc_isrh);
sc->sc_isr.isr_intr = wdc_xsurf_intr;
sc->sc_isr.isr_arg = sc;
sc->sc_isr.isr_ipl = 2;
add_isr(&sc->sc_isr);
}
void
wdc_xsurf_attach_channel(struct wdc_xsurf_softc *sc, int chnum)
{
#ifdef WDC_XSURF_DEBUG
device_t self;
self = sc->sc_wdcdev.sc_atac.atac_dev;
#endif
sc->sc_chanarray[chnum] = &sc->sc_ports[chnum].channel;
memset(&sc->sc_ports[chnum],0,sizeof(struct wdc_xsurf_port));
sc->sc_ports[chnum].channel.ch_channel = chnum;
sc->sc_ports[chnum].channel.ch_atac = &sc->sc_wdcdev.sc_atac;
wdc_xsurf_map_channel(sc, chnum);
wdc_init_shadow_regs(CHAN_TO_WDC_REGS(&sc->sc_ports[chnum].channel));
wdcattach(&sc->sc_ports[chnum].channel);
#ifdef WDC_XSURF_DEBUG
aprint_normal_dev(self, "done init for channel %d\n", chnum);
#endif
}
void
wdc_xsurf_map_channel(struct wdc_xsurf_softc *sc, int chnum)
{
struct wdc_regs *wdr;
int i;
wdr = CHAN_TO_WDC_REGS(&sc->sc_ports[chnum].channel);
wdr->cmd_iot = sc->sc_cmdt;
bus_space_map(sc->sc_cmdt, chnum * WDC_XSURF_CHANOFF,
WDC_XSURF_CHANSIZE, 0, &wdr->cmd_baseioh);
for (i = 0; i < WDC_NREG; i++)
bus_space_subregion(wdr->cmd_iot, wdr->cmd_baseioh,
wdc_xsurf_wdr_offsets[i], i == 0 ? 2 : 1,
&wdr->cmd_iohs[i]);
}
int
wdc_xsurf_intr(void *arg)
{
struct wdc_xsurf_softc *sc;
uint8_t intreq;
int r1, r2;
sc = (struct wdc_xsurf_softc *)arg;
r1 = r2 = 0;
intreq = bus_space_read_1(sc->sc_cmdt, sc->sc_isrh, 0);
bus_space_write_1(sc->sc_cmdt, sc->sc_isrh, 0, 0);
if (intreq & WDC_XSURF_ISR_HIGH) {
r1 = wdcintr(&sc->sc_ports[0].channel);
r2 = wdcintr(&sc->sc_ports[1].channel);
}
return r1 | r2;
}