54ecff8b84
Add a missing DELAY(1) in ata_wait. Change the info from ad_version, so the ATA version from the disk can be used to quantify the DAM modes valid for this drive, ie be more selective with turning DMA on on older disks that should not support it.. Fix the probe for BIOS enabled DMA in the generic case, master/slave was reversed in the test. Check the return for ata_command in all cases, and print warnings if it fails. Call ata_dmainit with all dmamodes off when falling back to PIO mode, that should take care of both the Promise & HPT366 controllers not being able to handle the fallback... Cleanup the printf's in the drivers, use the prober device name (if possible) instead of ataN-master/slave.
664 lines
22 KiB
C
664 lines
22 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 "pci.h"
|
|
#include "apm.h"
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/buf.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/disk.h>
|
|
#include <sys/devicestat.h>
|
|
#include <vm/vm.h>
|
|
#include <vm/pmap.h>
|
|
#if NPCI > 0
|
|
#include <pci/pcivar.h>
|
|
#endif
|
|
#if NAPM > 0
|
|
#include <machine/apm_bios.h>
|
|
#endif
|
|
#include <dev/ata/ata-all.h>
|
|
#include <dev/ata/ata-disk.h>
|
|
|
|
/* prototypes */
|
|
static void hpt366_timing(struct ata_softc *, int32_t, int32_t);
|
|
|
|
/* misc defines */
|
|
#define MIN(a,b) ((a)>(b)?(b):(a))
|
|
#ifdef __alpha__
|
|
#undef vtophys
|
|
#define vtophys(va) alpha_XXX_dmamap((vm_offset_t)va)
|
|
#endif
|
|
|
|
#if NPCI > 0
|
|
|
|
int32_t
|
|
ata_dmainit(struct ata_softc *scp, int32_t device,
|
|
int32_t apiomode, int32_t wdmamode, int32_t udmamode)
|
|
{
|
|
int32_t type, devno, error;
|
|
void *dmatab;
|
|
|
|
if (!scp->bmaddr)
|
|
return -1;
|
|
#ifdef ATA_DMADEBUG
|
|
printf("ata%d: dmainit: ioaddr=0x%x altioaddr=0x%x, bmaddr=0x%x\n",
|
|
scp->lun, scp->ioaddr, scp->altioaddr, scp->bmaddr);
|
|
#endif
|
|
|
|
/* if simplex controller, only allow DMA on primary channel */
|
|
if (scp->unit == 1) {
|
|
outb(scp->bmaddr + ATA_BMSTAT_PORT, inb(scp->bmaddr + ATA_BMSTAT_PORT) &
|
|
(ATA_BMSTAT_DMA_MASTER | ATA_BMSTAT_DMA_SLAVE));
|
|
if (inb(scp->bmaddr + ATA_BMSTAT_PORT) & ATA_BMSTAT_DMA_SIMPLEX) {
|
|
printf("ata%d: simplex device, DMA on primary channel only\n",
|
|
scp->lun);
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
if (!(dmatab = malloc(PAGE_SIZE, M_DEVBUF, M_NOWAIT)))
|
|
return -1;
|
|
|
|
if (((uintptr_t)dmatab >> PAGE_SHIFT) ^
|
|
(((uintptr_t)dmatab + PAGE_SIZE - 1) >> PAGE_SHIFT)) {
|
|
printf("ata_dmainit: dmatab crosses page boundary, no DMA\n");
|
|
free(dmatab, M_DEVBUF);
|
|
return -1;
|
|
}
|
|
scp->dmatab[(device == ATA_MASTER) ? 0 : 1] = dmatab;
|
|
|
|
switch (type = pci_get_devid(scp->dev)) {
|
|
|
|
case 0x71118086: /* Intel PIIX4 */
|
|
if (udmamode >= 2) {
|
|
int32_t mask48, new48;
|
|
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up UDMA2 mode on PIIX4 chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
devno = (scp->unit << 1) + ((device == ATA_MASTER) ? 0 : 1);
|
|
mask48 = (1 << devno) + (3 << (16 + (devno << 2)));
|
|
new48 = (1 << devno) + (2 << (16 + (devno << 2)));
|
|
pci_write_config(scp->dev, 0x48,
|
|
(pci_read_config(scp->dev, 0x48, 4) &
|
|
~mask48) | new48, 4);
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_UDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
/* FALLTHROUGH */
|
|
|
|
case 0x70108086: /* Intel PIIX3 */
|
|
if (wdmamode >= 2 && apiomode >= 4) {
|
|
int32_t mask40, new40, mask44, new44;
|
|
|
|
/* if SITRE not set doit for both channels */
|
|
if (!((pci_read_config(scp->dev, 0x40, 4)>>(scp->unit<<8))&0x4000)){
|
|
new40 = pci_read_config(scp->dev, 0x40, 4);
|
|
new44 = pci_read_config(scp->dev, 0x44, 4);
|
|
if (!(new40 & 0x00004000)) {
|
|
new44 &= ~0x0000000f;
|
|
new44 |= ((new40&0x00003000)>>10)|((new40&0x00000300)>>8);
|
|
}
|
|
if (!(new40 & 0x40000000)) {
|
|
new44 &= ~0x000000f0;
|
|
new44 |= ((new40&0x30000000)>>22)|((new40&0x03000000)>>20);
|
|
}
|
|
new40 |= 0x40004000;
|
|
pci_write_config(scp->dev, 0x40, new40, 4);
|
|
pci_write_config(scp->dev, 0x44, new44, 4);
|
|
}
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up WDMA2 mode on PIIX4 chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
if (device == ATA_MASTER) {
|
|
mask40 = 0x0000330f;
|
|
new40 = 0x00002307;
|
|
mask44 = 0;
|
|
new44 = 0;
|
|
}
|
|
else {
|
|
mask40 = 0x000000f0;
|
|
new40 = 0x00000070;
|
|
mask44 = 0x0000000f;
|
|
new44 = 0x0000000b;
|
|
}
|
|
if (scp->unit) {
|
|
mask40 <<= 16;
|
|
new40 <<= 16;
|
|
mask44 <<= 4;
|
|
new44 <<= 4;
|
|
}
|
|
pci_write_config(scp->dev, 0x40,
|
|
(pci_read_config(scp->dev, 0x40, 4) & ~mask40)|
|
|
new40, 4);
|
|
pci_write_config(scp->dev, 0x44,
|
|
(pci_read_config(scp->dev, 0x44, 4) & ~mask44)|
|
|
new44, 4);
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_WDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
/* we could set PIO mode timings, but we assume the BIOS did that */
|
|
break;
|
|
|
|
case 0x12308086: /* Intel PIIX */
|
|
if (wdmamode >= 2 && apiomode >= 4) {
|
|
int32_t word40;
|
|
|
|
word40 = pci_read_config(scp->dev, 0x40, 4);
|
|
word40 >>= scp->unit * 16;
|
|
|
|
/* Check for timing config usable for DMA on controller */
|
|
if (!((word40 & 0x3300) == 0x2300 &&
|
|
((word40 >> (device == ATA_MASTER ? 0 : 4)) & 1) == 1))
|
|
break;
|
|
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up WDMA2 mode on PIIX chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_WDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
break;
|
|
|
|
case 0x522910b9: /* AcerLabs Aladdin IV/V */
|
|
/* the Aladdin doesn't support ATAPI DMA on both master & slave */
|
|
if (scp->devices & ATA_ATAPI_MASTER && scp->devices & ATA_ATAPI_SLAVE) {
|
|
printf("ata%d: Aladdin: two atapi devices on this channel, "
|
|
"DMA disabled\n", scp->lun);
|
|
break;
|
|
}
|
|
if (udmamode >= 2) {
|
|
int32_t word54 = pci_read_config(scp->dev, 0x54, 4);
|
|
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up UDMA2 mode on Aladdin chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
word54 |= 0x5555;
|
|
word54 |= (0x0a << (16 + (scp->unit << 3) + (device << 2)));
|
|
pci_write_config(scp->dev, 0x54, word54, 4);
|
|
pci_write_config(scp->dev, 0x53,
|
|
pci_read_config(scp->dev, 0x53, 1) | 0x03, 1);
|
|
scp->flags |= ATA_ATAPI_DMA_RO;
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_UDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
if (wdmamode >= 2 && apiomode >= 4) {
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up WDMA2 mode on Aladdin chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
pci_write_config(scp->dev, 0x53,
|
|
pci_read_config(scp->dev, 0x53, 1) | 0x03, 1);
|
|
scp->flags |= ATA_ATAPI_DMA_RO;
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_WDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
/* we could set PIO mode timings, but we assume the BIOS did that */
|
|
break;
|
|
|
|
case 0x05711106: /* VIA Apollo 82c571 / 82c586 / 82c686 */
|
|
devno = (scp->unit << 1) + ((device == ATA_MASTER) ? 0 : 1);
|
|
|
|
/* UDMA4 mode only on rev 6 (VT82C686) hardware */
|
|
if (udmamode >= 4 && pci_read_config(scp->dev, 0x08, 1) == 0x06) {
|
|
int8_t byte = pci_read_config(scp->dev, 0x53 - devno, 1);
|
|
|
|
/* enable UDMA transfer modes setting by SETFEATURES cmd */
|
|
pci_write_config(scp->dev, 0x53 - devno, (byte & 0x1c) | 0x40, 1);
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up UDMA4 mode on VIA chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master":"slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_UDMA4;
|
|
return 0;
|
|
}
|
|
pci_write_config(scp->dev, 0x53 - devno, byte, 1);
|
|
}
|
|
|
|
/* UDMA2 mode only on rev 1 and up (VT82C586, VT82C686) hardware */
|
|
if (udmamode >= 2 && pci_read_config(scp->dev, 0x08, 1) >= 0x01) {
|
|
int8_t byte = pci_read_config(scp->dev, 0x53 - devno, 1);
|
|
|
|
/* enable UDMA transfer modes setting by SETFEATURES cmd */
|
|
pci_write_config(scp->dev, 0x53 - devno, (byte & 0x1c) | 0x40, 1);
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up UDMA2 mode on VIA chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
if ((device == ATA_MASTER && scp->devices & ATA_ATA_MASTER) ||
|
|
(device == ATA_SLAVE && scp->devices & ATA_ATA_SLAVE)) {
|
|
struct ata_params *ap = ((struct ad_softc *)
|
|
(scp->dev_softc[(device==ATA_MASTER)?0:1]))->ata_parm;
|
|
|
|
if ((pci_read_config(scp->dev, 0x08, 1) == 0x06) &&
|
|
(ap->udmamodes & 0x10) && !ap->cblid) {
|
|
pci_write_config(scp->dev, 0x53 - devno,
|
|
(byte & 0x1c) | 0x42, 1);
|
|
}
|
|
}
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_UDMA2;
|
|
return 0;
|
|
}
|
|
pci_write_config(scp->dev, 0x53 - devno, byte, 1);
|
|
}
|
|
if (wdmamode >= 2 && apiomode >= 4) {
|
|
/* set WDMA2 mode timing */
|
|
pci_write_config(scp->dev, 0x4b - devno, 0x31 , 1);
|
|
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up WDMA2 mode on VIA chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_WDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
/* we could set PIO mode timings, but we assume the BIOS did that */
|
|
break;
|
|
|
|
case 0x55131039: /* SiS 5591 */
|
|
devno = (scp->unit << 1) + ((device == ATA_MASTER) ? 0 : 1);
|
|
if (udmamode >= 2) {
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up UDMA2 mode on SiS chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
pci_write_config(scp->dev, 0x40 + (devno << 1), 0xa301, 2);
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_UDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
if (wdmamode >=2 && apiomode >= 4) {
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up WDMA2 mode on SiS chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
pci_write_config(scp->dev, 0x40 + (devno << 1), 0x0301, 2);
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_WDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
/* we could set PIO mode timings, but we assume the BIOS did that */
|
|
break;
|
|
|
|
case 0x4d33105a: /* Promise Ultra33 / FastTrak33 controllers */
|
|
case 0x4d38105a: /* Promise Ultra66 / FastTrak66 controllers */
|
|
/* the Promise can only do DMA on ATA disks not on ATAPI devices */
|
|
if ((device == ATA_MASTER && scp->devices & ATA_ATAPI_MASTER) ||
|
|
(device == ATA_SLAVE && scp->devices & ATA_ATAPI_SLAVE))
|
|
break;
|
|
|
|
devno = (scp->unit << 1) + ((device == ATA_MASTER) ? 0 : 1);
|
|
if (udmamode >=4 && type == 0x4d38105a &&
|
|
!(pci_read_config(scp->dev, 0x50, 2)&(scp->unit ? 1<<11 : 1<<10))) {
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up UDMA4 mode on Promise chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
outb(scp->bmaddr+0x11, inl(scp->bmaddr+0x11) | scp->unit ? 8:2);
|
|
pci_write_config(scp->dev, 0x60 + (devno << 2), 0x004127f3, 4);
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_UDMA4;
|
|
return 0;
|
|
}
|
|
}
|
|
if (udmamode >= 2) {
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up UDMA2 mode on Promise chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
pci_write_config(scp->dev, 0x60 + (devno << 2), 0x004127f3, 4);
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_UDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
if (wdmamode >= 2 && apiomode >= 4) {
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up WDMA2 mode on Promise chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
pci_write_config(scp->dev, 0x60 + (devno << 2), 0x004367f3, 4);
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_WDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
if (bootverbose)
|
|
printf("ata%d: %s: setting PIO mode on Promise chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave");
|
|
pci_write_config(scp->dev, 0x60 + (devno << 2), 0x004fe924, 4);
|
|
break;
|
|
|
|
case 0x00041103: /* HighPoint HPT366 controller */
|
|
/* no ATAPI devices for now */
|
|
if ((device == ATA_MASTER && scp->devices & ATA_ATAPI_MASTER) ||
|
|
(device == ATA_SLAVE && scp->devices & ATA_ATAPI_SLAVE))
|
|
break;
|
|
|
|
devno = (device == ATA_MASTER) ? 0 : 1;
|
|
if (udmamode >=4 && !(pci_read_config(scp->dev, 0x5a, 1) & 0x2)) {
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up UDMA4 mode on HPT366 chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
hpt366_timing(scp, device, ATA_MODE_UDMA4);
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_UDMA4;
|
|
return 0;
|
|
}
|
|
}
|
|
if (udmamode >=3 && !(pci_read_config(scp->dev, 0x5a, 1) & 0x2)) {
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA3, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up UDMA3 mode on HPT366 chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
hpt366_timing(scp, device, ATA_MODE_UDMA3);
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_UDMA3;
|
|
return 0;
|
|
}
|
|
}
|
|
if (udmamode >= 2) {
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up UDMA2 mode on HPT366 chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
hpt366_timing(scp, device, ATA_MODE_UDMA2);
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_UDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
if (wdmamode >= 2 && apiomode >= 4) {
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up WDMA2 mode on HPT366 chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
hpt366_timing(scp, device, ATA_MODE_WDMA2);
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_WDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
if (bootverbose)
|
|
printf("ata%d: %s: setting PIO mode on HPT366 chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave");
|
|
hpt366_timing(scp, device, ATA_MODE_PIO);
|
|
break;
|
|
|
|
default: /* unknown controller chip */
|
|
/* better not try generic DMA on ATAPI devices it almost never works */
|
|
if ((device == ATA_MASTER && scp->devices & ATA_ATAPI_MASTER) ||
|
|
(device == ATA_SLAVE && scp->devices & ATA_ATAPI_SLAVE))
|
|
break;
|
|
|
|
/* well, we have no support for this, but try anyways */
|
|
if (((wdmamode >= 2 && apiomode >= 4) || udmamode >= 2) &&
|
|
(inb(scp->bmaddr + ATA_BMSTAT_PORT) &
|
|
((device == ATA_MASTER) ?
|
|
ATA_BMSTAT_DMA_MASTER : ATA_BMSTAT_DMA_SLAVE))) {
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
|
|
if (bootverbose)
|
|
printf("ata%d: %s: %s setting up WDMA2 mode on generic chip\n",
|
|
scp->lun, (device == ATA_MASTER) ? "master" : "slave",
|
|
(error) ? "failed" : "success");
|
|
if (!error) {
|
|
scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_MODE_WDMA2;
|
|
return 0;
|
|
}
|
|
}
|
|
}
|
|
free(dmatab, M_DEVBUF);
|
|
return -1;
|
|
}
|
|
|
|
int32_t
|
|
ata_dmasetup(struct ata_softc *scp, int32_t device,
|
|
int8_t *data, int32_t count, int32_t flags)
|
|
{
|
|
struct ata_dmaentry *dmatab;
|
|
u_int32_t dma_count, dma_base;
|
|
int32_t i = 0;
|
|
|
|
#ifdef ATA_DMADEBUG
|
|
printf("ata%d: dmasetup\n", scp->lun);
|
|
#endif
|
|
if (((uintptr_t)data & 1) || (count & 1))
|
|
return -1;
|
|
|
|
if (!count) {
|
|
#ifdef ATA_DMADEBUG
|
|
printf("ata%d: zero length DMA transfer attempt on %s\n",
|
|
scp->lun, ((device == ATA_MASTER) ? "master" : "slave"));
|
|
#endif
|
|
return -1;
|
|
}
|
|
|
|
dmatab = scp->dmatab[(device == ATA_MASTER) ? 0 : 1];
|
|
dma_base = vtophys(data);
|
|
dma_count = MIN(count, (PAGE_SIZE - ((uintptr_t)data & PAGE_MASK)));
|
|
data += dma_count;
|
|
count -= dma_count;
|
|
|
|
while (count) {
|
|
dmatab[i].base = dma_base;
|
|
dmatab[i].count = (dma_count & 0xffff);
|
|
i++;
|
|
if (i >= ATA_DMA_ENTRIES) {
|
|
printf("ata%d: too many segments in DMA table for %s\n",
|
|
scp->lun, (device ? "slave" : "master"));
|
|
return -1;
|
|
}
|
|
dma_base = vtophys(data);
|
|
dma_count = MIN(count, PAGE_SIZE);
|
|
data += MIN(count, PAGE_SIZE);
|
|
count -= MIN(count, PAGE_SIZE);
|
|
}
|
|
#ifdef ATA_DMADEBUG
|
|
printf("ata_dmasetup: base=%08x count%08x\n", dma_base, dma_count);
|
|
#endif
|
|
dmatab[i].base = dma_base;
|
|
dmatab[i].count = (dma_count & 0xffff) | ATA_DMA_EOT;
|
|
|
|
outl(scp->bmaddr + ATA_BMDTP_PORT, vtophys(dmatab));
|
|
#ifdef ATA_DMADEBUG
|
|
printf("dmatab=%08x %08x\n",
|
|
vtophys(dmatab), inl(scp->bmaddr+ATA_BMDTP_PORT));
|
|
#endif
|
|
outb(scp->bmaddr + ATA_BMCMD_PORT, flags ? ATA_BMCMD_WRITE_READ:0);
|
|
outb(scp->bmaddr + ATA_BMSTAT_PORT, (inb(scp->bmaddr + ATA_BMSTAT_PORT) |
|
|
(ATA_BMSTAT_INTERRUPT | ATA_BMSTAT_ERROR)));
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
ata_dmastart(struct ata_softc *scp)
|
|
{
|
|
#ifdef ATA_DMADEBUG
|
|
printf("ata%d: dmastart\n", scp->lun);
|
|
#endif
|
|
scp->flags |= ATA_DMA_ACTIVE;
|
|
outb(scp->bmaddr + ATA_BMCMD_PORT,
|
|
inb(scp->bmaddr + ATA_BMCMD_PORT) | ATA_BMCMD_START_STOP);
|
|
}
|
|
|
|
int32_t
|
|
ata_dmadone(struct ata_softc *scp)
|
|
{
|
|
#ifdef ATA_DMADEBUG
|
|
printf("ata%d: dmadone\n", scp->lun);
|
|
#endif
|
|
outb(scp->bmaddr + ATA_BMCMD_PORT,
|
|
inb(scp->bmaddr + ATA_BMCMD_PORT) & ~ATA_BMCMD_START_STOP);
|
|
scp->flags &= ~ATA_DMA_ACTIVE;
|
|
return inb(scp->bmaddr + ATA_BMSTAT_PORT) & ATA_BMSTAT_MASK;
|
|
}
|
|
|
|
int32_t
|
|
ata_dmastatus(struct ata_softc *scp)
|
|
{
|
|
#ifdef ATA_DMADEBUG
|
|
printf("ata%d: dmastatus\n", scp->lun);
|
|
#endif
|
|
return inb(scp->bmaddr + ATA_BMSTAT_PORT) & ATA_BMSTAT_MASK;
|
|
}
|
|
|
|
static void
|
|
hpt366_timing(struct ata_softc *scp, int32_t device, int32_t mode)
|
|
{
|
|
u_int32_t timing;
|
|
|
|
switch (pci_read_config(scp->dev, (device == ATA_MASTER) ? 0x41 : 0x45, 1)){
|
|
case 0x85: /* 25Mhz */
|
|
switch (mode) {
|
|
case ATA_MODE_PIO: timing = 0xc0ca8521; break;
|
|
case ATA_MODE_WDMA2: timing = 0xa0ca8521; break;
|
|
case ATA_MODE_UDMA2:
|
|
case ATA_MODE_UDMA3: timing = 0x90cf8521; break;
|
|
case ATA_MODE_UDMA4: timing = 0x90c98521; break;
|
|
default: timing = 0x01208585;
|
|
}
|
|
break;
|
|
default:
|
|
case 0xa7: /* 33MHz */
|
|
switch (mode) {
|
|
case ATA_MODE_PIO: timing = 0xc0c8a731; break;
|
|
case ATA_MODE_WDMA2: timing = 0xa0c8a731; break;
|
|
case ATA_MODE_UDMA2: timing = 0x90caa731; break;
|
|
case ATA_MODE_UDMA3: timing = 0x90cfa731; break;
|
|
case ATA_MODE_UDMA4: timing = 0x90c9a731; break;
|
|
default: timing = 0x0120a7a7;
|
|
}
|
|
break;
|
|
case 0xd9: /* 40Mhz */
|
|
switch (mode) {
|
|
case ATA_MODE_PIO: timing = 0xc008d963; break;
|
|
case ATA_MODE_WDMA2: timing = 0xa008d943; break;
|
|
case ATA_MODE_UDMA2: timing = 0x900bd943; break;
|
|
case ATA_MODE_UDMA3: timing = 0x900ad943; break;
|
|
case ATA_MODE_UDMA4: timing = 0x900fd943; break;
|
|
default: timing = 0x0120d9d9;
|
|
}
|
|
}
|
|
pci_write_config(scp->dev, 0x40 + (device==ATA_MASTER ? 0 : 4), timing, 4);
|
|
}
|
|
|
|
#else /* NPCI > 0 */
|
|
|
|
int32_t
|
|
ata_dmainit(struct ata_softc *scp, int32_t device,
|
|
int32_t piomode, int32_t wdmamode, int32_t udmamode)
|
|
{
|
|
return -1;
|
|
}
|
|
|
|
int32_t
|
|
ata_dmasetup(struct ata_softc *scp, int32_t device,
|
|
int8_t *data, int32_t count, int32_t flags)
|
|
{
|
|
return -1;
|
|
}
|
|
|
|
void
|
|
ata_dmastart(struct ata_softc *scp)
|
|
{
|
|
}
|
|
|
|
int32_t
|
|
ata_dmadone(struct ata_softc *scp)
|
|
{
|
|
return -1;
|
|
}
|
|
|
|
int32_t
|
|
ata_dmastatus(struct ata_softc *scp)
|
|
{
|
|
return -1;
|
|
}
|
|
|
|
#endif /* NPCI > 0 */
|