mirror of
https://github.com/freebsd/freebsd-src
synced 2024-10-19 06:44:31 +00:00
775986fc09
Fixed problems:
Promise controllers was not always set up correctly.
Parantheses are a good thing, fixed.
Some older CDROM's could hang the probe.
Proberly wait for the drive to catch its breath after IDENTIFY.
Some CD writers fails because they dont support rezero.
Rearranged the code to not use rezero.
Warnings now that we use EGCS.
Fixed.
366 lines
11 KiB
C
366 lines
11 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-dma.c,v 1.3 1999/03/30 13:09:47 sos Exp $
|
|
*/
|
|
|
|
#include "ata.h"
|
|
#include "pci.h"
|
|
#if NATA > 0
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/buf.h>
|
|
#include <sys/malloc.h>
|
|
#include <vm/vm.h>
|
|
#include <vm/pmap.h>
|
|
#include <pci/pcivar.h>
|
|
#include <pci/pcireg.h>
|
|
#include <dev/ata/ata-all.h>
|
|
|
|
/* misc defines */
|
|
#define MIN(a,b) ((a)>(b)?(b):(a))
|
|
|
|
#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_DEBUGDMA
|
|
printf("ata%d: dmainit: ioaddr=0x%x altioaddr=0x%x, bmaddr=0x%x\n",
|
|
scp->lun, scp->ioaddr, scp->altioaddr, scp->bmaddr);
|
|
#endif
|
|
|
|
if (!(dmatab = malloc(PAGE_SIZE, M_DEVBUF, M_NOWAIT)))
|
|
return -1;
|
|
|
|
if (((int)dmatab>>PAGE_SHIFT)^(((int)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 ? 1 : 0] = dmatab;
|
|
|
|
type = pci_conf_read(scp->tag, PCI_ID_REG);
|
|
|
|
switch(type) {
|
|
|
|
case 0x71118086: /* Intel PIIX4 */
|
|
if (udmamode >= 2) {
|
|
int32_t mask48, new48;
|
|
|
|
printf("ata%d: %s: settting up UDMA2 mode on PIIX4 chip ",
|
|
scp->lun, (device) ? "slave" : "master");
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA2, ATA_C_FEA_SETXFER, ATA_WAIT_INTR);
|
|
if (error) {
|
|
printf("failed\n");
|
|
break;
|
|
}
|
|
printf("OK\n");
|
|
devno = (scp->unit << 1) + (device ? 1 : 0);
|
|
mask48 = (1 << devno) + (3 << (16 + (devno << 2)));
|
|
new48 = (1 << devno) + (2 << (16 + (devno << 2)));
|
|
pci_conf_write(scp->tag, 0x48,
|
|
(pci_conf_read(scp->tag, 0x48) & ~mask48) | new48);
|
|
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_conf_read(scp->tag, 0x40) >> (scp->unit<<8)) & 0x4000)) {
|
|
new40 = pci_conf_read(scp->tag, 0x40);
|
|
new44 = pci_conf_read(scp->tag, 0x44);
|
|
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_conf_write(scp->tag, 0x40, new40);
|
|
pci_conf_write(scp->tag, 0x44, new44);
|
|
}
|
|
printf("ata%d: %s: settting up WDMA2 mode on PIIX3/4 chip ",
|
|
scp->lun, (device) ? "slave" : "master");
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_FEA_SETXFER, ATA_WAIT_INTR);
|
|
if (error) {
|
|
printf("failed\n");
|
|
break;
|
|
}
|
|
printf("OK\n");
|
|
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_conf_write(scp->tag, 0x40,
|
|
(pci_conf_read(scp->tag, 0x40) & ~mask40) | new40);
|
|
pci_conf_write(scp->tag, 0x44,
|
|
(pci_conf_read(scp->tag, 0x44) & ~mask44) | new44);
|
|
return 0;
|
|
}
|
|
break;
|
|
|
|
case 0x12308086: /* Intel PIIX */
|
|
/* probably not worth the trouble */
|
|
break;
|
|
|
|
case 0x4d33105a: /* Promise Ultra/33 / FastTrack controllers */
|
|
devno = (scp->unit << 1) + (device ? 1 : 0);
|
|
if (udmamode >=2) {
|
|
printf("ata%d: %s: settting up UDMA2 mode on Promise chip ",
|
|
scp->lun, (device) ? "slave" : "master");
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA2, ATA_C_FEA_SETXFER, ATA_WAIT_INTR);
|
|
if (error) {
|
|
printf("failed\n");
|
|
break;
|
|
}
|
|
printf("OK\n");
|
|
pci_conf_write(scp->tag, 0x60 + (devno << 2), 0x004127f3);
|
|
return 0;
|
|
}
|
|
else if (wdmamode >= 2 && apiomode >= 4) {
|
|
printf("ata%d: %s: settting up WDMA2 mode on Promise chip ",
|
|
scp->lun, (device) ? "slave" : "master");
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_FEA_SETXFER, ATA_WAIT_INTR);
|
|
if (error) {
|
|
printf("failed\n");
|
|
break;
|
|
}
|
|
printf("OK\n");
|
|
pci_conf_write(scp->tag, 0x60 + (devno << 2), 0x004367f3);
|
|
return 0;
|
|
}
|
|
else {
|
|
printf("ata%d: %s: settting up PIO mode on Promise chip OK\n",
|
|
scp->lun, (device) ? "slave" : "master");
|
|
pci_conf_write(scp->tag, 0x60 + (devno << 2), 0x004fe924);
|
|
}
|
|
break;
|
|
|
|
case 0x522910b9: /* AcerLabs Aladdin IV/V */
|
|
if (udmamode >=2) {
|
|
int32_t word54 = pci_conf_read(scp->tag, 0x54);
|
|
|
|
printf("ata%d: %s: settting up UDMA2 mode on Aladdin chip ",
|
|
scp->lun, (device) ? "slave" : "master");
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_UDMA2, ATA_C_FEA_SETXFER, ATA_WAIT_INTR);
|
|
if (error) {
|
|
printf("failed\n");
|
|
break;
|
|
}
|
|
printf("OK\n");
|
|
word54 |= 0x5555;
|
|
word54 |= (0x0000000A << (16 + (scp->unit << 3) + (device << 2)));
|
|
pci_conf_write(scp->tag, 0x54, word54);
|
|
return 0;
|
|
|
|
}
|
|
else if (wdmamode >= 2 && apiomode >= 4) {
|
|
printf("ata%d: %s: settting up WDMA2 mode on Aladdin chip ",
|
|
scp->lun, (device) ? "slave" : "master");
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_FEA_SETXFER, ATA_WAIT_INTR);
|
|
if (error) {
|
|
printf("failed\n");
|
|
break;
|
|
}
|
|
printf("OK\n");
|
|
return 0;
|
|
}
|
|
break;
|
|
|
|
default: /* well, we have no support for this, but try anyways */
|
|
if ((wdmamode >= 2 && apiomode >= 4) || udmamode >= 2) {
|
|
printf("ata%d: %s: settting up generic WDMA2 mode ",
|
|
scp->lun, (device) ? "slave" : "master");
|
|
error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
|
|
ATA_WDMA2, ATA_C_FEA_SETXFER, ATA_WAIT_INTR);
|
|
if (error) {
|
|
printf("failed\n");
|
|
break;
|
|
}
|
|
printf("OK\n");
|
|
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_DEBUGDMA
|
|
printf("ata%d: dmasetup\n", scp->lun);
|
|
#endif
|
|
if (((u_int32_t)data & 1) || (count & 1))
|
|
return -1;
|
|
|
|
if (!count) {
|
|
printf("ata%d: zero length DMA transfer attempt on %s\n",
|
|
scp->lun, (device ? "slave" : "master"));
|
|
return -1;
|
|
}
|
|
|
|
dmatab = scp->dmatab[device ? 1 : 0];
|
|
dma_base = vtophys(data);
|
|
dma_count = MIN(count, (PAGE_SIZE - ((u_int32_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_DEBUGDMA
|
|
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_DEBUGDMA
|
|
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, int32_t device)
|
|
{
|
|
#ifdef ATA_DEBUGDMA
|
|
printf("ata%d: dmastart\n", scp->lun);
|
|
#endif
|
|
outb(scp->bmaddr + ATA_BMCMD_PORT,
|
|
inb(scp->bmaddr + ATA_BMCMD_PORT) | ATA_BMCMD_START_STOP);
|
|
}
|
|
|
|
int32_t
|
|
ata_dmadone(struct ata_softc *scp, int32_t device)
|
|
{
|
|
#ifdef ATA_DEBUGDMA
|
|
printf("ata%d: dmadone\n", scp->lun);
|
|
#endif
|
|
outb(scp->bmaddr + ATA_BMCMD_PORT,
|
|
inb(scp->bmaddr + ATA_BMCMD_PORT) & ~ATA_BMCMD_START_STOP);
|
|
return inb(scp->bmaddr + ATA_BMSTAT_PORT) & ATA_BMSTAT_MASK;
|
|
}
|
|
|
|
int32_t
|
|
ata_dmastatus(struct ata_softc *scp, int32_t device)
|
|
{
|
|
#ifdef ATA_DEBUGDMA
|
|
printf("ata%d: dmastatus\n", scp->lun);
|
|
#endif
|
|
return inb(scp->bmaddr + ATA_BMSTAT_PORT) & ATA_BMSTAT_MASK;
|
|
}
|
|
|
|
#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 device)
|
|
{
|
|
}
|
|
|
|
int32_t
|
|
ata_dmadone(struct ata_softc *scp, int32_t device)
|
|
{
|
|
return -1;
|
|
}
|
|
|
|
int32_t
|
|
ata_dmastatus(struct ata_softc *scp, int32_t device)
|
|
{
|
|
return -1;
|
|
}
|
|
|
|
#endif /* NPCI > 0 */
|
|
#endif /* NATA > 0 */
|