kauai.c revision 1.19.36.2 1 1.19.36.2 garbled /* $NetBSD: kauai.c,v 1.19.36.2 2007/06/26 18:12:59 garbled 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.19.36.2 garbled __KERNEL_RCSID(0, "$NetBSD: kauai.c,v 1.19.36.2 2007/06/26 18:12:59 garbled 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.19.36.1 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.19.36.1 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.19.36.1 garbled struct powerpc_bus_space sc_iot;
68 1.1 hamajima dbdma_regmap_t *sc_dmareg;
69 1.1 hamajima dbdma_command_t *sc_dmacmd;
70 1.1 hamajima u_int sc_piotiming_r[2];
71 1.1 hamajima u_int sc_piotiming_w[2];
72 1.1 hamajima u_int sc_dmatiming_r[2];
73 1.1 hamajima u_int sc_dmatiming_w[2];
74 1.1 hamajima void (*sc_calc_timing)(struct kauai_softc *, int);
75 1.1 hamajima };
76 1.1 hamajima
77 1.1 hamajima int kauai_match __P((struct device *, struct cfdata *, void *));
78 1.1 hamajima void kauai_attach __P((struct device *, struct device *, void *));
79 1.1 hamajima int kauai_dma_init __P((void *, int, int, void *, size_t, int));
80 1.1 hamajima void kauai_dma_start __P((void *, int, int));
81 1.1 hamajima int kauai_dma_finish __P((void *, int, int, int));
82 1.15 thorpej void kauai_set_modes __P((struct ata_channel *));
83 1.1 hamajima static void calc_timing_kauai __P((struct kauai_softc *, int));
84 1.1 hamajima static int getnodebypci(pci_chipset_tag_t, pcitag_t);
85 1.1 hamajima
86 1.1 hamajima CFATTACH_DECL(kauai, sizeof(struct kauai_softc),
87 1.1 hamajima kauai_match, kauai_attach, NULL, wdcactivate);
88 1.1 hamajima
89 1.1 hamajima int
90 1.1 hamajima kauai_match(parent, match, aux)
91 1.1 hamajima struct device *parent;
92 1.1 hamajima struct cfdata *match;
93 1.1 hamajima void *aux;
94 1.1 hamajima {
95 1.1 hamajima struct pci_attach_args *pa = aux;
96 1.1 hamajima
97 1.19.36.2 garbled if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_APPLE) {
98 1.19.36.2 garbled switch (PCI_PRODUCT(pa->pa_id)) {
99 1.19.36.2 garbled case PCI_PRODUCT_APPLE_KAUAI:
100 1.19.36.2 garbled case PCI_PRODUCT_APPLE_UNINORTH_ATA:
101 1.19.36.2 garbled case PCI_PRODUCT_APPLE_INTREPID2_ATA:
102 1.19.36.2 garbled return 5;
103 1.19.36.2 garbled }
104 1.19.36.2 garbled }
105 1.1 hamajima
106 1.1 hamajima return 0;
107 1.1 hamajima }
108 1.1 hamajima
109 1.1 hamajima void
110 1.1 hamajima kauai_attach(parent, self, aux)
111 1.1 hamajima struct device *parent, *self;
112 1.1 hamajima void *aux;
113 1.1 hamajima {
114 1.1 hamajima struct kauai_softc *sc = (void *)self;
115 1.1 hamajima struct pci_attach_args *pa = aux;
116 1.15 thorpej struct ata_channel *chp = &sc->sc_channel;
117 1.15 thorpej struct wdc_regs *wdr;
118 1.1 hamajima pci_intr_handle_t ih;
119 1.1 hamajima paddr_t regbase, dmabase;
120 1.7 bouyer int node, reg[5], i;
121 1.1 hamajima
122 1.1 hamajima #ifdef DIAGNOSTIC
123 1.1 hamajima if ((vaddr_t)sc->sc_dmacmd & 0x0f) {
124 1.1 hamajima printf(": bad dbdma alignment\n");
125 1.1 hamajima return;
126 1.1 hamajima }
127 1.1 hamajima #endif
128 1.1 hamajima
129 1.1 hamajima node = getnodebypci(pa->pa_pc, pa->pa_tag);
130 1.1 hamajima if (node == 0) {
131 1.1 hamajima printf(": cannot find gmac node\n");
132 1.1 hamajima return;
133 1.1 hamajima }
134 1.1 hamajima
135 1.1 hamajima if (OF_getprop(node, "assigned-addresses", reg, sizeof reg) < 12) {
136 1.1 hamajima printf(": cannot get address property\n");
137 1.1 hamajima return;
138 1.1 hamajima }
139 1.1 hamajima regbase = reg[2] + 0x2000;
140 1.1 hamajima dmabase = reg[2] + 0x1000;
141 1.1 hamajima
142 1.1 hamajima /*
143 1.1 hamajima * XXX PCI_INTERRUPT_REG seems to be wired to 0.
144 1.1 hamajima * XXX So use fixed intrpin and intrline values.
145 1.1 hamajima */
146 1.1 hamajima if (pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_INTERRUPT_REG) == 0) {
147 1.1 hamajima pa->pa_intrpin = 1;
148 1.1 hamajima pa->pa_intrline = 39;
149 1.1 hamajima }
150 1.1 hamajima
151 1.1 hamajima if (pci_intr_map(pa, &ih)) {
152 1.1 hamajima printf(": unable to map interrupt\n");
153 1.1 hamajima return;
154 1.1 hamajima }
155 1.1 hamajima printf(": interrupting at %s\n", pci_intr_string(pa->pa_pc, ih));
156 1.1 hamajima
157 1.15 thorpej sc->sc_wdcdev.regs = wdr = &sc->sc_wdc_regs;
158 1.1 hamajima
159 1.19.36.1 garbled sc->sc_iot.pbs_offset = regbase;
160 1.19.36.1 garbled sc->sc_iot.pbs_base = 0;
161 1.19.36.1 garbled sc->sc_iot.pbs_limit = WDC_REG_NPORTS;
162 1.19.36.1 garbled sc->sc_iot.pbs_flags = _BUS_SPACE_LITTLE_ENDIAN | 4;
163 1.19.36.1 garbled bus_space_init(&sc->sc_iot, "kauai io", NULL, 0);
164 1.15 thorpej
165 1.19.36.1 garbled wdr->cmd_iot = wdr->ctl_iot = &sc->sc_iot;
166 1.19.36.1 garbled
167 1.19.36.1 garbled if (bus_space_map(wdr->cmd_iot, regbase, WDC_REG_NPORTS, 0,
168 1.15 thorpej &wdr->cmd_baseioh) ||
169 1.15 thorpej bus_space_subregion(wdr->cmd_iot, wdr->cmd_baseioh,
170 1.15 thorpej WDC_AUXREG_OFFSET, 1, &wdr->ctl_ioh)) {
171 1.1 hamajima printf("%s: couldn't map registers\n", self->dv_xname);
172 1.1 hamajima return;
173 1.1 hamajima }
174 1.7 bouyer for (i = 0; i < WDC_NREG; i++) {
175 1.15 thorpej if (bus_space_subregion(wdr->cmd_iot, wdr->cmd_baseioh, i,
176 1.15 thorpej i == 0 ? 4 : 1, &wdr->cmd_iohs[i]) != 0) {
177 1.15 thorpej bus_space_unmap(wdr->cmd_iot, wdr->cmd_baseioh,
178 1.7 bouyer WDC_REG_NPORTS);
179 1.7 bouyer printf("%s: couldn't subregion registers\n",
180 1.16 thorpej sc->sc_wdcdev.sc_atac.atac_dev.dv_xname);
181 1.7 bouyer return;
182 1.7 bouyer }
183 1.7 bouyer }
184 1.1 hamajima
185 1.1 hamajima if (pci_intr_establish(pa->pa_pc, ih, IPL_BIO, wdcintr, chp) == NULL) {
186 1.1 hamajima printf("%s: unable to establish interrupt\n", self->dv_xname);
187 1.1 hamajima return;
188 1.1 hamajima }
189 1.1 hamajima
190 1.1 hamajima
191 1.16 thorpej sc->sc_wdcdev.sc_atac.atac_pio_cap = 4;
192 1.16 thorpej sc->sc_wdcdev.sc_atac.atac_dma_cap = 2;
193 1.16 thorpej sc->sc_wdcdev.sc_atac.atac_udma_cap = 5;
194 1.16 thorpej sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_DATA16;
195 1.16 thorpej sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_DMA | ATAC_CAP_UDMA;
196 1.15 thorpej sc->sc_chanptr = chp;
197 1.16 thorpej sc->sc_wdcdev.sc_atac.atac_channels = &sc->sc_chanptr;
198 1.16 thorpej sc->sc_wdcdev.sc_atac.atac_nchannels = 1;
199 1.1 hamajima sc->sc_wdcdev.dma_arg = sc;
200 1.1 hamajima sc->sc_wdcdev.dma_init = kauai_dma_init;
201 1.1 hamajima sc->sc_wdcdev.dma_start = kauai_dma_start;
202 1.1 hamajima sc->sc_wdcdev.dma_finish = kauai_dma_finish;
203 1.16 thorpej sc->sc_wdcdev.sc_atac.atac_set_modes = kauai_set_modes;
204 1.1 hamajima sc->sc_calc_timing = calc_timing_kauai;
205 1.1 hamajima sc->sc_dmareg = (void *)dmabase;
206 1.1 hamajima
207 1.11 thorpej chp->ch_channel = 0;
208 1.16 thorpej chp->ch_atac = &sc->sc_wdcdev.sc_atac;
209 1.15 thorpej chp->ch_queue = &sc->sc_queue;
210 1.19 bouyer chp->ch_ndrive = 2;
211 1.17 manu wdc_init_shadow_regs(chp);
212 1.1 hamajima
213 1.6 bouyer wdcattach(chp);
214 1.1 hamajima }
215 1.1 hamajima
216 1.1 hamajima void
217 1.1 hamajima kauai_set_modes(chp)
218 1.15 thorpej struct ata_channel *chp;
219 1.1 hamajima {
220 1.16 thorpej struct kauai_softc *sc = (void *)chp->ch_atac;
221 1.16 thorpej struct wdc_regs *wdr = CHAN_TO_WDC_REGS(chp);
222 1.1 hamajima struct ata_drive_datas *drvp0 = &chp->ch_drive[0];
223 1.1 hamajima struct ata_drive_datas *drvp1 = &chp->ch_drive[1];
224 1.1 hamajima struct ata_drive_datas *drvp;
225 1.1 hamajima int drive;
226 1.1 hamajima
227 1.1 hamajima if ((drvp0->drive_flags & DRIVE) && (drvp1->drive_flags & DRIVE)) {
228 1.1 hamajima drvp0->PIO_mode = drvp1->PIO_mode =
229 1.1 hamajima min(drvp0->PIO_mode, drvp1->PIO_mode);
230 1.1 hamajima }
231 1.1 hamajima
232 1.1 hamajima for (drive = 0; drive < 2; drive++) {
233 1.1 hamajima drvp = &chp->ch_drive[drive];
234 1.1 hamajima if (drvp->drive_flags & DRIVE) {
235 1.1 hamajima (*sc->sc_calc_timing)(sc, drive);
236 1.15 thorpej bus_space_write_4(wdr->cmd_iot, wdr->cmd_baseioh,
237 1.1 hamajima PIO_CONFIG_REG, sc->sc_piotiming_r[drive]);
238 1.15 thorpej bus_space_write_4(wdr->cmd_iot, wdr->cmd_baseioh,
239 1.1 hamajima DMA_CONFIG_REG, sc->sc_dmatiming_r[drive]);
240 1.1 hamajima }
241 1.1 hamajima }
242 1.1 hamajima }
243 1.1 hamajima
244 1.1 hamajima /*
245 1.1 hamajima * IDE transfer timings
246 1.1 hamajima */
247 1.1 hamajima static const u_int pio_timing_kauai[] = { /* 0xff000fff */
248 1.1 hamajima 0x08000a92, /* Mode 0 */
249 1.1 hamajima 0x0800060f, /* 1 */
250 1.1 hamajima 0x0800038b, /* 2 */
251 1.1 hamajima 0x05000249, /* 3 */
252 1.1 hamajima 0x04000148 /* 4 */
253 1.1 hamajima };
254 1.1 hamajima static const u_int dma_timing_kauai[] = { /* 0x00fff000 */
255 1.1 hamajima 0x00618000, /* Mode 0 */
256 1.1 hamajima 0x00209000, /* 1 */
257 1.1 hamajima 0x00148000 /* 2 */
258 1.1 hamajima };
259 1.1 hamajima static const u_int udma_timing_kauai[] = { /* 0x0000ffff */
260 1.1 hamajima 0x000070c0, /* Mode 0 */
261 1.1 hamajima 0x00005d80, /* 1 */
262 1.1 hamajima 0x00004a60, /* 2 */
263 1.1 hamajima 0x00003a50, /* 3 */
264 1.1 hamajima 0x00002a30, /* 4 */
265 1.1 hamajima 0x00002921 /* 5 */
266 1.1 hamajima };
267 1.1 hamajima
268 1.1 hamajima /*
269 1.1 hamajima * Timing calculation for Kauai.
270 1.1 hamajima */
271 1.1 hamajima void
272 1.1 hamajima calc_timing_kauai(sc, drive)
273 1.1 hamajima struct kauai_softc *sc;
274 1.1 hamajima int drive;
275 1.1 hamajima {
276 1.15 thorpej struct ata_channel *chp = &sc->sc_channel;
277 1.1 hamajima struct ata_drive_datas *drvp = &chp->ch_drive[drive];
278 1.1 hamajima int piomode = drvp->PIO_mode;
279 1.1 hamajima int dmamode = drvp->DMA_mode;
280 1.1 hamajima int udmamode = drvp->UDMA_mode;
281 1.1 hamajima u_int pioconf, dmaconf;
282 1.1 hamajima
283 1.1 hamajima pioconf = pio_timing_kauai[piomode];
284 1.1 hamajima
285 1.1 hamajima dmaconf = 0;
286 1.1 hamajima if (drvp->drive_flags & DRIVE_DMA)
287 1.1 hamajima dmaconf |= dma_timing_kauai[dmamode];
288 1.1 hamajima if (drvp->drive_flags & DRIVE_UDMA)
289 1.1 hamajima dmaconf |= udma_timing_kauai[udmamode];
290 1.1 hamajima
291 1.1 hamajima if (drvp->drive_flags & DRIVE_UDMA)
292 1.1 hamajima dmaconf |= 1;
293 1.1 hamajima
294 1.1 hamajima sc->sc_piotiming_r[drive] = sc->sc_piotiming_w[drive] = pioconf;
295 1.1 hamajima sc->sc_dmatiming_r[drive] = sc->sc_dmatiming_w[drive] = dmaconf;
296 1.1 hamajima }
297 1.1 hamajima
298 1.1 hamajima int
299 1.1 hamajima kauai_dma_init(v, channel, drive, databuf, datalen, flags)
300 1.1 hamajima void *v;
301 1.1 hamajima void *databuf;
302 1.1 hamajima size_t datalen;
303 1.1 hamajima int flags;
304 1.1 hamajima {
305 1.1 hamajima struct kauai_softc *sc = v;
306 1.1 hamajima dbdma_command_t *cmdp = sc->sc_dmacmd;
307 1.15 thorpej struct ata_channel *chp = &sc->sc_channel;
308 1.16 thorpej struct wdc_regs *wdr = CHAN_TO_WDC_REGS(chp);
309 1.1 hamajima vaddr_t va = (vaddr_t)databuf;
310 1.1 hamajima int read = flags & WDC_DMA_READ;
311 1.1 hamajima int cmd = read ? DBDMA_CMD_IN_MORE : DBDMA_CMD_OUT_MORE;
312 1.1 hamajima u_int offset;
313 1.1 hamajima
314 1.15 thorpej bus_space_write_4(wdr->cmd_iot, wdr->cmd_baseioh, DMA_CONFIG_REG,
315 1.1 hamajima read ? sc->sc_dmatiming_r[drive] : sc->sc_dmatiming_w[drive]);
316 1.15 thorpej bus_space_read_4(wdr->cmd_iot, wdr->cmd_baseioh, DMA_CONFIG_REG);
317 1.1 hamajima
318 1.1 hamajima offset = va & PGOFSET;
319 1.1 hamajima
320 1.1 hamajima /* if va is not page-aligned, setup the first page */
321 1.1 hamajima if (offset != 0) {
322 1.1 hamajima int rest = PAGE_SIZE - offset; /* the rest of the page */
323 1.1 hamajima
324 1.1 hamajima if (datalen > rest) { /* if continues to next page */
325 1.1 hamajima DBDMA_BUILD(cmdp, cmd, 0, rest, vtophys(va),
326 1.1 hamajima DBDMA_INT_NEVER, DBDMA_WAIT_NEVER,
327 1.1 hamajima DBDMA_BRANCH_NEVER);
328 1.1 hamajima datalen -= rest;
329 1.1 hamajima va += rest;
330 1.1 hamajima cmdp++;
331 1.1 hamajima }
332 1.1 hamajima }
333 1.1 hamajima
334 1.1 hamajima /* now va is page-aligned */
335 1.1 hamajima while (datalen > PAGE_SIZE) {
336 1.1 hamajima DBDMA_BUILD(cmdp, cmd, 0, PAGE_SIZE, vtophys(va),
337 1.1 hamajima DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
338 1.1 hamajima datalen -= PAGE_SIZE;
339 1.1 hamajima va += PAGE_SIZE;
340 1.1 hamajima cmdp++;
341 1.1 hamajima }
342 1.1 hamajima
343 1.1 hamajima /* the last page (datalen <= PAGE_SIZE here) */
344 1.1 hamajima cmd = read ? DBDMA_CMD_IN_LAST : DBDMA_CMD_OUT_LAST;
345 1.1 hamajima DBDMA_BUILD(cmdp, cmd, 0, datalen, vtophys(va),
346 1.1 hamajima DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
347 1.1 hamajima cmdp++;
348 1.1 hamajima
349 1.1 hamajima DBDMA_BUILD(cmdp, DBDMA_CMD_STOP, 0, 0, 0,
350 1.1 hamajima DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER);
351 1.1 hamajima
352 1.1 hamajima return 0;
353 1.1 hamajima }
354 1.1 hamajima
355 1.1 hamajima void
356 1.1 hamajima kauai_dma_start(v, channel, drive)
357 1.1 hamajima void *v;
358 1.1 hamajima int channel, drive;
359 1.1 hamajima {
360 1.1 hamajima struct kauai_softc *sc = v;
361 1.1 hamajima
362 1.1 hamajima dbdma_start(sc->sc_dmareg, sc->sc_dmacmd);
363 1.1 hamajima }
364 1.1 hamajima
365 1.1 hamajima int
366 1.1 hamajima kauai_dma_finish(v, channel, drive, read)
367 1.1 hamajima void *v;
368 1.1 hamajima int channel, drive;
369 1.1 hamajima int read;
370 1.1 hamajima {
371 1.1 hamajima struct kauai_softc *sc = v;
372 1.1 hamajima
373 1.1 hamajima dbdma_stop(sc->sc_dmareg);
374 1.1 hamajima return 0;
375 1.1 hamajima }
376 1.1 hamajima
377 1.1 hamajima /*
378 1.1 hamajima * Find OF-device corresponding to the PCI device.
379 1.1 hamajima */
380 1.1 hamajima int
381 1.1 hamajima getnodebypci(pc, tag)
382 1.1 hamajima pci_chipset_tag_t pc;
383 1.1 hamajima pcitag_t tag;
384 1.1 hamajima {
385 1.1 hamajima int bus, dev, func;
386 1.1 hamajima u_int reg[5];
387 1.1 hamajima int p, q;
388 1.1 hamajima int l, b, d, f;
389 1.1 hamajima
390 1.1 hamajima pci_decompose_tag(pc, tag, &bus, &dev, &func);
391 1.1 hamajima
392 1.1 hamajima for (q = OF_peer(0); q; q = p) {
393 1.1 hamajima l = OF_getprop(q, "assigned-addresses", reg, sizeof(reg));
394 1.1 hamajima if (l > 4) {
395 1.1 hamajima b = (reg[0] >> 16) & 0xff;
396 1.1 hamajima d = (reg[0] >> 11) & 0x1f;
397 1.1 hamajima f = (reg[0] >> 8) & 0x07;
398 1.1 hamajima
399 1.1 hamajima if (b == bus && d == dev && f == func)
400 1.1 hamajima return q;
401 1.1 hamajima }
402 1.1 hamajima if ((p = OF_child(q)))
403 1.1 hamajima continue;
404 1.1 hamajima while (q) {
405 1.1 hamajima if ((p = OF_peer(q)))
406 1.1 hamajima break;
407 1.1 hamajima q = OF_parent(q);
408 1.1 hamajima }
409 1.1 hamajima }
410 1.1 hamajima return 0;
411 1.1 hamajima }
412