Home | History | Annotate | Line # | Download | only in dev
kauai.c revision 1.23
      1  1.23      cube /*	$NetBSD: kauai.c,v 1.23 2008/03/18 20:46:36 cube Exp $	*/
      2   1.1  hamajima 
      3   1.1  hamajima /*-
      4   1.1  hamajima  * Copyright (c) 2003 Tsubai Masanari.  All rights reserved.
      5   1.1  hamajima  *
      6   1.1  hamajima  * Redistribution and use in source and binary forms, with or without
      7   1.1  hamajima  * modification, are permitted provided that the following conditions
      8   1.1  hamajima  * are met:
      9   1.1  hamajima  * 1. Redistributions of source code must retain the above copyright
     10   1.1  hamajima  *    notice, this list of conditions and the following disclaimer.
     11   1.1  hamajima  * 2. Redistributions in binary form must reproduce the above copyright
     12   1.1  hamajima  *    notice, this list of conditions and the following disclaimer in the
     13   1.1  hamajima  *    documentation and/or other materials provided with the distribution.
     14   1.1  hamajima  * 3. The name of the author may not be used to endorse or promote products
     15   1.1  hamajima  *    derived from this software without specific prior written permission.
     16   1.1  hamajima  *
     17   1.1  hamajima  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     18   1.1  hamajima  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     19   1.1  hamajima  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     20   1.1  hamajima  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     21   1.1  hamajima  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     22   1.1  hamajima  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     23   1.1  hamajima  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     24   1.1  hamajima  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     25   1.1  hamajima  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
     26   1.1  hamajima  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     27   1.1  hamajima  */
     28   1.2     lukem 
     29   1.2     lukem #include <sys/cdefs.h>
     30  1.23      cube __KERNEL_RCSID(0, "$NetBSD: kauai.c,v 1.23 2008/03/18 20:46:36 cube Exp $");
     31   1.1  hamajima 
     32   1.1  hamajima #include <sys/param.h>
     33   1.1  hamajima #include <sys/systm.h>
     34   1.1  hamajima #include <sys/device.h>
     35   1.1  hamajima #include <sys/malloc.h>
     36   1.1  hamajima 
     37   1.1  hamajima #include <uvm/uvm_extern.h>
     38   1.1  hamajima 
     39   1.1  hamajima #include <machine/bus.h>
     40  1.21   garbled #include <machine/pio.h>
     41   1.1  hamajima 
     42   1.1  hamajima #include <dev/ata/atareg.h>
     43   1.1  hamajima #include <dev/ata/atavar.h>
     44   1.1  hamajima #include <dev/ic/wdcvar.h>
     45   1.1  hamajima 
     46   1.1  hamajima #include <dev/ofw/openfirm.h>
     47   1.1  hamajima 
     48   1.1  hamajima #include <dev/pci/pcivar.h>
     49   1.1  hamajima #include <dev/pci/pcireg.h>
     50   1.1  hamajima #include <dev/pci/pcidevs.h>
     51   1.1  hamajima 
     52   1.1  hamajima #include <macppc/dev/dbdma.h>
     53   1.1  hamajima 
     54   1.1  hamajima #define WDC_REG_NPORTS		8
     55   1.1  hamajima #define WDC_AUXREG_OFFSET	0x16
     56  1.21   garbled #define WDC_AUXREG_NPORTS	1
     57   1.1  hamajima 
     58   1.1  hamajima #define PIO_CONFIG_REG (0x200 >> 4)	/* PIO and DMA access timing */
     59   1.1  hamajima #define DMA_CONFIG_REG (0x210 >> 4)	/* UDMA access timing */
     60   1.1  hamajima 
     61   1.1  hamajima struct kauai_softc {
     62   1.1  hamajima 	struct wdc_softc sc_wdcdev;
     63  1.15   thorpej 	struct ata_channel *sc_chanptr;
     64  1.15   thorpej 	struct ata_channel sc_channel;
     65  1.15   thorpej 	struct wdc_regs sc_wdc_regs;
     66  1.15   thorpej 	struct ata_queue sc_queue;
     67   1.1  hamajima 	dbdma_regmap_t *sc_dmareg;
     68   1.1  hamajima 	dbdma_command_t	*sc_dmacmd;
     69   1.1  hamajima 	u_int sc_piotiming_r[2];
     70   1.1  hamajima 	u_int sc_piotiming_w[2];
     71   1.1  hamajima 	u_int sc_dmatiming_r[2];
     72   1.1  hamajima 	u_int sc_dmatiming_w[2];
     73   1.1  hamajima 	void (*sc_calc_timing)(struct kauai_softc *, int);
     74   1.1  hamajima };
     75   1.1  hamajima 
     76  1.22      matt static int kauai_match(device_t, cfdata_t, void *);
     77  1.22      matt static void kauai_attach(device_t, device_t, void *);
     78  1.22      matt static int kauai_dma_init(void *, int, int, void *, size_t, int);
     79  1.22      matt static void kauai_dma_start(void *, int, int);
     80  1.22      matt static int kauai_dma_finish(void *, int, int, int);
     81  1.22      matt static void kauai_set_modes(struct ata_channel *);
     82  1.22      matt static void calc_timing_kauai(struct kauai_softc *, int);
     83   1.1  hamajima static int getnodebypci(pci_chipset_tag_t, pcitag_t);
     84   1.1  hamajima 
     85  1.23      cube CFATTACH_DECL_NEW(kauai, sizeof(struct kauai_softc),
     86   1.1  hamajima     kauai_match, kauai_attach, NULL, wdcactivate);
     87   1.1  hamajima 
     88   1.1  hamajima int
     89  1.22      matt kauai_match(device_t parent, cfdata_t match, void *aux)
     90   1.1  hamajima {
     91   1.1  hamajima 	struct pci_attach_args *pa = aux;
     92   1.1  hamajima 
     93  1.20   aymeric 	if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_APPLE) {
     94  1.20   aymeric 		switch (PCI_PRODUCT(pa->pa_id)) {
     95  1.20   aymeric 		case PCI_PRODUCT_APPLE_KAUAI:
     96  1.20   aymeric 		case PCI_PRODUCT_APPLE_UNINORTH_ATA:
     97  1.20   aymeric 		case PCI_PRODUCT_APPLE_INTREPID2_ATA:
     98  1.20   aymeric 		    return 5;
     99  1.20   aymeric 		}
    100  1.20   aymeric 	}
    101   1.1  hamajima 
    102   1.1  hamajima 	return 0;
    103   1.1  hamajima }
    104   1.1  hamajima 
    105   1.1  hamajima void
    106  1.22      matt kauai_attach(device_t parent, device_t self, void *aux)
    107   1.1  hamajima {
    108  1.22      matt 	struct kauai_softc *sc = device_private(self);
    109   1.1  hamajima 	struct pci_attach_args *pa = aux;
    110  1.15   thorpej 	struct ata_channel *chp = &sc->sc_channel;
    111  1.15   thorpej 	struct wdc_regs *wdr;
    112   1.1  hamajima 	pci_intr_handle_t ih;
    113   1.1  hamajima 	paddr_t regbase, dmabase;
    114   1.7    bouyer 	int node, reg[5], i;
    115   1.1  hamajima 
    116  1.23      cube 	sc->sc_wdcdev.sc_atac.atac_dev = self;
    117  1.23      cube 
    118   1.1  hamajima #ifdef DIAGNOSTIC
    119   1.1  hamajima 	if ((vaddr_t)sc->sc_dmacmd & 0x0f) {
    120  1.22      matt 		aprint_error(": bad dbdma alignment\n");
    121   1.1  hamajima 		return;
    122   1.1  hamajima 	}
    123   1.1  hamajima #endif
    124   1.1  hamajima 
    125   1.1  hamajima 	node = getnodebypci(pa->pa_pc, pa->pa_tag);
    126   1.1  hamajima 	if (node == 0) {
    127  1.22      matt 		aprint_error(": cannot find kauai node\n");
    128   1.1  hamajima 		return;
    129   1.1  hamajima 	}
    130   1.1  hamajima 
    131   1.1  hamajima 	if (OF_getprop(node, "assigned-addresses", reg, sizeof reg) < 12) {
    132  1.22      matt 		aprint_error(": cannot get address property\n");
    133   1.1  hamajima 		return;
    134   1.1  hamajima 	}
    135   1.1  hamajima 	regbase = reg[2] + 0x2000;
    136   1.1  hamajima 	dmabase = reg[2] + 0x1000;
    137   1.1  hamajima 
    138   1.1  hamajima 	/*
    139   1.1  hamajima 	 * XXX PCI_INTERRUPT_REG seems to be wired to 0.
    140   1.1  hamajima 	 * XXX So use fixed intrpin and intrline values.
    141   1.1  hamajima 	 */
    142   1.1  hamajima 	if (pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_INTERRUPT_REG) == 0) {
    143   1.1  hamajima 		pa->pa_intrpin = 1;
    144   1.1  hamajima 		pa->pa_intrline = 39;
    145   1.1  hamajima 	}
    146   1.1  hamajima 
    147   1.1  hamajima 	if (pci_intr_map(pa, &ih)) {
    148  1.22      matt 		aprint_error(": unable to map interrupt\n");
    149   1.1  hamajima 		return;
    150   1.1  hamajima 	}
    151  1.22      matt 	aprint_normal(": interrupting at %s\n", pci_intr_string(pa->pa_pc, ih));
    152   1.1  hamajima 
    153  1.15   thorpej 	sc->sc_wdcdev.regs = wdr = &sc->sc_wdc_regs;
    154   1.1  hamajima 
    155  1.21   garbled 	wdr->cmd_iot = wdr->ctl_iot = pa->pa_memt;
    156  1.15   thorpej 
    157  1.21   garbled 	if (bus_space_map(wdr->cmd_iot, regbase, WDC_REG_NPORTS << 4, 0,
    158  1.15   thorpej 	    &wdr->cmd_baseioh) ||
    159  1.15   thorpej 	    bus_space_subregion(wdr->cmd_iot, wdr->cmd_baseioh,
    160  1.21   garbled 			WDC_AUXREG_OFFSET << 4, 1, &wdr->ctl_ioh)) {
    161  1.22      matt 		aprint_error_dev(self, "couldn't map registers\n");
    162   1.1  hamajima 		return;
    163   1.1  hamajima 	}
    164   1.7    bouyer 	for (i = 0; i < WDC_NREG; i++) {
    165  1.21   garbled 		if (bus_space_subregion(wdr->cmd_iot, wdr->cmd_baseioh, i << 4,
    166  1.15   thorpej 		    i == 0 ? 4 : 1, &wdr->cmd_iohs[i]) != 0) {
    167  1.15   thorpej 			bus_space_unmap(wdr->cmd_iot, wdr->cmd_baseioh,
    168  1.21   garbled 			    WDC_REG_NPORTS << 4);
    169  1.22      matt 			aprint_error_dev(self,
    170  1.22      matt 			    "couldn't subregion registers\n");
    171   1.7    bouyer 			return;
    172   1.7    bouyer 		}
    173   1.7    bouyer 	}
    174   1.1  hamajima 
    175   1.1  hamajima 	if (pci_intr_establish(pa->pa_pc, ih, IPL_BIO, wdcintr, chp) == NULL) {
    176  1.22      matt 		aprint_error_dev(self, "unable to establish interrupt\n");
    177   1.1  hamajima 		return;
    178   1.1  hamajima 	}
    179   1.1  hamajima 
    180   1.1  hamajima 
    181  1.16   thorpej 	sc->sc_wdcdev.sc_atac.atac_pio_cap = 4;
    182  1.16   thorpej 	sc->sc_wdcdev.sc_atac.atac_dma_cap = 2;
    183  1.16   thorpej 	sc->sc_wdcdev.sc_atac.atac_udma_cap = 5;
    184  1.16   thorpej 	sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_DATA16;
    185  1.16   thorpej 	sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_DMA | ATAC_CAP_UDMA;
    186  1.15   thorpej 	sc->sc_chanptr = chp;
    187  1.16   thorpej 	sc->sc_wdcdev.sc_atac.atac_channels = &sc->sc_chanptr;
    188  1.16   thorpej 	sc->sc_wdcdev.sc_atac.atac_nchannels = 1;
    189   1.1  hamajima 	sc->sc_wdcdev.dma_arg = sc;
    190   1.1  hamajima 	sc->sc_wdcdev.dma_init = kauai_dma_init;
    191   1.1  hamajima 	sc->sc_wdcdev.dma_start = kauai_dma_start;
    192   1.1  hamajima 	sc->sc_wdcdev.dma_finish = kauai_dma_finish;
    193  1.16   thorpej 	sc->sc_wdcdev.sc_atac.atac_set_modes = kauai_set_modes;
    194   1.1  hamajima 	sc->sc_calc_timing = calc_timing_kauai;
    195   1.1  hamajima 	sc->sc_dmareg = (void *)dmabase;
    196   1.1  hamajima 
    197  1.11   thorpej 	chp->ch_channel = 0;
    198  1.16   thorpej 	chp->ch_atac = &sc->sc_wdcdev.sc_atac;
    199  1.15   thorpej 	chp->ch_queue = &sc->sc_queue;
    200  1.19    bouyer 	chp->ch_ndrive = 2;
    201  1.17      manu 	wdc_init_shadow_regs(chp);
    202   1.1  hamajima 
    203   1.6    bouyer 	wdcattach(chp);
    204   1.1  hamajima }
    205   1.1  hamajima 
    206   1.1  hamajima void
    207  1.22      matt kauai_set_modes(struct ata_channel *chp)
    208   1.1  hamajima {
    209  1.16   thorpej 	struct kauai_softc *sc = (void *)chp->ch_atac;
    210  1.16   thorpej 	struct wdc_regs *wdr = CHAN_TO_WDC_REGS(chp);
    211   1.1  hamajima 	struct ata_drive_datas *drvp0 = &chp->ch_drive[0];
    212   1.1  hamajima 	struct ata_drive_datas *drvp1 = &chp->ch_drive[1];
    213   1.1  hamajima 	struct ata_drive_datas *drvp;
    214   1.1  hamajima 	int drive;
    215   1.1  hamajima 
    216   1.1  hamajima 	if ((drvp0->drive_flags & DRIVE) && (drvp1->drive_flags & DRIVE)) {
    217   1.1  hamajima 		drvp0->PIO_mode = drvp1->PIO_mode =
    218   1.1  hamajima 		    min(drvp0->PIO_mode, drvp1->PIO_mode);
    219   1.1  hamajima 	}
    220   1.1  hamajima 
    221   1.1  hamajima 	for (drive = 0; drive < 2; drive++) {
    222   1.1  hamajima 		drvp = &chp->ch_drive[drive];
    223   1.1  hamajima 		if (drvp->drive_flags & DRIVE) {
    224   1.1  hamajima 			(*sc->sc_calc_timing)(sc, drive);
    225  1.15   thorpej 			bus_space_write_4(wdr->cmd_iot, wdr->cmd_baseioh,
    226   1.1  hamajima 			    PIO_CONFIG_REG, sc->sc_piotiming_r[drive]);
    227  1.15   thorpej 			bus_space_write_4(wdr->cmd_iot, wdr->cmd_baseioh,
    228   1.1  hamajima 			    DMA_CONFIG_REG, sc->sc_dmatiming_r[drive]);
    229   1.1  hamajima 		}
    230   1.1  hamajima 	}
    231   1.1  hamajima }
    232   1.1  hamajima 
    233   1.1  hamajima /*
    234   1.1  hamajima  * IDE transfer timings
    235   1.1  hamajima  */
    236   1.1  hamajima static const u_int pio_timing_kauai[] = {	/* 0xff000fff */
    237   1.1  hamajima 	0x08000a92,	/* Mode 0 */
    238   1.1  hamajima 	0x0800060f,	/*      1 */
    239   1.1  hamajima 	0x0800038b,	/*      2 */
    240   1.1  hamajima 	0x05000249,	/*      3 */
    241   1.1  hamajima 	0x04000148	/*      4 */
    242   1.1  hamajima };
    243   1.1  hamajima static const u_int dma_timing_kauai[] = {	/* 0x00fff000 */
    244   1.1  hamajima 	0x00618000,	/* Mode 0 */
    245   1.1  hamajima 	0x00209000,	/*      1 */
    246   1.1  hamajima 	0x00148000	/*      2 */
    247   1.1  hamajima };
    248   1.1  hamajima static const u_int udma_timing_kauai[] = {	/* 0x0000ffff */
    249   1.1  hamajima 	0x000070c0,	/* Mode 0 */
    250   1.1  hamajima 	0x00005d80,	/*      1 */
    251   1.1  hamajima 	0x00004a60,	/*      2 */
    252   1.1  hamajima 	0x00003a50,	/*      3 */
    253   1.1  hamajima 	0x00002a30,	/*      4 */
    254   1.1  hamajima 	0x00002921	/*      5 */
    255   1.1  hamajima };
    256   1.1  hamajima 
    257   1.1  hamajima /*
    258   1.1  hamajima  * Timing calculation for Kauai.
    259   1.1  hamajima  */
    260   1.1  hamajima void
    261  1.22      matt calc_timing_kauai(struct kauai_softc *sc, int drive)
    262   1.1  hamajima {
    263  1.15   thorpej 	struct ata_channel *chp = &sc->sc_channel;
    264   1.1  hamajima 	struct ata_drive_datas *drvp = &chp->ch_drive[drive];
    265   1.1  hamajima 	int piomode = drvp->PIO_mode;
    266   1.1  hamajima 	int dmamode = drvp->DMA_mode;
    267   1.1  hamajima 	int udmamode = drvp->UDMA_mode;
    268   1.1  hamajima 	u_int pioconf, dmaconf;
    269   1.1  hamajima 
    270   1.1  hamajima 	pioconf = pio_timing_kauai[piomode];
    271   1.1  hamajima 
    272   1.1  hamajima 	dmaconf = 0;
    273   1.1  hamajima 	if (drvp->drive_flags & DRIVE_DMA)
    274   1.1  hamajima 		dmaconf |= dma_timing_kauai[dmamode];
    275   1.1  hamajima 	if (drvp->drive_flags & DRIVE_UDMA)
    276   1.1  hamajima 		dmaconf |= udma_timing_kauai[udmamode];
    277   1.1  hamajima 
    278   1.1  hamajima 	if (drvp->drive_flags & DRIVE_UDMA)
    279   1.1  hamajima 		dmaconf |= 1;
    280   1.1  hamajima 
    281   1.1  hamajima 	sc->sc_piotiming_r[drive] = sc->sc_piotiming_w[drive] = pioconf;
    282   1.1  hamajima 	sc->sc_dmatiming_r[drive] = sc->sc_dmatiming_w[drive] = dmaconf;
    283   1.1  hamajima }
    284   1.1  hamajima 
    285   1.1  hamajima int
    286  1.22      matt kauai_dma_init(void *v, int channel, int drive, void *databuf,
    287  1.22      matt 	size_t datalen, int flags)
    288   1.1  hamajima {
    289   1.1  hamajima 	struct kauai_softc *sc = v;
    290   1.1  hamajima 	dbdma_command_t *cmdp = sc->sc_dmacmd;
    291  1.15   thorpej 	struct ata_channel *chp = &sc->sc_channel;
    292  1.16   thorpej 	struct wdc_regs *wdr = CHAN_TO_WDC_REGS(chp);
    293   1.1  hamajima 	vaddr_t va = (vaddr_t)databuf;
    294   1.1  hamajima 	int read = flags & WDC_DMA_READ;
    295   1.1  hamajima 	int cmd = read ? DBDMA_CMD_IN_MORE : DBDMA_CMD_OUT_MORE;
    296   1.1  hamajima 	u_int offset;
    297   1.1  hamajima 
    298  1.15   thorpej 	bus_space_write_4(wdr->cmd_iot, wdr->cmd_baseioh, DMA_CONFIG_REG,
    299   1.1  hamajima 	    read ? sc->sc_dmatiming_r[drive] : sc->sc_dmatiming_w[drive]);
    300  1.15   thorpej 	bus_space_read_4(wdr->cmd_iot, wdr->cmd_baseioh, DMA_CONFIG_REG);
    301   1.1  hamajima 
    302   1.1  hamajima 	offset = va & PGOFSET;
    303   1.1  hamajima 
    304   1.1  hamajima 	/* if va is not page-aligned, setup the first page */
    305   1.1  hamajima 	if (offset != 0) {
    306   1.1  hamajima 		int rest = PAGE_SIZE - offset;	/* the rest of the page */
    307   1.1  hamajima 
    308   1.1  hamajima 		if (datalen > rest) {		/* if continues to next page */
    309   1.1  hamajima 			DBDMA_BUILD(cmdp, cmd, 0, rest, vtophys(va),
    310   1.1  hamajima 				DBDMA_INT_NEVER, DBDMA_WAIT_NEVER,
    311   1.1  hamajima 				DBDMA_BRANCH_NEVER);
    312   1.1  hamajima 			datalen -= rest;
    313   1.1  hamajima 			va += rest;
    314   1.1  hamajima 			cmdp++;
    315   1.1  hamajima 		}
    316   1.1  hamajima 	}
    317   1.1  hamajima 
    318   1.1  hamajima 	/* now va is page-aligned */
    319   1.1  hamajima 	while (datalen > PAGE_SIZE) {
    320   1.1  hamajima 		DBDMA_BUILD(cmdp, cmd, 0, PAGE_SIZE, vtophys(va),
    321   1.1  hamajima 			DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    322   1.1  hamajima 		datalen -= PAGE_SIZE;
    323   1.1  hamajima 		va += PAGE_SIZE;
    324   1.1  hamajima 		cmdp++;
    325   1.1  hamajima 	}
    326   1.1  hamajima 
    327   1.1  hamajima 	/* the last page (datalen <= PAGE_SIZE here) */
    328   1.1  hamajima 	cmd = read ? DBDMA_CMD_IN_LAST : DBDMA_CMD_OUT_LAST;
    329   1.1  hamajima 	DBDMA_BUILD(cmdp, cmd, 0, datalen, vtophys(va),
    330   1.1  hamajima 		DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    331   1.1  hamajima 	cmdp++;
    332   1.1  hamajima 
    333   1.1  hamajima 	DBDMA_BUILD(cmdp, DBDMA_CMD_STOP, 0, 0, 0,
    334   1.1  hamajima 		DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    335   1.1  hamajima 
    336   1.1  hamajima 	return 0;
    337   1.1  hamajima }
    338   1.1  hamajima 
    339   1.1  hamajima void
    340  1.22      matt kauai_dma_start(void *v, int channel, int drive)
    341   1.1  hamajima {
    342   1.1  hamajima 	struct kauai_softc *sc = v;
    343   1.1  hamajima 
    344   1.1  hamajima 	dbdma_start(sc->sc_dmareg, sc->sc_dmacmd);
    345   1.1  hamajima }
    346   1.1  hamajima 
    347   1.1  hamajima int
    348  1.22      matt kauai_dma_finish(void *v, int channel, int drive, int read)
    349   1.1  hamajima {
    350   1.1  hamajima 	struct kauai_softc *sc = v;
    351   1.1  hamajima 
    352   1.1  hamajima 	dbdma_stop(sc->sc_dmareg);
    353   1.1  hamajima 	return 0;
    354   1.1  hamajima }
    355   1.1  hamajima 
    356   1.1  hamajima /*
    357   1.1  hamajima  * Find OF-device corresponding to the PCI device.
    358   1.1  hamajima  */
    359   1.1  hamajima int
    360  1.22      matt getnodebypci(pci_chipset_tag_t pc, pcitag_t tag)
    361   1.1  hamajima {
    362   1.1  hamajima 	int bus, dev, func;
    363   1.1  hamajima 	u_int reg[5];
    364   1.1  hamajima 	int p, q;
    365   1.1  hamajima 	int l, b, d, f;
    366   1.1  hamajima 
    367   1.1  hamajima 	pci_decompose_tag(pc, tag, &bus, &dev, &func);
    368   1.1  hamajima 
    369   1.1  hamajima 	for (q = OF_peer(0); q; q = p) {
    370   1.1  hamajima 		l = OF_getprop(q, "assigned-addresses", reg, sizeof(reg));
    371   1.1  hamajima 		if (l > 4) {
    372   1.1  hamajima 			b = (reg[0] >> 16) & 0xff;
    373   1.1  hamajima 			d = (reg[0] >> 11) & 0x1f;
    374   1.1  hamajima 			f = (reg[0] >> 8) & 0x07;
    375   1.1  hamajima 
    376   1.1  hamajima 			if (b == bus && d == dev && f == func)
    377   1.1  hamajima 				return q;
    378   1.1  hamajima 		}
    379   1.1  hamajima 		if ((p = OF_child(q)))
    380   1.1  hamajima 			continue;
    381   1.1  hamajima 		while (q) {
    382   1.1  hamajima 			if ((p = OF_peer(q)))
    383   1.1  hamajima 				break;
    384   1.1  hamajima 			q = OF_parent(q);
    385   1.1  hamajima 		}
    386   1.1  hamajima 	}
    387   1.1  hamajima 	return 0;
    388   1.1  hamajima }
    389