Home | History | Annotate | Line # | Download | only in dev
kauai.c revision 1.1
      1  1.1  hamajima /*	$NetBSD: kauai.c,v 1.1 2003/06/11 07:35:39 hamajima 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.1  hamajima 
     29  1.1  hamajima #include <sys/param.h>
     30  1.1  hamajima #include <sys/systm.h>
     31  1.1  hamajima #include <sys/device.h>
     32  1.1  hamajima #include <sys/malloc.h>
     33  1.1  hamajima 
     34  1.1  hamajima #include <uvm/uvm_extern.h>
     35  1.1  hamajima 
     36  1.1  hamajima #include <machine/bus.h>
     37  1.1  hamajima 
     38  1.1  hamajima #include <dev/ata/atareg.h>
     39  1.1  hamajima #include <dev/ata/atavar.h>
     40  1.1  hamajima #include <dev/ic/wdcvar.h>
     41  1.1  hamajima 
     42  1.1  hamajima #include <dev/ofw/openfirm.h>
     43  1.1  hamajima 
     44  1.1  hamajima #include <dev/pci/pcivar.h>
     45  1.1  hamajima #include <dev/pci/pcireg.h>
     46  1.1  hamajima #include <dev/pci/pcidevs.h>
     47  1.1  hamajima 
     48  1.1  hamajima #include <macppc/dev/dbdma.h>
     49  1.1  hamajima 
     50  1.1  hamajima #define WDC_REG_NPORTS		8
     51  1.1  hamajima #define WDC_AUXREG_OFFSET	0x16
     52  1.1  hamajima 
     53  1.1  hamajima #define PIO_CONFIG_REG (0x200 >> 4)	/* PIO and DMA access timing */
     54  1.1  hamajima #define DMA_CONFIG_REG (0x210 >> 4)	/* UDMA access timing */
     55  1.1  hamajima 
     56  1.1  hamajima struct kauai_softc {
     57  1.1  hamajima 	struct wdc_softc sc_wdcdev;
     58  1.1  hamajima 	struct channel_softc *wdc_chanptr;
     59  1.1  hamajima 	struct channel_softc wdc_channel;
     60  1.1  hamajima 	struct channel_queue wdc_queue;
     61  1.1  hamajima 	dbdma_regmap_t *sc_dmareg;
     62  1.1  hamajima 	dbdma_command_t	*sc_dmacmd;
     63  1.1  hamajima 	u_int sc_piotiming_r[2];
     64  1.1  hamajima 	u_int sc_piotiming_w[2];
     65  1.1  hamajima 	u_int sc_dmatiming_r[2];
     66  1.1  hamajima 	u_int sc_dmatiming_w[2];
     67  1.1  hamajima 	void (*sc_calc_timing)(struct kauai_softc *, int);
     68  1.1  hamajima };
     69  1.1  hamajima 
     70  1.1  hamajima int kauai_match __P((struct device *, struct cfdata *, void *));
     71  1.1  hamajima void kauai_attach __P((struct device *, struct device *, void *));
     72  1.1  hamajima int kauai_dma_init __P((void *, int, int, void *, size_t, int));
     73  1.1  hamajima void kauai_dma_start __P((void *, int, int));
     74  1.1  hamajima int kauai_dma_finish __P((void *, int, int, int));
     75  1.1  hamajima void kauai_set_modes __P((struct channel_softc *));
     76  1.1  hamajima static void calc_timing_kauai __P((struct kauai_softc *, int));
     77  1.1  hamajima static int getnodebypci(pci_chipset_tag_t, pcitag_t);
     78  1.1  hamajima 
     79  1.1  hamajima CFATTACH_DECL(kauai, sizeof(struct kauai_softc),
     80  1.1  hamajima     kauai_match, kauai_attach, NULL, wdcactivate);
     81  1.1  hamajima 
     82  1.1  hamajima int
     83  1.1  hamajima kauai_match(parent, match, aux)
     84  1.1  hamajima 	struct device *parent;
     85  1.1  hamajima 	struct cfdata *match;
     86  1.1  hamajima 	void *aux;
     87  1.1  hamajima {
     88  1.1  hamajima 	struct pci_attach_args *pa = aux;
     89  1.1  hamajima 
     90  1.1  hamajima 	if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_APPLE &&
     91  1.1  hamajima 	    PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_APPLE_KAUAI)
     92  1.1  hamajima 		return 5;
     93  1.1  hamajima 
     94  1.1  hamajima 	return 0;
     95  1.1  hamajima }
     96  1.1  hamajima 
     97  1.1  hamajima void
     98  1.1  hamajima kauai_attach(parent, self, aux)
     99  1.1  hamajima 	struct device *parent, *self;
    100  1.1  hamajima 	void *aux;
    101  1.1  hamajima {
    102  1.1  hamajima 	struct kauai_softc *sc = (void *)self;
    103  1.1  hamajima 	struct pci_attach_args *pa = aux;
    104  1.1  hamajima 	struct channel_softc *chp = &sc->wdc_channel;
    105  1.1  hamajima 	pci_intr_handle_t ih;
    106  1.1  hamajima 	paddr_t regbase, dmabase;
    107  1.1  hamajima 	int node, reg[5];
    108  1.1  hamajima 
    109  1.1  hamajima #ifdef DIAGNOSTIC
    110  1.1  hamajima 	if ((vaddr_t)sc->sc_dmacmd & 0x0f) {
    111  1.1  hamajima 		printf(": bad dbdma alignment\n");
    112  1.1  hamajima 		return;
    113  1.1  hamajima 	}
    114  1.1  hamajima #endif
    115  1.1  hamajima 
    116  1.1  hamajima 	node = getnodebypci(pa->pa_pc, pa->pa_tag);
    117  1.1  hamajima 	if (node == 0) {
    118  1.1  hamajima 		printf(": cannot find gmac node\n");
    119  1.1  hamajima 		return;
    120  1.1  hamajima 	}
    121  1.1  hamajima 
    122  1.1  hamajima 	if (OF_getprop(node, "assigned-addresses", reg, sizeof reg) < 12) {
    123  1.1  hamajima 		printf(": cannot get address property\n");
    124  1.1  hamajima 		return;
    125  1.1  hamajima 	}
    126  1.1  hamajima 	regbase = reg[2] + 0x2000;
    127  1.1  hamajima 	dmabase = reg[2] + 0x1000;
    128  1.1  hamajima 
    129  1.1  hamajima 	/*
    130  1.1  hamajima 	 * XXX PCI_INTERRUPT_REG seems to be wired to 0.
    131  1.1  hamajima 	 * XXX So use fixed intrpin and intrline values.
    132  1.1  hamajima 	 */
    133  1.1  hamajima 	if (pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_INTERRUPT_REG) == 0) {
    134  1.1  hamajima 		pa->pa_intrpin = 1;
    135  1.1  hamajima 		pa->pa_intrline = 39;
    136  1.1  hamajima 	}
    137  1.1  hamajima 
    138  1.1  hamajima 	if (pci_intr_map(pa, &ih)) {
    139  1.1  hamajima 		printf(": unable to map interrupt\n");
    140  1.1  hamajima 		return;
    141  1.1  hamajima 	}
    142  1.1  hamajima 	printf(": interrupting at %s\n", pci_intr_string(pa->pa_pc, ih));
    143  1.1  hamajima 
    144  1.1  hamajima 	chp->cmd_iot = chp->ctl_iot = macppc_make_bus_space_tag(regbase, 4);
    145  1.1  hamajima 
    146  1.1  hamajima 	if (bus_space_map(chp->cmd_iot, 0, WDC_REG_NPORTS, 0, &chp->cmd_ioh) ||
    147  1.1  hamajima 	    bus_space_subregion(chp->cmd_iot, chp->cmd_ioh,
    148  1.1  hamajima 			WDC_AUXREG_OFFSET, 1, &chp->ctl_ioh)) {
    149  1.1  hamajima 		printf("%s: couldn't map registers\n", self->dv_xname);
    150  1.1  hamajima 		return;
    151  1.1  hamajima 	}
    152  1.1  hamajima 
    153  1.1  hamajima 	if (pci_intr_establish(pa->pa_pc, ih, IPL_BIO, wdcintr, chp) == NULL) {
    154  1.1  hamajima 		printf("%s: unable to establish interrupt\n", self->dv_xname);
    155  1.1  hamajima 		return;
    156  1.1  hamajima 	}
    157  1.1  hamajima 
    158  1.1  hamajima 
    159  1.1  hamajima 	sc->sc_wdcdev.PIO_cap = 4;
    160  1.1  hamajima 	sc->sc_wdcdev.DMA_cap = 2;
    161  1.1  hamajima 	sc->sc_wdcdev.UDMA_cap = 5;
    162  1.1  hamajima 	sc->sc_wdcdev.cap |= WDC_CAPABILITY_DATA16 | WDC_CAPABILITY_MODE;
    163  1.1  hamajima 	sc->sc_wdcdev.cap |= WDC_CAPABILITY_DMA | WDC_CAPABILITY_UDMA;
    164  1.1  hamajima 	sc->wdc_chanptr = chp;
    165  1.1  hamajima 	sc->sc_wdcdev.channels = &sc->wdc_chanptr;
    166  1.1  hamajima 	sc->sc_wdcdev.nchannels = 1;
    167  1.1  hamajima 	sc->sc_wdcdev.dma_arg = sc;
    168  1.1  hamajima 	sc->sc_wdcdev.dma_init = kauai_dma_init;
    169  1.1  hamajima 	sc->sc_wdcdev.dma_start = kauai_dma_start;
    170  1.1  hamajima 	sc->sc_wdcdev.dma_finish = kauai_dma_finish;
    171  1.1  hamajima 	sc->sc_wdcdev.set_modes = kauai_set_modes;
    172  1.1  hamajima 	sc->sc_calc_timing = calc_timing_kauai;
    173  1.1  hamajima 	sc->sc_dmareg = (void *)dmabase;
    174  1.1  hamajima 
    175  1.1  hamajima 	chp->channel = 0;
    176  1.1  hamajima 	chp->wdc = &sc->sc_wdcdev;
    177  1.1  hamajima 	chp->ch_queue = &sc->wdc_queue;
    178  1.1  hamajima 
    179  1.1  hamajima 	wdcattach(chp);
    180  1.1  hamajima 
    181  1.1  hamajima 	/* Modify access timings. */
    182  1.1  hamajima 	kauai_set_modes(chp);
    183  1.1  hamajima }
    184  1.1  hamajima 
    185  1.1  hamajima void
    186  1.1  hamajima kauai_set_modes(chp)
    187  1.1  hamajima 	struct channel_softc *chp;
    188  1.1  hamajima {
    189  1.1  hamajima 	struct kauai_softc *sc = (void *)chp->wdc;
    190  1.1  hamajima 	struct ata_drive_datas *drvp0 = &chp->ch_drive[0];
    191  1.1  hamajima 	struct ata_drive_datas *drvp1 = &chp->ch_drive[1];
    192  1.1  hamajima 	struct ata_drive_datas *drvp;
    193  1.1  hamajima 	int drive;
    194  1.1  hamajima 
    195  1.1  hamajima 	if ((drvp0->drive_flags & DRIVE) && (drvp1->drive_flags & DRIVE)) {
    196  1.1  hamajima 		drvp0->PIO_mode = drvp1->PIO_mode =
    197  1.1  hamajima 		    min(drvp0->PIO_mode, drvp1->PIO_mode);
    198  1.1  hamajima 	}
    199  1.1  hamajima 
    200  1.1  hamajima 	for (drive = 0; drive < 2; drive++) {
    201  1.1  hamajima 		drvp = &chp->ch_drive[drive];
    202  1.1  hamajima 		if (drvp->drive_flags & DRIVE) {
    203  1.1  hamajima 			(*sc->sc_calc_timing)(sc, drive);
    204  1.1  hamajima 			bus_space_write_4(chp->cmd_iot, chp->cmd_ioh,
    205  1.1  hamajima 			    PIO_CONFIG_REG, sc->sc_piotiming_r[drive]);
    206  1.1  hamajima 			bus_space_write_4(chp->cmd_iot, chp->cmd_ioh,
    207  1.1  hamajima 			    DMA_CONFIG_REG, sc->sc_dmatiming_r[drive]);
    208  1.1  hamajima 		}
    209  1.1  hamajima 	}
    210  1.1  hamajima 
    211  1.1  hamajima 	wdc_print_modes(chp);
    212  1.1  hamajima }
    213  1.1  hamajima 
    214  1.1  hamajima /*
    215  1.1  hamajima  * IDE transfer timings
    216  1.1  hamajima  */
    217  1.1  hamajima static const u_int pio_timing_kauai[] = {	/* 0xff000fff */
    218  1.1  hamajima 	0x08000a92,	/* Mode 0 */
    219  1.1  hamajima 	0x0800060f,	/*      1 */
    220  1.1  hamajima 	0x0800038b,	/*      2 */
    221  1.1  hamajima 	0x05000249,	/*      3 */
    222  1.1  hamajima 	0x04000148	/*      4 */
    223  1.1  hamajima };
    224  1.1  hamajima static const u_int dma_timing_kauai[] = {	/* 0x00fff000 */
    225  1.1  hamajima 	0x00618000,	/* Mode 0 */
    226  1.1  hamajima 	0x00209000,	/*      1 */
    227  1.1  hamajima 	0x00148000	/*      2 */
    228  1.1  hamajima };
    229  1.1  hamajima static const u_int udma_timing_kauai[] = {	/* 0x0000ffff */
    230  1.1  hamajima 	0x000070c0,	/* Mode 0 */
    231  1.1  hamajima 	0x00005d80,	/*      1 */
    232  1.1  hamajima 	0x00004a60,	/*      2 */
    233  1.1  hamajima 	0x00003a50,	/*      3 */
    234  1.1  hamajima 	0x00002a30,	/*      4 */
    235  1.1  hamajima 	0x00002921	/*      5 */
    236  1.1  hamajima };
    237  1.1  hamajima 
    238  1.1  hamajima /*
    239  1.1  hamajima  * Timing calculation for Kauai.
    240  1.1  hamajima  */
    241  1.1  hamajima void
    242  1.1  hamajima calc_timing_kauai(sc, drive)
    243  1.1  hamajima 	struct kauai_softc *sc;
    244  1.1  hamajima 	int drive;
    245  1.1  hamajima {
    246  1.1  hamajima 	struct channel_softc *chp = &sc->wdc_channel;
    247  1.1  hamajima 	struct ata_drive_datas *drvp = &chp->ch_drive[drive];
    248  1.1  hamajima 	int piomode = drvp->PIO_mode;
    249  1.1  hamajima 	int dmamode = drvp->DMA_mode;
    250  1.1  hamajima 	int udmamode = drvp->UDMA_mode;
    251  1.1  hamajima 	u_int pioconf, dmaconf;
    252  1.1  hamajima 
    253  1.1  hamajima 	pioconf = pio_timing_kauai[piomode];
    254  1.1  hamajima 
    255  1.1  hamajima 	dmaconf = 0;
    256  1.1  hamajima 	if (drvp->drive_flags & DRIVE_DMA)
    257  1.1  hamajima 		dmaconf |= dma_timing_kauai[dmamode];
    258  1.1  hamajima 	if (drvp->drive_flags & DRIVE_UDMA)
    259  1.1  hamajima 		dmaconf |= udma_timing_kauai[udmamode];
    260  1.1  hamajima 
    261  1.1  hamajima 	if (drvp->drive_flags & DRIVE_UDMA)
    262  1.1  hamajima 		dmaconf |= 1;
    263  1.1  hamajima 
    264  1.1  hamajima 	sc->sc_piotiming_r[drive] = sc->sc_piotiming_w[drive] = pioconf;
    265  1.1  hamajima 	sc->sc_dmatiming_r[drive] = sc->sc_dmatiming_w[drive] = dmaconf;
    266  1.1  hamajima }
    267  1.1  hamajima 
    268  1.1  hamajima int
    269  1.1  hamajima kauai_dma_init(v, channel, drive, databuf, datalen, flags)
    270  1.1  hamajima 	void *v;
    271  1.1  hamajima 	void *databuf;
    272  1.1  hamajima 	size_t datalen;
    273  1.1  hamajima 	int flags;
    274  1.1  hamajima {
    275  1.1  hamajima 	struct kauai_softc *sc = v;
    276  1.1  hamajima 	dbdma_command_t *cmdp = sc->sc_dmacmd;
    277  1.1  hamajima 	struct channel_softc *chp = &sc->wdc_channel;
    278  1.1  hamajima 	vaddr_t va = (vaddr_t)databuf;
    279  1.1  hamajima 	int read = flags & WDC_DMA_READ;
    280  1.1  hamajima 	int cmd = read ? DBDMA_CMD_IN_MORE : DBDMA_CMD_OUT_MORE;
    281  1.1  hamajima 	u_int offset;
    282  1.1  hamajima 
    283  1.1  hamajima 	bus_space_write_4(chp->cmd_iot, chp->cmd_ioh, DMA_CONFIG_REG,
    284  1.1  hamajima 	    read ? sc->sc_dmatiming_r[drive] : sc->sc_dmatiming_w[drive]);
    285  1.1  hamajima 	bus_space_read_4(chp->cmd_iot, chp->cmd_ioh, DMA_CONFIG_REG);
    286  1.1  hamajima 
    287  1.1  hamajima 	offset = va & PGOFSET;
    288  1.1  hamajima 
    289  1.1  hamajima 	/* if va is not page-aligned, setup the first page */
    290  1.1  hamajima 	if (offset != 0) {
    291  1.1  hamajima 		int rest = PAGE_SIZE - offset;	/* the rest of the page */
    292  1.1  hamajima 
    293  1.1  hamajima 		if (datalen > rest) {		/* if continues to next page */
    294  1.1  hamajima 			DBDMA_BUILD(cmdp, cmd, 0, rest, vtophys(va),
    295  1.1  hamajima 				DBDMA_INT_NEVER, DBDMA_WAIT_NEVER,
    296  1.1  hamajima 				DBDMA_BRANCH_NEVER);
    297  1.1  hamajima 			datalen -= rest;
    298  1.1  hamajima 			va += rest;
    299  1.1  hamajima 			cmdp++;
    300  1.1  hamajima 		}
    301  1.1  hamajima 	}
    302  1.1  hamajima 
    303  1.1  hamajima 	/* now va is page-aligned */
    304  1.1  hamajima 	while (datalen > PAGE_SIZE) {
    305  1.1  hamajima 		DBDMA_BUILD(cmdp, cmd, 0, PAGE_SIZE, vtophys(va),
    306  1.1  hamajima 			DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    307  1.1  hamajima 		datalen -= PAGE_SIZE;
    308  1.1  hamajima 		va += PAGE_SIZE;
    309  1.1  hamajima 		cmdp++;
    310  1.1  hamajima 	}
    311  1.1  hamajima 
    312  1.1  hamajima 	/* the last page (datalen <= PAGE_SIZE here) */
    313  1.1  hamajima 	cmd = read ? DBDMA_CMD_IN_LAST : DBDMA_CMD_OUT_LAST;
    314  1.1  hamajima 	DBDMA_BUILD(cmdp, cmd, 0, datalen, vtophys(va),
    315  1.1  hamajima 		DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    316  1.1  hamajima 	cmdp++;
    317  1.1  hamajima 
    318  1.1  hamajima 	DBDMA_BUILD(cmdp, DBDMA_CMD_STOP, 0, 0, 0,
    319  1.1  hamajima 		DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
    320  1.1  hamajima 
    321  1.1  hamajima 	return 0;
    322  1.1  hamajima }
    323  1.1  hamajima 
    324  1.1  hamajima void
    325  1.1  hamajima kauai_dma_start(v, channel, drive)
    326  1.1  hamajima 	void *v;
    327  1.1  hamajima 	int channel, drive;
    328  1.1  hamajima {
    329  1.1  hamajima 	struct kauai_softc *sc = v;
    330  1.1  hamajima 
    331  1.1  hamajima 	dbdma_start(sc->sc_dmareg, sc->sc_dmacmd);
    332  1.1  hamajima }
    333  1.1  hamajima 
    334  1.1  hamajima int
    335  1.1  hamajima kauai_dma_finish(v, channel, drive, read)
    336  1.1  hamajima 	void *v;
    337  1.1  hamajima 	int channel, drive;
    338  1.1  hamajima 	int read;
    339  1.1  hamajima {
    340  1.1  hamajima 	struct kauai_softc *sc = v;
    341  1.1  hamajima 
    342  1.1  hamajima 	dbdma_stop(sc->sc_dmareg);
    343  1.1  hamajima 	return 0;
    344  1.1  hamajima }
    345  1.1  hamajima 
    346  1.1  hamajima /*
    347  1.1  hamajima  * Find OF-device corresponding to the PCI device.
    348  1.1  hamajima  */
    349  1.1  hamajima int
    350  1.1  hamajima getnodebypci(pc, tag)
    351  1.1  hamajima 	pci_chipset_tag_t pc;
    352  1.1  hamajima 	pcitag_t tag;
    353  1.1  hamajima {
    354  1.1  hamajima 	int bus, dev, func;
    355  1.1  hamajima 	u_int reg[5];
    356  1.1  hamajima 	int p, q;
    357  1.1  hamajima 	int l, b, d, f;
    358  1.1  hamajima 
    359  1.1  hamajima 	pci_decompose_tag(pc, tag, &bus, &dev, &func);
    360  1.1  hamajima 
    361  1.1  hamajima 	for (q = OF_peer(0); q; q = p) {
    362  1.1  hamajima 		l = OF_getprop(q, "assigned-addresses", reg, sizeof(reg));
    363  1.1  hamajima 		if (l > 4) {
    364  1.1  hamajima 			b = (reg[0] >> 16) & 0xff;
    365  1.1  hamajima 			d = (reg[0] >> 11) & 0x1f;
    366  1.1  hamajima 			f = (reg[0] >> 8) & 0x07;
    367  1.1  hamajima 
    368  1.1  hamajima 			if (b == bus && d == dev && f == func)
    369  1.1  hamajima 				return q;
    370  1.1  hamajima 		}
    371  1.1  hamajima 		if ((p = OF_child(q)))
    372  1.1  hamajima 			continue;
    373  1.1  hamajima 		while (q) {
    374  1.1  hamajima 			if ((p = OF_peer(q)))
    375  1.1  hamajima 				break;
    376  1.1  hamajima 			q = OF_parent(q);
    377  1.1  hamajima 		}
    378  1.1  hamajima 	}
    379  1.1  hamajima 	return 0;
    380  1.1  hamajima }
    381