#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: nside.c,v 1.10 2017/01/04 15:49:28 christos Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <dev/pci/pcivar.h>
#include <dev/pci/pcidevs.h>
#include <dev/pci/pciidereg.h>
#include <dev/pci/pciidevar.h>
#include <dev/pci/pciide_natsemi_reg.h>
static void natsemi_chip_map(struct pciide_softc *,
const struct pci_attach_args *);
static void natsemi_setup_channel(struct ata_channel *);
static int natsemi_pci_intr(void *);
static void natsemi_irqack(struct ata_channel *);
static int nside_match(device_t, cfdata_t, void *);
static void nside_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(nside, sizeof(struct pciide_softc),
nside_match, nside_attach, pciide_detach, NULL);
static const struct pciide_product_desc pciide_natsemi_products[] = {
{ PCI_PRODUCT_NS_PC87415,
0,
"National Semiconductor PC87415 IDE Controller",
natsemi_chip_map,
},
{ 0,
0,
NULL,
NULL
}
};
static int
nside_match(device_t parent, cfdata_t match, void *aux)
{
struct pci_attach_args *pa = aux;
if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_NS &&
PCI_CLASS(pa->pa_class) == PCI_CLASS_MASS_STORAGE &&
PCI_SUBCLASS(pa->pa_class) == PCI_SUBCLASS_MASS_STORAGE_IDE) {
if (pciide_lookup_product(pa->pa_id, pciide_natsemi_products))
return 2;
}
return 0;
}
static void
nside_attach(device_t parent, device_t self, void *aux)
{
struct pci_attach_args *pa = aux;
struct pciide_softc *sc = device_private(self);
sc->sc_wdcdev.sc_atac.atac_dev = self;
pciide_common_attach(sc, pa,
pciide_lookup_product(pa->pa_id, pciide_natsemi_products));
}
static void
natsemi_chip_map(struct pciide_softc *sc, const struct pci_attach_args *pa)
{
struct pciide_channel *cp;
int channel;
pcireg_t interface, ctl;
if (pciide_chipen(sc, pa) == 0)
return;
aprint_verbose_dev(sc->sc_wdcdev.sc_atac.atac_dev,
"bus-master DMA support present");
pciide_mapreg_dma(sc, pa);
aprint_verbose("\n");
sc->sc_wdcdev.sc_atac.atac_cap = ATAC_CAP_DATA16;
if (sc->sc_dma_ok) {
sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_DMA;
sc->sc_wdcdev.irqack = natsemi_irqack;
}
pciide_pci_write(sc->sc_pc, sc->sc_tag, NATSEMI_CCBT, 0xb7);
pciide_pci_write(sc->sc_pc, sc->sc_tag, NATSEMI_CTRL2,
pciide_pci_read(sc->sc_pc, sc->sc_tag, NATSEMI_CTRL2) |
NATSEMI_CHMASK(0) | NATSEMI_CHMASK(1));
sc->sc_wdcdev.sc_atac.atac_pio_cap = 4;
sc->sc_wdcdev.sc_atac.atac_dma_cap = 2;
sc->sc_wdcdev.sc_atac.atac_set_modes = natsemi_setup_channel;
sc->sc_wdcdev.sc_atac.atac_channels = sc->wdc_chanarray;
sc->sc_wdcdev.sc_atac.atac_nchannels = PCIIDE_NUM_CHANNELS;
sc->sc_wdcdev.wdc_maxdrives = 2;
interface = PCI_INTERFACE(pa->pa_class);
interface &= ~PCIIDE_CHANSTATUS_EN;
ctl = pciide_pci_read(sc->sc_pc, sc->sc_tag, NATSEMI_CTRL1);
if (interface & (PCIIDE_INTERFACE_PCI(0) | PCIIDE_INTERFACE_PCI(1)))
ctl &= ~NATSEMI_CTRL1_INTAMASK;
else
ctl |= NATSEMI_CTRL1_INTAMASK;
pciide_pci_write(sc->sc_pc, sc->sc_tag, NATSEMI_CTRL1, ctl);
wdc_allocate_regs(&sc->sc_wdcdev);
for (channel = 0; channel < sc->sc_wdcdev.sc_atac.atac_nchannels; channel++) {
cp = &sc->pciide_channels[channel];
if (pciide_chansetup(sc, channel, interface) == 0)
continue;
pciide_mapchan(pa, cp, interface, natsemi_pci_intr);
pciide_pci_write(sc->sc_pc, sc->sc_tag, NATSEMI_CTRL2,
pciide_pci_read(sc->sc_pc, sc->sc_tag, NATSEMI_CTRL2) &
~(NATSEMI_CHMASK(channel)));
}
}
void
natsemi_setup_channel(struct ata_channel *chp)
{
struct ata_drive_datas *drvp;
int drive;
uint32_t idedma_ctl = 0;
struct pciide_channel *cp = CHAN_TO_PCHAN(chp);
struct pciide_softc *sc = CHAN_TO_PCIIDE(chp);
uint8_t tim;
pciide_channel_dma_setup(cp);
for (drive = 0; drive < 2; drive++) {
drvp = &chp->ch_drive[drive];
if (drvp->drive_type == ATA_DRIVET_NONE)
continue;
if ((drvp->drive_flags & ATA_DRIVE_DMA) == 0) {
tim = natsemi_pio_pulse[drvp->PIO_mode] |
(natsemi_pio_recover[drvp->PIO_mode] << 4);
} else {
if (drvp->PIO_mode >= 3 &&
(drvp->DMA_mode + 2) > drvp->PIO_mode) {
drvp->DMA_mode = drvp->PIO_mode - 2;
}
idedma_ctl |= IDEDMA_CTL_DRV_DMA(drive);
tim = natsemi_dma_pulse[drvp->DMA_mode] |
(natsemi_dma_recover[drvp->DMA_mode] << 4);
}
pciide_pci_write(sc->sc_pc, sc->sc_tag,
NATSEMI_RTREG(chp->ch_channel, drive), tim);
pciide_pci_write(sc->sc_pc, sc->sc_tag,
NATSEMI_WTREG(chp->ch_channel, drive), tim);
}
if (idedma_ctl != 0) {
bus_space_write_1(sc->sc_dma_iot, cp->dma_iohs[IDEDMA_CTL], 0,
idedma_ctl);
}
natsemi_irqack(chp);
}
void
natsemi_irqack(struct ata_channel *chp)
{
struct pciide_channel *cp = CHAN_TO_PCHAN(chp);
struct pciide_softc *sc = CHAN_TO_PCIIDE(chp);
uint8_t clr;
clr = bus_space_read_1(sc->sc_dma_iot, cp->dma_iohs[IDEDMA_CMD], 0);
clr |= bus_space_read_1(sc->sc_dma_iot, cp->dma_iohs[IDEDMA_CTL], 0) &
(IDEDMA_CTL_ERR | IDEDMA_CTL_INTR);
bus_space_write_1(sc->sc_dma_iot, cp->dma_iohs[IDEDMA_CMD], 0, clr);
}
int
natsemi_pci_intr(void *arg)
{
struct pciide_softc *sc = arg;
struct pciide_channel *cp;
struct ata_channel *wdc_cp;
int i, rv, crv;
uint8_t msk;
rv = 0;
msk = pciide_pci_read(sc->sc_pc, sc->sc_tag, NATSEMI_CTRL2);
for (i = 0; i < sc->sc_wdcdev.sc_atac.atac_nchannels; i++) {
cp = &sc->pciide_channels[i];
wdc_cp = &cp->ata_channel;
if (cp->compat)
continue;
if (msk & NATSEMI_CHMASK(i))
continue;
crv = wdcintr(wdc_cp);
if (crv == 0)
;
else if (crv == 1)
rv = 1;
else if (rv == 0)
rv = crv;
}
return (rv);
}