/* * Copyright 1996 Massachusetts Institute of Technology * * Permission to use, copy, modify, and distribute this software and * its documentation for any purpose and without fee is hereby * granted, provided that both the above copyright notice and this * permission notice appear in all copies, that both the above * copyright notice and this permission notice appear in all * supporting documentation, and that the name of M.I.T. not be used * in advertising or publicity pertaining to distribution of the * software without specific, written prior permission. M.I.T. makes * no representations about the suitability of this software for any * purpose. It is provided "as is" without express or implied * warranty. * * THIS SOFTWARE IS PROVIDED BY M.I.T. ``AS IS''. M.I.T. DISCLAIMS * ALL EXPRESS OR IMPLIED WARRANTIES WITH REGARD TO THIS SOFTWARE, * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT * SHALL M.I.T. 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. * * From: wd82371.c,v 1.5.2.1 1996/11/16 21:19:51 phk Exp $ * $Id: ide_pci.c,v 1.2 1997/08/02 14:33:09 bde Exp $ */ #include "pci.h" #if NPCI > 0 #include "opt_wd.h" #include #include #include #include #include #include #include #include #include #include #include #ifndef MIN #define MIN(a,b) (((a)<(b))?(a):(b)) #endif struct ide_pci_cookie; /* structs vendor_fns, ide_pci_cookie are recursive */ struct vendor_fns { int (*vendor_dmainit) /* initialize DMA controller and drive */ (struct ide_pci_cookie *cookie, struct wdparams *wp, int(*wdcmd)(int, void *), void *); void (*vendor_status) /* prints off DMA timing info */ (struct ide_pci_cookie *cookie); }; /* * XXX the fact that this list keeps all kinds of info on PCI controllers * is pretty grotty-- much of this should be replaced by a proper integration * of PCI probes into the wd driver. * XXX if we're going to support native-PCI controllers, we also need to * keep the address of the IDE control block register, which is something wd.c * needs to know, which is why this info is in the wrong place. */ struct ide_pci_cookie { LIST_ENTRY(ide_pci_cookie) le; int iobase_wd; int ctlr; /* pri/sec controller on this PCI IDE interface */ int unit; int iobase_bm; /* SFF-8038 control registers */ pcici_t tag; pcidi_t type; struct ide_pci_prd *prd; struct vendor_fns vs; }; struct ide_pci_softc { LIST_HEAD(, ide_pci_cookie) cookies; }; static int generic_dmainit(struct ide_pci_cookie *cookie, struct wdparams *wp, int(*wdcmd)(int, void *), void *wdinfo); static void generic_status(struct ide_pci_cookie *cookie); static void via_571_status(struct ide_pci_cookie *cookie); static void intel_piix_dump_drive(char *ctlr, int sitre, int is_piix4, int word40, int word44, int word48, int word4a, int drive); static void intel_piix_status(struct ide_pci_cookie *cookie); static int intel_piix_dmainit(struct ide_pci_cookie *cookie, struct wdparams *wp, int(*wdcmd)(int, void *), void *wdinfo); static struct ide_pci_cookie * mkcookie(int iobase_wd, int ctlr, int unit, int iobase_bm, pcici_t tag, pcidi_t type, struct vendor_fns *vp); static void ide_pci_attach(pcici_t tag, int unit); static void *ide_pci_candma(int, int); static int ide_pci_dmainit(void *, struct wdparams *, int (*)(int, void *), void *); static int ide_pci_dmaverify(void *, char *, u_long, int); static int ide_pci_dmasetup(void *, char *, u_long, int); static void ide_pci_dmastart(void *); static int ide_pci_dmadone(void *); static int ide_pci_status(void *); static int ide_pci_timing(void *, int); static struct ide_pci_softc softc; static int ide_pci_softc_cookies_initted = 0; /* * PRD_ALLOC_SIZE should be something that will not be allocated across a 64k * boundary. * PRD_MAX_SEGS is defined to be the maximum number of segments required for * a transfer on an IDE drive, for an xfer that is linear in virtual memory. * PRD_BUF_SIZE is the size of the buffer needed for a PRD table. */ #define PRD_ALLOC_SIZE PAGE_SIZE #define PRD_MAX_SEGS ((256 * 512 / PAGE_SIZE) + 1) #define PRD_BUF_SIZE PRD_MAX_SEGS * 8 static void *prdbuf = 0; static void *prdbuf_next = 0; /* * Hardware specific IDE controller code. All vendor-specific code * for handling IDE timing and other chipset peculiarities should be * encapsulated here. */ /* Generic busmastering PCI-IDE */ static int generic_dmainit(struct ide_pci_cookie *cookie, struct wdparams *wp, int(*wdcmd)(int, void *), void *wdinfo) { /* * punt on the whole timing issue by looking for either a * drive programmed for both PIO4 and mDMA2 (which use similar * timing) or a drive in an UltraDMA mode (hopefully all * controllers have separate timing for UDMA). one hopes that if * the drive's DMA mode has been configured by the BIOS, the * controller's has also. */ /* XXX way too sick and twisted conditional */ if (!((((wp->wdp_atavalid & 2) == 2) && ((wp->wdp_dmamword & 0x404) == 0x404) && ((wp->wdp_eidepiomodes & 2) == 2)) || (((wp->wdp_atavalid & 4) == 4) && (wp->wdp_udmamode == 4)))) return 0; return 1; } static void generic_status(struct ide_pci_cookie *cookie) { printf("generic_status: no PCI IDE timing info available\n"); } static struct vendor_fns vs_generic = { generic_dmainit, generic_status }; /* VIA Technologies "82C571" PCI-IDE controller core */ static void via_571_status(struct ide_pci_cookie *cookie) { int iobase_wd; int unit; int iobase_bm; pcici_t tag; pcidi_t type; unsigned int word40[5]; int i; iobase_wd = cookie->iobase_wd; unit = cookie->unit; iobase_bm = cookie->iobase_bm; tag = cookie->tag; type = cookie->type; /* XXX how to handle four calls for one controller? */ if (iobase_wd != 0x1f0 || unit != 0) return; for (i=0; i<5; i++) { word40[i] = pci_conf_read(tag, i * 4 + 0x40); } printf("via_571_status: Primary IDE prefetch/postwrite %s/%s\n", word40[0] & 0x8000 ? "enabled" : "disabled", word40[0] & 0x4000 ? "enabled" : "disabled"); printf("via_571_status: Secondary IDE prefetch/postwrite %s/%s\n", word40[0] & 0x2000 ? "enabled" : "disabled", word40[0] & 0x1000 ? "enabled" : "disabled"); printf("via_571_status: Master %d read/%d write IRDY# wait states\n", (word40[1] & 0x40) >> 6, (word40[1] & 0x20) >> 5); printf("via_571_status: busmaster status read retry %s\n", (word40[1] & 0x10) ? "enabled" : "disabled"); for (i=0; i<4; i++) printf("via_571_status: %s drive %d setup=%d active=%d recovery=%d\n", i < 2 ? "primary" : "secondary", i & 1, ((word40[3] >> ((3 - i) * 2)) & 3) + 1, ((word40[2] >> (((3 - i) * 8) + 4)) & 0x0f) + 1, ((word40[2] >> ((3 - i) * 8)) & 0x0f) + 1); /* XXX could go on and do UDMA status for '586B */ } static struct vendor_fns vs_via_571 = { generic_dmainit, via_571_status }; /* Intel PIIX, PIIX3, and PIIX4 IDE controller subfunctions */ static void intel_piix_dump_drive(char *ctlr, int sitre, int is_piix4, int word40, int word44, int word48, int word4a, int drive) { char *ms; if (!sitre) ms = "master/slave"; else if (drive == 0) ms = "master"; else ms = "slave"; if (sitre || drive == 0) printf("intel_piix_status: %s %s sample = %d, %s recovery = %d\n", ctlr, ms, 5 - ((sitre && drive) ? ((word44 >> 2) & 3) : ((word40 >> 12) & 3)), ms, 4 - ((sitre && drive) ? ((word44 >> 0) & 3) : ((word40 >> 8) & 3))); word40 >>= (drive * 4); printf("\ intel_piix_status: %s %s fastDMAonly %s, pre/post %s,\n\ intel_piix_status: IORDY sampling %s,\n\ intel_piix_status: fast PIO %s%s\n", ctlr, (drive == 0) ? "master" : "slave", (word40 & 8) ? "enabled" : "disabled", (word40 & 4) ? "enabled" : "disabled", (word40 & 2) ? "enabled" : "disabled", (word40 & 1) ? "enabled" : "disabled", ((word40 & 9) == 9) ? " (overridden by fastDMAonly)" : "" ); if (is_piix4) printf("intel_piix_status: UltraDMA %s, CT/RP = %d/%d\n", word48 ? "enabled": "disabled", 4 - (word4a & 3), 6 - (word4a & 3)); } static void intel_piix_status(struct ide_pci_cookie *cookie) { int iobase_wd; int unit; int iobase_bm; pcici_t tag; pcidi_t type; int ctlr; unsigned int word40, word44, word48; int sitre, is_piix4; iobase_wd = cookie->iobase_wd; unit = cookie->unit; iobase_bm = cookie->iobase_bm; tag = cookie->tag; type = cookie->type; ctlr = cookie->ctlr; word40 = pci_conf_read(tag, 0x40); word44 = pci_conf_read(tag, 0x44); word48 = pci_conf_read(tag, 0x48); /* * XXX will not be right for the *next* generation of upward-compatible * intel IDE controllers... */ is_piix4 = pci_conf_read(tag, PCI_CLASS_REG) == 0x71118086; sitre = word40 & 0x4000; switch (ctlr * 2 + unit) { case 0: intel_piix_dump_drive("primary", sitre, is_piix4, word40 & 0xffff, word44 & 0x0f, word48, word48 >> 16, 0); case 1: intel_piix_dump_drive("primary", sitre, is_piix4, word40 & 0xffff, word44 & 0x0f, word48 >> 1, word48 >> 20, 1); case 2: intel_piix_dump_drive("secondary", sitre, is_piix4, (word40 >> 16) & 0xffff, (word44 >> 4) & 0x0f, word48 >> 2, word48 >> 24, 0); case 3: intel_piix_dump_drive("secondary", sitre, is_piix4, (word40 >> 16) & 0xffff, (word44 >> 4) & 0x0f, word48 >> 3, word48 >> 28, 1); } } static int intel_piix_dmainit(struct ide_pci_cookie *cookie, struct wdparams *wp, int(*wdcmd)(int, void *), void *wdinfo) { int r, pci_id; pci_id = pci_conf_read(cookie->tag, PCI_CLASS_REG); /* * If the drive is already in mDMA2 or UDMA2, we leave it and the * controller alone, on the theory that the BIOS already DTRT. * * XXX this does not handle the conceivable case where the drive * has been left in a the right mode from a previous boot, the * BIOS has not reset it, and the BIOS has also not set the modes * on the controller. The one case seen so far where the BIOS * doesn't dink the drives (Tyan S1563D with Award v4.01) it * *does* seem to correctly program the controller. * * Aren't PC's fun? */ /* XXX way too sick and twisted conditional */ if ((((wp->wdp_atavalid & 2) == 2) && ((wp->wdp_dmamword & 0x404) == 0x404) && ((wp->wdp_eidepiomodes & 2) == 2)) || (((wp->wdp_atavalid & 4) == 4) && (wp->wdp_udmamode & 0x404 == 0x404))) return 1; /* If it's a UDMA drive and a PIIX4, set it up */ if (((wp->wdp_atavalid & 4) == 4) && ((wp->wdp_udmamode & 4) == 4) && pci_id == 0x71118086) { /* Set UDMA mode 2 on controller */ int unitno, mask, new; if (bootverbose) printf("intel_piix_dmainit: setting ultra DMA mode 2\n"); r = wdcmd(WDDMA_UDMA2, wdinfo); if (!r) { printf("intel_piix_dmainit: setting DMA mode failed\n"); return 0; } unitno = cookie->ctlr * 2 + cookie->unit; mask = 1 << unitno + 3 << (16 + unitno * 4); new = 1 << unitno + 2 << (16 + unitno * 4); pci_conf_write(cookie->tag, 0x48, (pci_conf_read(cookie->tag, 0x48) & ~mask) | new); } /* * if the SITRE bit is not set, indicating independent programming * of drive timing, we punt; we're not gonna fuss with trying to * coordinate timing modes between drives. if this is you, get a * BIOS that does this for us, or get a new motherboard if it's an * 82371FB (Triton FX). Or contribute patches :) */ else if ((pci_conf_read(cookie->tag, 0x40) >> (16 * cookie->ctlr)) & 0x4000 == 0) return 0; /* otherwise, program it for MW DMA mode 2 */ else if (((wp->wdp_atavalid & 2) == 2) && ((wp->wdp_dmamword & 4) == 4)) { /* Set multiword DMA mode 2 on controller */ unsigned int mask40, mask44, new40, new44; if (bootverbose) printf("intel_piix_dmainit: setting multiword DMA mode 2\n"); r = wdcmd(WDDMA_MDMA2, wdinfo); if (!r) { printf("intel_piix_dmainit: setting DMA mode failed\n"); return 0; } /* * backward compatible hardware leaves us with such twisted masses * of software (aka twiddle the extremely weird register layout on * a PIIX3) */ if (cookie->unit == 0) { mask40 = 0x330f; new40 = 0x2307; mask44 = 0; new44 = 0; } else { mask40 = 0x00f0; new40 = 0x0070; mask44 = 0x000f; new44 = 0x000b; } if (cookie->ctlr) { mask40 <<= 16; new40 <<= 16; mask44 <<= 4; new44 <<= 4; } pci_conf_write(cookie->tag, 0x40, (pci_conf_read(cookie->tag, 0x40) & ~mask40) | new40); pci_conf_write(cookie->tag, 0x44, (pci_conf_read(cookie->tag, 0x44) & ~mask44) | new44); } if (bootverbose) intel_piix_status(cookie); return 1; } static struct vendor_fns vs_intel_piix = { intel_piix_dmainit, intel_piix_status }; /* Generic SFF-8038i code-- all code below here, except for PCI probes, * more or less conforms to the SFF-8038i spec as extended for PCI. * There should be no code that goes beyond that feature set below. */ /* XXX mkcookie is overloaded with too many parameters */ static struct ide_pci_cookie * mkcookie(int iobase_wd, int ctlr, int unit, int iobase_bm, pcici_t tag, pcidi_t type, struct vendor_fns *vp) { struct ide_pci_cookie *cp; cp = malloc(sizeof *cp, M_DEVBUF, M_NOWAIT); if (!cp) return cp; cp->iobase_wd = iobase_wd; cp->ctlr = ctlr; cp->unit = unit; cp->tag = tag; cp->type = type; cp->iobase_bm = iobase_bm; bcopy(vp, &cp->vs, sizeof(struct vendor_fns)); if (!prdbuf) { prdbuf = malloc(PRD_ALLOC_SIZE, M_DEVBUF, M_NOWAIT); if (!prdbuf) { FREE(cp, M_DEVBUF); return 0; } if (((int)prdbuf >> PAGE_SHIFT) ^ (((int)prdbuf + PRD_ALLOC_SIZE - 1) >> PAGE_SHIFT)) { printf("ide_pci: prdbuf straddles page boundary, no DMA\n"); FREE(cp, M_DEVBUF); FREE(prdbuf, M_DEVBUF); return 0; } prdbuf_next = prdbuf; } cp->prd = prdbuf_next; (char *)prdbuf_next += PRD_BUF_SIZE; if ((char *)prdbuf_next > ((char *)prdbuf + PRD_ALLOC_SIZE)) { printf("ide_pci: mkcookie %04x:%d: no more space for PRDs, no DMA\n", iobase_wd, unit); return 0; } #if 0 if (bootverbose) printf("ide_pci: mkcookie %04x:%d: PRD vstart = %08x vend = %08x\n", iobase_wd, unit, (int)cp->prd, ((int)cp->prd)+PRD_BUF_SIZE); #endif LIST_INSERT_HEAD(&softc.cookies, cp, le); return cp; } static char * ide_pci_probe(pcici_t tag, pcidi_t type) { int data = pci_conf_read(tag, PCI_CLASS_REG); if ((data & PCI_CLASS_MASK) == PCI_CLASS_MASS_STORAGE && (data & PCI_SUBCLASS_MASK) == 0x00010000) { if (type == 0x71118086) return ("Intel PIIX4 Bus-master IDE controller"); if (type == 0x70108086) return ("Intel PIIX3 Bus-master IDE controller"); if (type == 0x12308086) return ("Intel PIIX Bus-master IDE controller"); if (type == 0x05711106) return ("VIA 82C586x (Apollo) Bus-master IDE controller"); if (data & 0x8000) return ("PCI IDE controller (busmaster capable)"); #ifndef CMD640 /* * XXX the CMD640B hack should be better integrated, or * something. */ else return ("PCI IDE controller (not busmaster capable)"); #endif }; return ((char*)0); } static void ide_pci_attach(pcici_t tag, int unit) { u_long idetm; int class; int bmista_1, bmista_2; int iobase_wd_1, iobase_wd_2, iobase_bm_1, iobase_bm_2; int cmd; struct vendor_fns *vp; pcidi_t type; struct ide_pci_cookie *cookie; if (unit) return; /* is it busmaster capable? bail if not */ class = pci_conf_read(tag, PCI_CLASS_REG); if (!(class & 0x8000)) return; /* is it enabled and is busmastering turned on? */ cmd = pci_conf_read(tag, PCI_COMMAND_STATUS_REG); if ((cmd & 5) != 5) return; /* set up vendor-specific stuff */ type = pci_conf_read(tag, PCI_ID_REG); switch (type) { case 0x71118086: case 0x70108086: case 0x12308086: /* Intel PIIX, PIIX3, PIIX4 */ vp = &vs_intel_piix; break; case 0x5711106: /* VIA Apollo chipset family */ vp = &vs_via_571; break; default: /* everybody else */ vp = &vs_generic; break; } iobase_wd_1 = (class & 0x100) ? (pci_conf_read(tag, 0x10) & 0xfffc) : 0x1f0; iobase_bm_1 = pci_conf_read(tag, 0x20) & 0xfffc; iobase_wd_2 = (class & 0x400) ? (pci_conf_read(tag, 0x10) & 0xfffc) : 0x170; iobase_bm_2 = iobase_bm_1 + SFF8038_CTLR_1; if (iobase_bm_1 == 0) { printf("ide_pci: BIOS has not configured busmaster I/O address,\n" "ide_pci: giving up\n"); return; } wddma.wdd_candma = ide_pci_candma; wddma.wdd_dmainit = ide_pci_dmainit; wddma.wdd_dmaverify = ide_pci_dmaverify; wddma.wdd_dmaprep = ide_pci_dmasetup; wddma.wdd_dmastart = ide_pci_dmastart; wddma.wdd_dmadone = ide_pci_dmadone; wddma.wdd_dmastatus = ide_pci_status; bmista_1 = inb(iobase_bm_1 + BMISTA_PORT); bmista_2 = inb(iobase_bm_2 + BMISTA_PORT); if (!ide_pci_softc_cookies_initted) { LIST_INIT(&softc.cookies); ide_pci_softc_cookies_initted = 1; } if (iobase_wd_1 != 0) { cookie = mkcookie(iobase_wd_1, 0, 0, iobase_bm_1, tag, type, vp); if (bootverbose) vp->vendor_status(cookie); cookie = mkcookie(iobase_wd_1, 0, 1, iobase_bm_1, tag, type, vp); if (bootverbose) { vp->vendor_status(cookie); printf("ide_pci: busmaster 0 status: %02x from port: %08x\n", bmista_1, iobase_bm_1+BMISTA_PORT); if (bmista_1 & BMISTA_DMA0CAP) printf("ide_pci: ide0:0 has been configured for DMA by BIOS\n"); if (bmista_1 & BMISTA_DMA1CAP) printf("ide_pci: ide0:1 has been configured for DMA by BIOS\n"); } } if (bmista_1 & BMISTA_SIMPLEX || bmista_2 & BMISTA_SIMPLEX) { printf("ide_pci: controller is simplex, no DMA on secondary channel\n"); } else if (iobase_wd_2 != 0) { cookie = mkcookie(iobase_wd_2, 1, 0, iobase_bm_2, tag, type, vp); if (bootverbose) vp->vendor_status(cookie); cookie = mkcookie(iobase_wd_2, 1, 1, iobase_bm_2, tag, type, vp); if (bootverbose) { vp->vendor_status(cookie); printf("ide_pci: busmaster 1 status: %02x from port: %08x\n", bmista_2, iobase_bm_2+BMISTA_PORT); if (bmista_2 & BMISTA_DMA0CAP) printf("ide_pci: ide1:0 has been configured for DMA by BIOS\n"); if (bmista_2 & BMISTA_DMA1CAP) printf("ide_pci: ide1:1 has been configured for DMA by BIOS\n"); } } } static u_long ide_pci_count; static struct pci_device ide_pci_device = { "ide_pci", ide_pci_probe, ide_pci_attach, &ide_pci_count, 0 }; DATA_SET(pcidevice_set, ide_pci_device); /* * Return a cookie if we can do DMA on the specified (iobase_wd, unit). */ static void * ide_pci_candma(int iobase_wd, int unit) { struct ide_pci_cookie *cp; cp = softc.cookies.lh_first; while(cp) { if (cp->unit == unit && cp->iobase_wd == iobase_wd) break; cp = cp->le.le_next; } return cp; } /* * Initialize controller and drive for DMA operation, including timing modes. * Uses data passed from the wd driver and a callback function to initialize * timing modes on the drive. */ static int ide_pci_dmainit(void *cookie, struct wdparams *wp, int(*wdcmd)(int, void *), void *wdinfo) { struct ide_pci_cookie *cp = cookie; /* * If the controller status indicates that DMA is configured already, * we flounce happily away */ if (inb(cp->iobase_bm + BMISTA_PORT) & ((cp->unit == 0) ? BMISTA_DMA0CAP : BMISTA_DMA1CAP)) return 1; /* We take a stab at it with device-dependent code */ return(cp->vs.vendor_dmainit(cp, wp, wdcmd, wdinfo)); } /* * Verify that controller can handle a dma request for cp. Should * not affect any hardware or driver state. */ static int ide_pci_dmaverify(void *xcp, char *vaddr, u_long count, int dir) { int badfu; /* * check for nonaligned or odd-length Stuff */ badfu = ((unsigned int)vaddr & 1) || (count & 1); #ifdef DIAGNOSTIC if (badfu) { printf("ide_pci: dmaverify odd vaddr or length, "); printf("vaddr = %08x length = %08x\n", (int)vaddr, count); } #endif return (!badfu); } /* * Set up DMA for cp. It is the responsibility of the caller * to ensure that the controller is idle before this routine * is called. */ static int ide_pci_dmasetup(void *xcp, char *vaddr, u_long vcount, int dir) { struct ide_pci_cookie *cp = xcp; struct ide_pci_prd *prd; int i; u_long firstpage; u_long prd_base, prd_count; u_long nbase, ncount, nend; int iobase_bm; static int trashmore = 0xdeadbeef; static int *trashmore_p = 0; u_long count, checkcount; prd = cp->prd; count = vcount; i = 0; iobase_bm = cp->iobase_bm; if (count == 0) { printf("ide_pci: dmasetup 0-length transfer, "); printf("vaddr = %08x length = %08x\n", (int)vaddr, count); return 1; } /* Generate first PRD entry, which may be non-aligned. */ firstpage = PAGE_SIZE - ((u_long)vaddr & PAGE_MASK); prd_base = vtophys(vaddr); prd_count = MIN(count, firstpage); vaddr += prd_count; count -= prd_count; /* Step through virtual pages, coalescing as needed. */ while (count) { nbase = vtophys(vaddr); ncount = MIN(count, PAGE_SIZE); nend = nbase + ncount; /* Coalesce if physically contiguous and not crossing 64k boundary. */ if ((prd_base + prd_count == nbase) && ((((nend - 1) ^ prd_base) & ~0xffff) == 0)) { prd_count += ncount; } else { prd[i].prd_base = prd_base; prd[i].prd_count = (prd_count & 0xffff); i++; if (i >= PRD_MAX_SEGS) { printf("wd82371: too many segments in PRD table\n"); return 1; } prd_base = nbase; prd_count = ncount; } vaddr += ncount; count -= ncount; } /* Write last PRD entry. */ prd[i].prd_base = prd_base; prd[i].prd_count = (prd_count & 0xffff) | PRD_EOT_BIT; #ifdef DIAGNOSTIC /* sanity check the transfer for length and page-alignment, at least */ checkcount = 0; for (i = 0;; i++) { unsigned int modcount; modcount = prd[i].prd_count & 0xffffe; if (modcount == 0) modcount = 0x10000; checkcount += modcount; if (i != 0 && ((prd[i].prd_base & PAGE_MASK) != 0)) { printf("ide_pci: dmasetup() diagnostic fails-- unaligned page\n"); return 1; } if (prd[i].prd_count & PRD_EOT_BIT) break; } if (checkcount != vcount) { printf("ide_pci: dmasetup() diagnostic fails-- bad length\n"); return 1; } #endif /* Set up PRD base register */ outl(iobase_bm + BMIDTP_PORT, vtophys(prd)); /* Set direction of transfer */ outb(iobase_bm + BMICOM_PORT, (dir == B_READ) ? BMICOM_READ_WRITE : 0); /* Clear interrupt and error bits */ outb(iobase_bm + BMISTA_PORT, (inb(iobase_bm + BMISTA_PORT) | (BMISTA_INTERRUPT | BMISTA_DMA_ERROR))); return 0; } static void ide_pci_dmastart(void *xcp) { struct ide_pci_cookie *cp = xcp; int iobase_bm; iobase_bm = cp->iobase_bm; outb(iobase_bm + BMICOM_PORT, inb(iobase_bm + BMICOM_PORT) | BMICOM_STOP_START); } static int ide_pci_dmadone(void *xcp) { struct ide_pci_cookie *cp = xcp; int iobase_bm, status; status = ide_pci_status(xcp); iobase_bm = cp->iobase_bm; outb(iobase_bm + BMICOM_PORT, inb(iobase_bm + BMICOM_PORT) & ~BMICOM_STOP_START); return status; } static int ide_pci_status(void *xcp) { struct ide_pci_cookie *cp = xcp; int iobase_bm, status, bmista; status = 0; iobase_bm = cp->iobase_bm; bmista = inb(iobase_bm + BMISTA_PORT); if (bmista & BMISTA_INTERRUPT) status |= WDDS_INTERRUPT; if (bmista & BMISTA_DMA_ERROR) status |= WDDS_ERROR; if (bmista & BMISTA_DMA_ACTIVE) status |= WDDS_ACTIVE; return status; } #endif /* NPCI > 0 */