4249382df0
new system is integrated with the ISA bus code more cleanly and allows the future addition of more enumerators such as PnPBIOS and ACPI. This commit also enables the new pcm driver since it is somewhat tied to the new PnP code.
769 lines
21 KiB
C
769 lines
21 KiB
C
/*-
|
|
* Copyright (c) 1998,1999 Søren Schmidt
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer,
|
|
* without modification, immediately at the beginning of the file.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
* $FreeBSD$
|
|
*/
|
|
|
|
#include "ata.h"
|
|
#if NATA > 0
|
|
#include "isa.h"
|
|
#include "pci.h"
|
|
#include "atadisk.h"
|
|
#include "opt_global.h"
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/interrupt.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/module.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/buf.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/devicestat.h>
|
|
#include <vm/vm.h>
|
|
#include <vm/pmap.h>
|
|
#include <machine/resource.h>
|
|
#include <machine/bus.h>
|
|
#include <sys/rman.h>
|
|
#include <machine/clock.h>
|
|
#ifdef __i386__
|
|
#include <machine/smp.h>
|
|
#include <i386/isa/intr_machdep.h>
|
|
#endif
|
|
#if NPCI > 0
|
|
#include <pci/pcivar.h>
|
|
#include <pci/pcireg.h>
|
|
#endif
|
|
#include <isa/isavar.h>
|
|
#include <isa/isareg.h>
|
|
#include <dev/ata/ata-all.h>
|
|
#include <dev/ata/ata-disk.h>
|
|
#include <dev/ata/atapi-all.h>
|
|
|
|
/* misc defines */
|
|
#define UNIT(dev) (dev>>3 & 0x1f) /* assume 8 minor # per unit */
|
|
#define MIN(a,b) ((a)>(b)?(b):(a))
|
|
#if SMP == 0
|
|
#define isa_apic_irq(x) x
|
|
#endif
|
|
|
|
/* prototypes */
|
|
#if NPCI > 0
|
|
static void promise_intr(void *);
|
|
#endif
|
|
static int32_t ata_probe(int32_t, int32_t, int32_t, device_t, int32_t *);
|
|
static void ataintr(void *);
|
|
|
|
static int32_t atanlun = 0;
|
|
struct ata_softc *atadevices[MAXATA];
|
|
static devclass_t ata_devclass;
|
|
|
|
#if NISA > 0
|
|
static struct isa_pnp_id ata_ids[] = {
|
|
{0x0006d041, "Generic ESDI/IDE/ATA controller"}, /* PNP0600 */
|
|
{0x0106d041, "Plus Hardcard II"}, /* PNP0601 */
|
|
{0x0206d041, "Plus Hardcard IIXL/EZ"}, /* PNP0602 */
|
|
{0x0306d041, "Generic ATA"}, /* PNP0603 */
|
|
{0}
|
|
};
|
|
|
|
static int
|
|
ata_isaprobe(device_t dev)
|
|
{
|
|
struct resource *port;
|
|
int rid;
|
|
int32_t ctlr, res;
|
|
int32_t lun;
|
|
|
|
/* Check isapnp ids */
|
|
if (ISA_PNP_PROBE(device_get_parent(dev), dev, ata_ids) == ENXIO)
|
|
return (ENXIO);
|
|
|
|
/* Allocate the port range */
|
|
rid = 0;
|
|
port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, RF_ACTIVE);
|
|
if (!port)
|
|
return (ENOMEM);
|
|
|
|
/* check if allready in use by a PCI device */
|
|
for (ctlr = 0; ctlr < atanlun; ctlr++) {
|
|
if (atadevices[ctlr]->ioaddr == rman_get_start(port)) {
|
|
printf("ata-isa%d: already registered as ata%d\n",
|
|
device_get_unit(dev), ctlr);
|
|
bus_release_resource(dev, SYS_RES_IOPORT, 0, port);
|
|
return ENXIO;
|
|
}
|
|
}
|
|
|
|
lun = 0;
|
|
res = ata_probe(rman_get_start(port), rman_get_start(port) + ATA_ALTPORT,
|
|
0, dev, &lun);
|
|
|
|
bus_release_resource(dev, SYS_RES_IOPORT, 0, port);
|
|
|
|
if (res) {
|
|
isa_set_portsize(dev, res);
|
|
*(int *)device_get_softc(dev) = lun;
|
|
return 0;
|
|
}
|
|
|
|
return ENXIO;
|
|
}
|
|
|
|
static int
|
|
ata_isaattach(device_t dev)
|
|
{
|
|
struct resource *port;
|
|
struct resource *irq;
|
|
void *ih;
|
|
int rid;
|
|
|
|
/* Allocate the port range and interrupt */
|
|
rid = 0;
|
|
port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid, 0, ~0, 1, RF_ACTIVE);
|
|
if (!port)
|
|
return (ENOMEM);
|
|
|
|
rid = 0;
|
|
irq = bus_alloc_resource(dev, SYS_RES_IRQ, &rid, 0, ~0, 1, RF_ACTIVE);
|
|
if (!irq) {
|
|
bus_release_resource(dev, SYS_RES_IOPORT, 0, port);
|
|
return (ENOMEM);
|
|
}
|
|
return bus_setup_intr(dev, irq, INTR_TYPE_BIO, ataintr,
|
|
atadevices[*(int *)device_get_softc(dev)], &ih);
|
|
}
|
|
|
|
static device_method_t ata_isa_methods[] = {
|
|
/* Device interface */
|
|
DEVMETHOD(device_probe, ata_isaprobe),
|
|
DEVMETHOD(device_attach, ata_isaattach),
|
|
{ 0, 0 }
|
|
};
|
|
|
|
static driver_t ata_isa_driver = {
|
|
"ata",
|
|
ata_isa_methods,
|
|
sizeof(int),
|
|
};
|
|
|
|
DRIVER_MODULE(ata, isa, ata_isa_driver, ata_devclass, 0, 0);
|
|
|
|
#endif
|
|
|
|
#if NPCI > 0
|
|
|
|
static const char *
|
|
ata_pcimatch(device_t dev)
|
|
{
|
|
u_int32_t data;
|
|
|
|
data = pci_read_config(dev, PCI_CLASS_REG, 4);
|
|
if (pci_get_class(dev) == PCIC_STORAGE &&
|
|
(pci_get_subclass(dev) == PCIS_STORAGE_IDE ||
|
|
pci_get_subclass(dev) == PCIS_STORAGE_RAID ||
|
|
pci_get_subclass(dev) == PCIS_STORAGE_OTHER)) {
|
|
switch (pci_get_devid(dev)) {
|
|
case 0x12308086:
|
|
return "Intel PIIX IDE controller";
|
|
case 0x70108086:
|
|
return "Intel PIIX3 IDE controller";
|
|
case 0x71118086:
|
|
return "Intel PIIX4 IDE controller";
|
|
case 0x4d33105a:
|
|
return "Promise Ultra/33 IDE controller";
|
|
case 0x4d38105a:
|
|
return "Promise Ultra/66 IDE controller";
|
|
case 0x522910b9:
|
|
return "AcerLabs Aladdin IDE controller";
|
|
#if 0
|
|
case 0x05711106:
|
|
return "VIA Apollo IDE controller";
|
|
case 0x06401095:
|
|
return "CMD 640 IDE controller";
|
|
case 0x06461095:
|
|
return "CMD 646 IDE controller";
|
|
case 0xc6931080:
|
|
return "Cypress 82C693 IDE controller";
|
|
case 0x01021078:
|
|
return "Cyrix 5530 IDE controller";
|
|
#endif
|
|
default:
|
|
return "Unknown PCI IDE controller (using generic mode)";
|
|
}
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static int
|
|
ata_pciprobe(device_t dev)
|
|
{
|
|
const char *desc = ata_pcimatch(dev);
|
|
if (desc) {
|
|
device_set_desc(dev, desc);
|
|
return 0;
|
|
}
|
|
else
|
|
return ENXIO;
|
|
}
|
|
|
|
static int
|
|
ata_pciattach(device_t dev)
|
|
{
|
|
int unit = device_get_unit(dev);
|
|
struct ata_softc *scp;
|
|
u_int32_t type;
|
|
u_int8_t class, subclass;
|
|
u_int32_t cmd;
|
|
int32_t iobase_1, iobase_2, altiobase_1, altiobase_2;
|
|
int32_t bmaddr_1 = 0, bmaddr_2 = 0, irq1, irq2;
|
|
int32_t lun;
|
|
|
|
/* set up vendor-specific stuff */
|
|
type = pci_get_devid(dev);
|
|
class = pci_get_class(dev);
|
|
subclass = pci_get_subclass(dev);
|
|
cmd = pci_read_config(dev, PCIR_COMMAND, 4);
|
|
|
|
#ifdef ATA_DEBUG
|
|
printf("ata-pci%d: type=%08x class=%02x subclass=%02x cmd=%08x\n",
|
|
unit, type, class, subclass, cmd);
|
|
#endif
|
|
|
|
/* if this is a Promise controller handle it specially */
|
|
if (type == 0x4d33105a || type == 0x4d38105a) {
|
|
iobase_1 = pci_read_config(dev, 0x10, 4) & 0xfffc;
|
|
altiobase_1 = pci_read_config(dev, 0x14, 4) & 0xfffc;
|
|
iobase_2 = pci_read_config(dev, 0x18, 4) & 0xfffc;
|
|
altiobase_2 = pci_read_config(dev, 0x1c, 4) & 0xfffc;
|
|
irq1 = irq2 = pci_read_config(dev, PCI_INTERRUPT_REG, 4) & 0xff;
|
|
bmaddr_1 = pci_read_config(dev, 0x20, 4) & 0xfffc;
|
|
bmaddr_2 = bmaddr_1 + ATA_BM_OFFSET1;
|
|
outb(bmaddr_1 + 0x1f, inb(bmaddr_1 + 0x1f) | 0x01);
|
|
printf("ata-pci%d: Busmastering DMA supported\n", unit);
|
|
}
|
|
/* everybody else seems to do it this way */
|
|
else {
|
|
if ((unit == 0) &&
|
|
(pci_get_progif(dev) & PCIP_STORAGE_IDE_MODEPRIM) == 0) {
|
|
iobase_1 = IO_WD1;
|
|
altiobase_1 = iobase_1 + ATA_ALTPORT;
|
|
irq1 = 14;
|
|
}
|
|
else {
|
|
iobase_1 = pci_read_config(dev, 0x10, 4) & 0xfffc;
|
|
altiobase_1 = pci_read_config(dev, 0x14, 4) & 0xfffc;
|
|
irq1 = pci_read_config(dev, PCI_INTERRUPT_REG, 4) & 0xff;
|
|
}
|
|
if ((unit == 0) &&
|
|
(pci_get_progif(dev) & PCIP_STORAGE_IDE_MODESEC) == 0) {
|
|
iobase_2 = IO_WD2;
|
|
altiobase_2 = iobase_2 + ATA_ALTPORT;
|
|
irq2 = 15;
|
|
}
|
|
else {
|
|
iobase_2 = pci_read_config(dev, 0x18, 4) & 0xfffc;
|
|
altiobase_2 = pci_read_config(dev, 0x1c, 4) & 0xfffc;
|
|
irq2 = pci_read_config(dev, PCI_INTERRUPT_REG, 4) & 0xff;
|
|
}
|
|
|
|
/* is this controller busmaster capable ? */
|
|
if (pci_get_progif(dev) & PCIP_STORAGE_IDE_MASTERDEV) {
|
|
/* is busmastering support turned on ? */
|
|
if ((pci_read_config(dev, PCI_COMMAND_STATUS_REG, 4) & 5) == 5) {
|
|
/* is there a valid port range to connect to ? */
|
|
if ((bmaddr_1 = pci_read_config(dev, 0x20, 4) & 0xfffc)) {
|
|
bmaddr_2 = bmaddr_1 + ATA_BM_OFFSET1;
|
|
printf("ata-pci%d: Busmastering DMA supported\n", unit);
|
|
}
|
|
else
|
|
printf("ata-pci%d: Busmastering DMA not configured\n",unit);
|
|
}
|
|
else
|
|
printf("ata-pci%d: Busmastering DMA not enabled\n", unit);
|
|
}
|
|
else
|
|
printf("ata-pci%d: Busmastering DMA not supported\n", unit);
|
|
}
|
|
|
|
/* now probe the addresse found for "real" ATA/ATAPI hardware */
|
|
lun = 0;
|
|
if (ata_probe(iobase_1, altiobase_1, bmaddr_1, dev, &lun)) {
|
|
scp = atadevices[lun];
|
|
if (iobase_1 == IO_WD1)
|
|
#ifdef __i386__
|
|
inthand_add(device_get_nameunit(dev), irq1, ataintr, scp,
|
|
&bio_imask, INTR_EXCL);
|
|
#endif
|
|
#ifdef __alpha__
|
|
alpha_platform_setup_ide_intr(0, ataintr, scp);
|
|
#endif
|
|
else {
|
|
struct resource *irq;
|
|
int rid = 0;
|
|
void *ih;
|
|
|
|
irq = bus_alloc_resource(dev, SYS_RES_IRQ, &rid, 0, ~0, 1,
|
|
RF_SHAREABLE | RF_ACTIVE);
|
|
if (!irq)
|
|
printf("ata_pciattach: Unable to alloc interrupt\n");
|
|
|
|
if (type == 0x4d33105a || type == 0x4d38105a)
|
|
bus_setup_intr(dev, irq, INTR_TYPE_BIO, promise_intr, scp, &ih);
|
|
else
|
|
bus_setup_intr(dev, irq, INTR_TYPE_BIO, ataintr, scp, &ih);
|
|
}
|
|
printf("ata%d at 0x%04x irq %d on ata-pci%d\n",
|
|
lun, iobase_1, isa_apic_irq(irq1), unit);
|
|
}
|
|
lun = 1;
|
|
if (ata_probe(iobase_2, altiobase_2, bmaddr_2, dev, &lun)) {
|
|
scp = atadevices[lun];
|
|
if (iobase_2 == IO_WD2)
|
|
#ifdef __i386__
|
|
inthand_add(device_get_nameunit(dev), irq2, ataintr, scp,
|
|
&bio_imask, INTR_EXCL);
|
|
#endif
|
|
#ifdef __alpha__
|
|
alpha_platform_setup_ide_intr(1, ataintr, scp);
|
|
#endif
|
|
else {
|
|
struct resource *irq;
|
|
int rid = 0;
|
|
void *ih;
|
|
|
|
if (type != 0x4d33105a && type != 0x4d38105a) {
|
|
irq = bus_alloc_resource(dev, SYS_RES_IRQ, &rid, 0, ~0, 1,
|
|
RF_SHAREABLE | RF_ACTIVE);
|
|
if (!irq)
|
|
printf("ata_pciattach: Unable to alloc interrupt\n");
|
|
|
|
bus_setup_intr(dev, irq, INTR_TYPE_BIO, ataintr, scp, &ih);
|
|
}
|
|
}
|
|
printf("ata%d at 0x%04x irq %d on ata-pci%d\n",
|
|
lun, iobase_2, isa_apic_irq(irq2), unit);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static device_method_t ata_pci_methods[] = {
|
|
/* Device interface */
|
|
DEVMETHOD(device_probe, ata_pciprobe),
|
|
DEVMETHOD(device_attach, ata_pciattach),
|
|
{ 0, 0 }
|
|
};
|
|
|
|
static driver_t ata_pci_driver = {
|
|
"ata-pci",
|
|
ata_pci_methods,
|
|
sizeof(int),
|
|
};
|
|
|
|
DRIVER_MODULE(ata, pci, ata_pci_driver, ata_devclass, 0, 0);
|
|
|
|
static void
|
|
promise_intr(void *data)
|
|
{
|
|
struct ata_softc *scp = (struct ata_softc *)data;
|
|
int32_t channel = inl((pci_read_config(scp->dev, 0x20, 4) & 0xfffc) + 0x1c);
|
|
|
|
if (channel & 0x00000400)
|
|
ataintr(data);
|
|
|
|
if (channel & 0x00004000)
|
|
ataintr(atadevices[scp->lun + 1]);
|
|
}
|
|
#endif
|
|
|
|
static int32_t
|
|
ata_probe(int32_t ioaddr, int32_t altioaddr, int32_t bmaddr,
|
|
device_t dev, int32_t *unit)
|
|
{
|
|
struct ata_softc *scp = atadevices[atanlun];
|
|
int32_t mask = 0;
|
|
int32_t timeout;
|
|
int32_t lun = atanlun;
|
|
u_int8_t status0, status1;
|
|
|
|
#ifdef ATA_STATIC_ID
|
|
atanlun++;
|
|
#endif
|
|
if (lun > MAXATA) {
|
|
printf("ata: unit out of range(%d)\n", lun);
|
|
return 0;
|
|
}
|
|
if (scp) {
|
|
printf("ata%d: unit already attached\n", lun);
|
|
return 0;
|
|
}
|
|
scp = malloc(sizeof(struct ata_softc), M_DEVBUF, M_NOWAIT);
|
|
if (scp == NULL) {
|
|
printf("ata%d: failed to allocate driver storage\n", lun);
|
|
return 0;
|
|
}
|
|
bzero(scp, sizeof(struct ata_softc));
|
|
|
|
scp->unit = *unit;
|
|
scp->lun = lun;
|
|
scp->ioaddr = ioaddr;
|
|
scp->altioaddr = altioaddr;
|
|
scp->active = ATA_IDLE;
|
|
|
|
#ifdef ATA_DEBUG
|
|
printf("ata%d: iobase=0x%04x altiobase=0x%04x\n",
|
|
scp->lun, scp->ioaddr, scp->altioaddr);
|
|
#endif
|
|
|
|
/* do we have any signs of ATA/ATAPI HW being present ? */
|
|
outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_MASTER);
|
|
DELAY(1);
|
|
status0 = inb(scp->ioaddr + ATA_STATUS);
|
|
outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_SLAVE);
|
|
DELAY(1);
|
|
status1 = inb(scp->ioaddr + ATA_STATUS);
|
|
if ((status0 & 0xf8) != 0xf8)
|
|
mask |= 0x01;
|
|
if ((status1 & 0xf8) != 0xf8)
|
|
mask |= 0x02;
|
|
#ifdef ATA_DEBUG
|
|
printf("ata%d: mask=%02x status0=%02x status1=%02x\n",
|
|
scp->lun, mask, status0, status1);
|
|
#endif
|
|
if (!mask) {
|
|
free(scp, M_DEVBUF);
|
|
return 0;
|
|
}
|
|
/* assert reset for devices and wait for completition */
|
|
outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_MASTER);
|
|
DELAY(1);
|
|
outb(scp->altioaddr, ATA_A_IDS | ATA_A_RESET);
|
|
DELAY(1000);
|
|
outb(scp->altioaddr, ATA_A_IDS);
|
|
DELAY(1000);
|
|
inb(scp->ioaddr + ATA_ERROR);
|
|
DELAY(1);
|
|
outb(scp->altioaddr, ATA_A_4BIT);
|
|
DELAY(1);
|
|
|
|
/* wait for BUSY to go inactive */
|
|
for (timeout = 0; timeout < 30000*10; timeout++) {
|
|
outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_MASTER);
|
|
DELAY(1);
|
|
status0 = inb(scp->ioaddr + ATA_STATUS);
|
|
outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | ATA_SLAVE);
|
|
DELAY(1);
|
|
status1 = inb(scp->ioaddr + ATA_STATUS);
|
|
if (mask == 0x01) /* wait for master only */
|
|
if (!(status0 & ATA_S_BSY))
|
|
break;
|
|
if (mask == 0x02) /* wait for slave only */
|
|
if (!(status1 & ATA_S_BSY))
|
|
break;
|
|
if (mask == 0x03) /* wait for both master & slave */
|
|
if (!(status0 & ATA_S_BSY) && !(status1 & ATA_S_BSY))
|
|
break;
|
|
DELAY(100);
|
|
}
|
|
if (status0 & ATA_S_BSY)
|
|
mask &= ~0x01;
|
|
if (status1 & ATA_S_BSY)
|
|
mask &= ~0x02;
|
|
#ifdef ATA_DEBUG
|
|
printf("ata%d: mask=%02x status0=%02x status1=%02x\n",
|
|
scp->lun, mask, status0, status1);
|
|
#endif
|
|
if (!mask) {
|
|
free(scp, M_DEVBUF);
|
|
return 0;
|
|
}
|
|
/*
|
|
* OK, we have at least one device on the chain,
|
|
* check for ATAPI signatures, if none check if its
|
|
* a good old ATA device.
|
|
*/
|
|
|
|
outb(scp->ioaddr + ATA_DRIVE, (ATA_D_IBM | ATA_MASTER));
|
|
DELAY(1);
|
|
if (inb(scp->ioaddr + ATA_CYL_LSB) == ATAPI_MAGIC_LSB &&
|
|
inb(scp->ioaddr + ATA_CYL_MSB) == ATAPI_MAGIC_MSB) {
|
|
scp->devices |= ATA_ATAPI_MASTER;
|
|
}
|
|
outb(scp->ioaddr + ATA_DRIVE, (ATA_D_IBM | ATA_SLAVE));
|
|
DELAY(1);
|
|
if (inb(scp->ioaddr + ATA_CYL_LSB) == ATAPI_MAGIC_LSB &&
|
|
inb(scp->ioaddr + ATA_CYL_MSB) == ATAPI_MAGIC_MSB) {
|
|
scp->devices |= ATA_ATAPI_SLAVE;
|
|
}
|
|
if (status0 != 0x00 && !(scp->devices & ATA_ATAPI_MASTER)) {
|
|
outb(scp->ioaddr + ATA_DRIVE, (ATA_D_IBM | ATA_MASTER));
|
|
DELAY(1);
|
|
outb(scp->ioaddr + ATA_ERROR, 0x58);
|
|
outb(scp->ioaddr + ATA_CYL_LSB, 0xa5);
|
|
if (inb(scp->ioaddr + ATA_ERROR) != 0x58 &&
|
|
inb(scp->ioaddr + ATA_CYL_LSB) == 0xa5) {
|
|
scp->devices |= ATA_ATA_MASTER;
|
|
}
|
|
}
|
|
if (status1 != 0x00 && !(scp->devices & ATA_ATAPI_SLAVE)) {
|
|
outb(scp->ioaddr + ATA_DRIVE, (ATA_D_IBM | ATA_SLAVE));
|
|
DELAY(1);
|
|
outb(scp->ioaddr + ATA_ERROR, 0x58);
|
|
outb(scp->ioaddr + ATA_CYL_LSB, 0xa5);
|
|
if (inb(scp->ioaddr + ATA_ERROR) != 0x58 &&
|
|
inb(scp->ioaddr + ATA_CYL_LSB) == 0xa5) {
|
|
scp->devices |= ATA_ATA_SLAVE;
|
|
}
|
|
}
|
|
#ifdef ATA_DEBUG
|
|
printf("ata%d: devices = 0x%x\n", scp->lun, scp->devices);
|
|
#endif
|
|
if (!scp->devices) {
|
|
free(scp, M_DEVBUF);
|
|
return 0;
|
|
}
|
|
TAILQ_INIT(&scp->ata_queue);
|
|
TAILQ_INIT(&scp->atapi_queue);
|
|
*unit = scp->lun;
|
|
scp->dev = dev;
|
|
if (bmaddr)
|
|
scp->bmaddr = bmaddr;
|
|
atadevices[scp->lun] = scp;
|
|
#ifndef ATA_STATIC_ID
|
|
atanlun++;
|
|
#endif
|
|
return ATA_IOSIZE;
|
|
}
|
|
|
|
static void
|
|
ataintr(void *data)
|
|
{
|
|
struct ata_softc *scp;
|
|
struct atapi_request *atapi_request;
|
|
struct ad_request *ad_request;
|
|
u_int8_t status;
|
|
static int32_t intr_count = 0;
|
|
|
|
scp = (struct ata_softc *)data;
|
|
|
|
/* find & call the responsible driver to process this interrupt */
|
|
switch (scp->active) {
|
|
#if NATADISK > 0
|
|
case ATA_ACTIVE_ATA:
|
|
if ((ad_request = TAILQ_FIRST(&scp->ata_queue)))
|
|
if (ad_interrupt(ad_request) == ATA_OP_CONTINUES)
|
|
return;
|
|
break;
|
|
#endif
|
|
case ATA_ACTIVE_ATAPI:
|
|
if ((atapi_request = TAILQ_FIRST(&scp->atapi_queue)))
|
|
if (atapi_interrupt(atapi_request) == ATA_OP_CONTINUES)
|
|
return;
|
|
break;
|
|
|
|
case ATA_WAIT_INTR:
|
|
wakeup((caddr_t)scp);
|
|
break;
|
|
|
|
case ATA_IGNORE_INTR:
|
|
break;
|
|
|
|
default:
|
|
case ATA_IDLE:
|
|
status = inb(scp->ioaddr + ATA_STATUS);
|
|
if (intr_count++ < 10)
|
|
printf("ata%d: unwanted interrupt %d status = %02x\n",
|
|
scp->lun, intr_count, status);
|
|
return;
|
|
}
|
|
scp->active = ATA_IDLE;
|
|
ata_start(scp);
|
|
}
|
|
|
|
void
|
|
ata_start(struct ata_softc *scp)
|
|
{
|
|
struct ad_request *ad_request;
|
|
struct atapi_request *atapi_request;
|
|
|
|
#ifdef ATA_DEBUG
|
|
printf("ata_start: entered\n");
|
|
#endif
|
|
if (scp->active != ATA_IDLE) {
|
|
printf("ata: unwanted ata_start\n");
|
|
return;
|
|
}
|
|
|
|
#if NATADISK > 0
|
|
/* find & call the responsible driver if anything on ATA queue */
|
|
if ((ad_request = TAILQ_FIRST(&scp->ata_queue))) {
|
|
scp->active = ATA_ACTIVE_ATA;
|
|
ad_transfer(ad_request);
|
|
#ifdef ATA_DEBUG
|
|
printf("ata_start: started ata, leaving\n");
|
|
#endif
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
/* find & call the responsible driver if anything on ATAPI queue */
|
|
if ((atapi_request = TAILQ_FIRST(&scp->atapi_queue))) {
|
|
scp->active = ATA_ACTIVE_ATAPI;
|
|
atapi_transfer(atapi_request);
|
|
#ifdef ATA_DEBUG
|
|
printf("ata_start: started atapi, leaving\n");
|
|
#endif
|
|
return;
|
|
}
|
|
}
|
|
|
|
int32_t
|
|
ata_wait(struct ata_softc *scp, int32_t device, u_int8_t mask)
|
|
{
|
|
u_int8_t status;
|
|
u_int32_t timeout = 0;
|
|
|
|
while (timeout++ <= 500000) { /* timeout 5 secs */
|
|
status = inb(scp->ioaddr + ATA_STATUS);
|
|
|
|
/* if drive fails status, reselect the drive just to be sure */
|
|
if (status == 0xff) {
|
|
printf("ata%d: %s: no status, reselecting device\n",
|
|
scp->lun, device?"slave":"master");
|
|
outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | device);
|
|
DELAY(1);
|
|
status = inb(scp->ioaddr + ATA_STATUS);
|
|
}
|
|
if (status == 0xff)
|
|
return -1;
|
|
scp->status = status;
|
|
if (!(status & ATA_S_BSY)) {
|
|
if (status & ATA_S_ERROR)
|
|
scp->error = inb(scp->ioaddr + ATA_ERROR);
|
|
if ((status & mask) == mask)
|
|
return (status & ATA_S_ERROR);
|
|
}
|
|
if (timeout > 1000)
|
|
DELAY(1000);
|
|
else
|
|
DELAY(10);
|
|
}
|
|
return -1;
|
|
}
|
|
|
|
int32_t
|
|
ata_command(struct ata_softc *scp, int32_t device, u_int32_t command,
|
|
u_int32_t cylinder, u_int32_t head, u_int32_t sector,
|
|
u_int32_t count, u_int32_t feature, int32_t flags)
|
|
{
|
|
#ifdef ATA_DEBUG
|
|
printf("ata%d: ata_command: addr=%04x, device=%02x, cmd=%02x, c=%d, h=%d, s=%d, count=%d, flags=%02x\n", scp->lun, scp->ioaddr, device, command, cylinder, head, sector, count, flags);
|
|
#endif
|
|
|
|
/* ready to issue command ? */
|
|
if (ata_wait(scp, device, 0) < 0) {
|
|
printf("ata%d: %s: timeout waiting to give command s=%02x e=%02x\n",
|
|
scp->lun, device?"slave":"master", scp->status, scp->error);
|
|
}
|
|
outb(scp->ioaddr + ATA_FEATURE, feature);
|
|
outb(scp->ioaddr + ATA_CYL_LSB, cylinder);
|
|
outb(scp->ioaddr + ATA_CYL_MSB, cylinder >> 8);
|
|
outb(scp->ioaddr + ATA_DRIVE, ATA_D_IBM | device | head);
|
|
outb(scp->ioaddr + ATA_SECTOR, sector);
|
|
outb(scp->ioaddr + ATA_COUNT, count);
|
|
|
|
if (scp->active != ATA_IDLE && flags != ATA_IMMEDIATE)
|
|
printf("DANGER active=%d\n", scp->active);
|
|
|
|
switch (flags) {
|
|
case ATA_WAIT_INTR:
|
|
scp->active = ATA_WAIT_INTR;
|
|
outb(scp->ioaddr + ATA_CMD, command);
|
|
if (tsleep((caddr_t)scp, PRIBIO, "atacmd", 500)) {
|
|
printf("ata_command: timeout waiting for interrupt\n");
|
|
scp->active = ATA_IDLE;
|
|
return -1;
|
|
}
|
|
break;
|
|
|
|
case ATA_IGNORE_INTR:
|
|
scp->active = ATA_IGNORE_INTR;
|
|
outb(scp->ioaddr + ATA_CMD, command);
|
|
break;
|
|
|
|
case ATA_IMMEDIATE:
|
|
default:
|
|
outb(scp->ioaddr + ATA_CMD, command);
|
|
break;
|
|
}
|
|
#ifdef ATA_DEBUG
|
|
printf("ata_command: leaving\n");
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
bswap(int8_t *buf, int32_t len)
|
|
{
|
|
u_int16_t *p = (u_int16_t*)(buf + len);
|
|
|
|
while (--p >= (u_int16_t*)buf)
|
|
*p = ntohs(*p);
|
|
}
|
|
|
|
void
|
|
btrim(int8_t *buf, int32_t len)
|
|
{
|
|
int8_t *p;
|
|
|
|
for (p = buf; p < buf+len; ++p)
|
|
if (!*p)
|
|
*p = ' ';
|
|
for (p = buf + len - 1; p >= buf && *p == ' '; --p)
|
|
*p = 0;
|
|
}
|
|
|
|
void
|
|
bpack(int8_t *src, int8_t *dst, int32_t len)
|
|
{
|
|
int32_t i, j, blank;
|
|
|
|
for (i = j = blank = 0 ; i < len-1; i++) {
|
|
if (blank && src[i] == ' ') continue;
|
|
if (blank && src[i] != ' ') {
|
|
dst[j++] = src[i];
|
|
blank = 0;
|
|
continue;
|
|
}
|
|
if (src[i] == ' ')
|
|
blank = 1;
|
|
dst[j++] = src[i];
|
|
}
|
|
dst[j] = 0x00;
|
|
}
|
|
#endif /* NATA > 0 */
|