55bfaed1c0
Well, better late than newer, but things has been hectic
around here, sorry for the long delay.
DMA support has been added to the ATA disk driver.
This only works on Intel PIIX3/4, Acer Aladdin and Promise controllers.
The promise support works without the BIOS on the board,
and timing modes are set to support up to UDMA speed. This
solves the problems with having more than one promise controller
in the same system.
There is support for "generic" DMA, that might work on other
controllers, but now you have been warned :)
More chipset specific code will come soon, I have to find testers
with the approbiate HW, more on that when I have it ready.
The system now uses its own major numbers, please run MAKEDEV
with the devices you need (ad?, acd?, afd?, ast?).
For now the disk driver will also attach to the old wd major
so one can at least boot without this step, but be warned, this
will eventually go away. The bootblocks will have to be changed
before one can boot directly from an "ad" device though.
Fixed problems:
All known hang problems should be solved
The probe code has been sligthly changed, this should solve
the reports I have lying around (I hope).
Hangs when accessing ata & atapi device on the same channel simultaniously.
A real braino in ata_start caused this, fixed.
As usual USE AT YOUR OWN RISK!!, this is still pre alpha level code.
Especially the DMA support can hose your disk real bad if anything
goes wrong, agaiin you have been warned :)
But please tell me how it works for you!
Enjoy!
-Søren
629 lines
17 KiB
C
629 lines
17 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.
|
|
*
|
|
* $Id: ata-all.c,v 1.4 1999/03/07 21:49:14 sos Exp $
|
|
*/
|
|
|
|
#include "ata.h"
|
|
#if NATA > 0
|
|
#include "isa.h"
|
|
#include "pci.h"
|
|
#include "atadisk.h"
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/interrupt.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/buf.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/devicestat.h>
|
|
#include <vm/vm.h>
|
|
#include <vm/pmap.h>
|
|
#include <machine/clock.h>
|
|
#include <machine/smp.h>
|
|
#include <pci/pcivar.h>
|
|
#include <pci/pcireg.h>
|
|
#include <i386/isa/icu.h>
|
|
#include <i386/isa/isa.h>
|
|
#include <i386/isa/isa_device.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 NSMP == 0
|
|
#define isa_apic_irq(x) x
|
|
#endif
|
|
|
|
/* prototypes */
|
|
#if NISA > 0
|
|
static int32_t ata_isaprobe(struct isa_device *);
|
|
static int32_t ata_isaattach(struct isa_device *);
|
|
#endif
|
|
#if NPCI > 0
|
|
static const char *ata_pciprobe(pcici_t, pcidi_t);
|
|
static void ata_pciattach(pcici_t, int32_t);
|
|
static void promise_intr(int32_t);
|
|
#endif
|
|
static int32_t ata_probe(int32_t, int32_t, int32_t, pcici_t, int32_t *);
|
|
static void ataintr(int32_t);
|
|
|
|
static int32_t atanlun = 0, sysctrl = 0;
|
|
struct ata_softc *atadevices[MAXATA];
|
|
struct isa_driver atadriver = { ata_isaprobe, ata_isaattach, "ata" };
|
|
|
|
#if NISA > 0
|
|
static int32_t
|
|
ata_isaprobe(struct isa_device *devp)
|
|
{
|
|
int32_t ctlr, res;
|
|
|
|
for (ctlr = 0; ctlr < atanlun; ctlr++) {
|
|
if (atadevices[ctlr]->ioaddr == devp->id_iobase) {
|
|
printf("ata-isa%d: already registered as ata%d\n",
|
|
devp->id_unit, ctlr);
|
|
return 0;
|
|
}
|
|
}
|
|
res = ata_probe(devp->id_iobase, devp->id_iobase + ATA_ALTPORT, 0, 0,
|
|
&devp->id_unit);
|
|
if (res)
|
|
devp->id_intr = (inthand2_t *)ataintr;
|
|
return res;
|
|
}
|
|
|
|
static int32_t
|
|
ata_isaattach(struct isa_device *devp)
|
|
{
|
|
return 1;
|
|
}
|
|
#endif
|
|
|
|
#if NPCI > 0
|
|
static u_long ata_pcicount;
|
|
static struct pci_device ata_pcidevice = {
|
|
"ata-pci", ata_pciprobe, ata_pciattach, &ata_pcicount, 0
|
|
};
|
|
|
|
DATA_SET(pcidevice_set, ata_pcidevice);
|
|
|
|
static const char *
|
|
ata_pciprobe(pcici_t tag, pcidi_t type)
|
|
{
|
|
u_int32_t data;
|
|
|
|
data = pci_conf_read(tag, PCI_CLASS_REG);
|
|
if ((data & PCI_CLASS_MASK) == PCI_CLASS_MASS_STORAGE &&
|
|
((data & PCI_SUBCLASS_MASK) == 0x00010000 ||
|
|
((data & PCI_SUBCLASS_MASK) == 0x00040000))) {
|
|
switch (type) {
|
|
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 0x522910b9:
|
|
return "AcerLabs Aladdin IDE controller";
|
|
#if 0
|
|
case 0x05711106:
|
|
return "VIA Apollo IDE controller";
|
|
case 0x01021078:
|
|
return "Cyrix 5530 IDE controller";
|
|
#endif
|
|
default:
|
|
return "Unknown PCI IDE controller";
|
|
}
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
static void
|
|
ata_pciattach(pcici_t tag, int32_t unit)
|
|
{
|
|
pcidi_t type, class, 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_conf_read(tag, PCI_ID_REG);
|
|
class = pci_conf_read(tag, PCI_CLASS_REG);
|
|
cmd = pci_conf_read(tag, PCI_COMMAND_STATUS_REG);
|
|
|
|
#ifdef ATA_DEBUG
|
|
printf("ata%d: type=%08x class=%08x cmd=%08x\n", unit, type, class, cmd);
|
|
#endif
|
|
|
|
/* if this is at Promise controller handle it specially */
|
|
if (type == 0x4d33105a) {
|
|
iobase_1 = pci_conf_read(tag, 0x10) & 0xfffc;
|
|
altiobase_1 = pci_conf_read(tag, 0x14) & 0xfffc;
|
|
iobase_2 = pci_conf_read(tag, 0x18) & 0xfffc;
|
|
altiobase_2 = pci_conf_read(tag, 0x1c) & 0xfffc;
|
|
irq1 = irq2 = pci_conf_read(tag, PCI_INTERRUPT_REG) & 0xff;
|
|
bmaddr_1 = pci_conf_read(tag, 0x20) & 0xfffc;
|
|
bmaddr_2 = bmaddr_1 + ATA_BM_OFFSET1;
|
|
sysctrl = (pci_conf_read(tag, 0x20) & 0xfffc) + 0x1c;
|
|
printf("ata-pci%d: Busmastering DMA supported\n", unit);
|
|
}
|
|
/* everybody else seems to do it this way */
|
|
else {
|
|
if ((class & 0x100) == 0) {
|
|
iobase_1 = IO_WD1;
|
|
altiobase_1 = iobase_1 + ATA_ALTPORT;
|
|
irq1 = 14;
|
|
}
|
|
else {
|
|
iobase_1 = pci_conf_read(tag, 0x10) & 0xfffc;
|
|
altiobase_1 = pci_conf_read(tag, 0x14) & 0xfffc;
|
|
irq1 = pci_conf_read(tag, PCI_INTERRUPT_REG) & 0xff;
|
|
}
|
|
if ((class & 0x400) == 0) {
|
|
iobase_2 = IO_WD2;
|
|
altiobase_2 = iobase_2 + ATA_ALTPORT;
|
|
irq2 = 15;
|
|
}
|
|
else {
|
|
iobase_2 = pci_conf_read(tag, 0x18) & 0xfffc;
|
|
altiobase_2 = pci_conf_read(tag, 0x1c) & 0xfffc;
|
|
irq2 = pci_conf_read(tag, PCI_INTERRUPT_REG) & 0xff;
|
|
}
|
|
|
|
/* is this controller busmaster capable ? */
|
|
if (pci_conf_read(tag, PCI_CLASS_REG) & 0x8000) {
|
|
/* is busmastering support turned on ? */
|
|
if ((pci_conf_read(tag, PCI_COMMAND_STATUS_REG) & 5) == 5) {
|
|
/* is there a valid port range to connect to ? */
|
|
if ((bmaddr_1 = pci_conf_read(tag, 0x20) & 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, tag, &lun)) {
|
|
if (iobase_1 == IO_WD1)
|
|
register_intr(irq1, (int)"", 0, (inthand2_t *)ataintr,
|
|
&bio_imask, lun);
|
|
else {
|
|
if (sysctrl)
|
|
pci_map_int(tag, (inthand2_t *)promise_intr,
|
|
(void *)lun, &bio_imask);
|
|
else
|
|
pci_map_int(tag, (inthand2_t *)ataintr, (void *)lun,&bio_imask);
|
|
}
|
|
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, tag, &lun)) {
|
|
if (iobase_2 == IO_WD2)
|
|
register_intr(irq2, (int)"", 0, (inthand2_t *)ataintr,
|
|
&bio_imask, lun);
|
|
else {
|
|
if (!sysctrl)
|
|
pci_map_int(tag, (inthand2_t *)ataintr, (void *)lun,&bio_imask);
|
|
}
|
|
printf("ata%d at 0x%04x irq %d on ata-pci%d\n",
|
|
lun, iobase_2, isa_apic_irq(irq2), unit);
|
|
}
|
|
}
|
|
|
|
static void
|
|
promise_intr(int32_t unit)
|
|
{
|
|
if (inl(sysctrl) & 0x00000400)
|
|
ataintr(unit);
|
|
if (inl(sysctrl) & 0x00004000)
|
|
ataintr(unit+1);
|
|
}
|
|
#endif
|
|
|
|
static int32_t
|
|
ata_probe(int32_t ioaddr, int32_t altioaddr, int32_t bmaddr,
|
|
pcici_t tag, 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;
|
|
}
|
|
bufq_init(&scp->ata_queue);
|
|
TAILQ_INIT(&scp->atapi_queue);
|
|
*unit = scp->lun;
|
|
scp->tag = tag;
|
|
if (bmaddr)
|
|
scp->bmaddr = bmaddr;
|
|
atadevices[scp->lun] = scp;
|
|
#ifndef ATA_STATIC_ID
|
|
atanlun++;
|
|
#endif
|
|
return ATA_IOSIZE;
|
|
}
|
|
|
|
static void
|
|
ataintr(int32_t unit)
|
|
{
|
|
struct ata_softc *scp;
|
|
struct atapi_request *atapi_request;
|
|
struct buf *ata_request;
|
|
static int32_t intcount = 0;
|
|
|
|
if (unit < 0 || unit > atanlun) {
|
|
printf("ataintr: unit %d unusable\n", unit);
|
|
return;
|
|
}
|
|
|
|
scp = atadevices[unit];
|
|
|
|
/* find & call the responsible driver to process this interrupt */
|
|
switch (scp->active) {
|
|
#if NATADISK > 0
|
|
case ATA_ACTIVE_ATA:
|
|
if ((ata_request = bufq_first(&scp->ata_queue)))
|
|
if (ad_interrupt(ata_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:
|
|
if (intcount++ < 10)
|
|
printf("ata%d: unwanted interrupt %d\n", unit, intcount);
|
|
inb(scp->ioaddr + ATA_STATUS);
|
|
return;
|
|
}
|
|
scp->active = ATA_IDLE;
|
|
ata_start(scp);
|
|
}
|
|
|
|
void
|
|
ata_start(struct ata_softc *scp)
|
|
{
|
|
struct buf *ata_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 ((ata_request = bufq_first(&scp->ata_queue))) {
|
|
scp->active = ATA_ACTIVE_ATA;
|
|
ad_transfer(ata_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_command: addr=%04x, device=%02x, cmd=%02x, c=%d, h=%d, s=%d, count=%d, flags=%02x\n", 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");
|
|
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 */
|