xd.c revision 1.75 1 /* $NetBSD: xd.c,v 1.75 2008/04/05 16:06:12 cegger Exp $ */
2
3 /*
4 *
5 * Copyright (c) 1995 Charles D. Cranor
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. All advertising materials mentioning features or use of this software
17 * must display the following acknowledgement:
18 * This product includes software developed by Charles D. Cranor.
19 * 4. The name of the author may not be used to endorse or promote products
20 * derived from this software without specific prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
23 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
24 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
25 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
26 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
27 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
31 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32 */
33
34 /*
35 *
36 * x d . c x y l o g i c s 7 5 3 / 7 0 5 3 v m e / s m d d r i v e r
37 *
38 * author: Chuck Cranor <chuck (at) ccrc.wustl.edu>
39 * started: 27-Feb-95
40 * references: [1] Xylogics Model 753 User's Manual
41 * part number: 166-753-001, Revision B, May 21, 1988.
42 * "Your Partner For Performance"
43 * [2] other NetBSD disk device drivers
44 *
45 * Special thanks go to Scott E. Campbell of Xylogics, Inc. for taking
46 * the time to answer some of my questions about the 753/7053.
47 *
48 * note: the 753 and the 7053 are programmed the same way, but are
49 * different sizes. the 753 is a 6U VME card, while the 7053 is a 9U
50 * VME card (found in many VME based suns).
51 */
52
53 #include <sys/cdefs.h>
54 __KERNEL_RCSID(0, "$NetBSD: xd.c,v 1.75 2008/04/05 16:06:12 cegger Exp $");
55
56 #undef XDC_DEBUG /* full debug */
57 #define XDC_DIAG /* extra sanity checks */
58 #if defined(DIAGNOSTIC) && !defined(XDC_DIAG)
59 #define XDC_DIAG /* link in with master DIAG option */
60 #endif
61
62 #include <sys/param.h>
63 #include <sys/proc.h>
64 #include <sys/systm.h>
65 #include <sys/kernel.h>
66 #include <sys/file.h>
67 #include <sys/stat.h>
68 #include <sys/ioctl.h>
69 #include <sys/buf.h>
70 #include <sys/bufq.h>
71 #include <sys/uio.h>
72 #include <sys/malloc.h>
73 #include <sys/device.h>
74 #include <sys/disklabel.h>
75 #include <sys/disk.h>
76 #include <sys/syslog.h>
77 #include <sys/dkbad.h>
78 #include <sys/conf.h>
79 #include <sys/kauth.h>
80
81 #include <sys/bus.h>
82 #include <sys/intr.h>
83
84 #if defined(__sparc__) || defined(sun3)
85 #include <dev/sun/disklabel.h>
86 #endif
87
88 #include <dev/vme/vmereg.h>
89 #include <dev/vme/vmevar.h>
90
91 #include <dev/vme/xdreg.h>
92 #include <dev/vme/xdvar.h>
93 #include <dev/vme/xio.h>
94
95 #include "locators.h"
96
97 /*
98 * macros
99 */
100
101 /*
102 * XDC_TWAIT: add iorq "N" to tail of SC's wait queue
103 */
104 #define XDC_TWAIT(SC, N) { \
105 (SC)->waitq[(SC)->waitend] = (N); \
106 (SC)->waitend = ((SC)->waitend + 1) % XDC_MAXIOPB; \
107 (SC)->nwait++; \
108 }
109
110 /*
111 * XDC_HWAIT: add iorq "N" to head of SC's wait queue
112 */
113 #define XDC_HWAIT(SC, N) { \
114 (SC)->waithead = ((SC)->waithead == 0) ? \
115 (XDC_MAXIOPB - 1) : ((SC)->waithead - 1); \
116 (SC)->waitq[(SC)->waithead] = (N); \
117 (SC)->nwait++; \
118 }
119
120 /*
121 * XDC_GET_WAITER: gets the first request waiting on the waitq
122 * and removes it (so it can be submitted)
123 */
124 #define XDC_GET_WAITER(XDCSC, RQ) { \
125 (RQ) = (XDCSC)->waitq[(XDCSC)->waithead]; \
126 (XDCSC)->waithead = ((XDCSC)->waithead + 1) % XDC_MAXIOPB; \
127 xdcsc->nwait--; \
128 }
129
130 /*
131 * XDC_FREE: add iorq "N" to SC's free list
132 */
133 #define XDC_FREE(SC, N) { \
134 (SC)->freereq[(SC)->nfree++] = (N); \
135 (SC)->reqs[N].mode = 0; \
136 if ((SC)->nfree == 1) wakeup(&(SC)->nfree); \
137 }
138
139
140 /*
141 * XDC_RQALLOC: allocate an iorq off the free list (assume nfree > 0).
142 */
143 #define XDC_RQALLOC(XDCSC) (XDCSC)->freereq[--((XDCSC)->nfree)]
144
145 /*
146 * XDC_GO: start iopb ADDR (DVMA addr in a u_long) on XDC
147 */
148 #define XDC_GO(XDC, ADDR) { \
149 (XDC)->xdc_iopbaddr0 = ((ADDR) & 0xff); \
150 (ADDR) = ((ADDR) >> 8); \
151 (XDC)->xdc_iopbaddr1 = ((ADDR) & 0xff); \
152 (ADDR) = ((ADDR) >> 8); \
153 (XDC)->xdc_iopbaddr2 = ((ADDR) & 0xff); \
154 (ADDR) = ((ADDR) >> 8); \
155 (XDC)->xdc_iopbaddr3 = (ADDR); \
156 (XDC)->xdc_iopbamod = XDC_ADDRMOD; \
157 (XDC)->xdc_csr = XDC_ADDIOPB; /* go! */ \
158 }
159
160 /*
161 * XDC_WAIT: wait for XDC's csr "BITS" to come on in "TIME".
162 * LCV is a counter. If it goes to zero then we timed out.
163 */
164 #define XDC_WAIT(XDC, LCV, TIME, BITS) { \
165 (LCV) = (TIME); \
166 while ((LCV) > 0) { \
167 if ((XDC)->xdc_csr & (BITS)) break; \
168 (LCV) = (LCV) - 1; \
169 DELAY(1); \
170 } \
171 }
172
173 /*
174 * XDC_DONE: don't need IORQ, get error code and free (done after xdc_cmd)
175 */
176 #define XDC_DONE(SC,RQ,ER) { \
177 if ((RQ) == XD_ERR_FAIL) { \
178 (ER) = (RQ); \
179 } else { \
180 if ((SC)->ndone-- == XDC_SUBWAITLIM) \
181 wakeup(&(SC)->ndone); \
182 (ER) = (SC)->reqs[RQ].errnum; \
183 XDC_FREE((SC), (RQ)); \
184 } \
185 }
186
187 /*
188 * XDC_ADVANCE: advance iorq's pointers by a number of sectors
189 */
190 #define XDC_ADVANCE(IORQ, N) { \
191 if (N) { \
192 (IORQ)->sectcnt -= (N); \
193 (IORQ)->blockno += (N); \
194 (IORQ)->dbuf += ((N)*XDFM_BPS); \
195 } \
196 }
197
198 /*
199 * note - addresses you can sleep on:
200 * [1] & of xd_softc's "state" (waiting for a chance to attach a drive)
201 * [2] & of xdc_softc's "nfree" (waiting for a free iorq/iopb)
202 * [3] & of xdc_softc's "ndone" (waiting for number of done iorq/iopb's
203 * to drop below XDC_SUBWAITLIM)
204 * [4] & an iorq (waiting for an XD_SUB_WAIT iorq to finish)
205 */
206
207
208 /*
209 * function prototypes
210 * "xdc_*" functions are internal, all others are external interfaces
211 */
212
213 extern int pil_to_vme[]; /* from obio.c */
214
215 /* internals */
216 int xdc_cmd(struct xdc_softc *, int, int, int, int, int, char *, int);
217 const char *xdc_e2str(int);
218 int xdc_error(struct xdc_softc *, struct xd_iorq *,
219 struct xd_iopb *, int, int);
220 int xdc_ioctlcmd(struct xd_softc *, dev_t dev, struct xd_iocmd *);
221 void xdc_perror(struct xd_iorq *, struct xd_iopb *, int);
222 int xdc_piodriver(struct xdc_softc *, int, int);
223 int xdc_remove_iorq(struct xdc_softc *);
224 int xdc_reset(struct xdc_softc *, int, int, int, struct xd_softc *);
225 inline void xdc_rqinit(struct xd_iorq *, struct xdc_softc *,
226 struct xd_softc *, int, u_long, int,
227 void *, struct buf *);
228 void xdc_rqtopb(struct xd_iorq *, struct xd_iopb *, int, int);
229 void xdc_start(struct xdc_softc *, int);
230 int xdc_startbuf(struct xdc_softc *, struct xd_softc *, struct buf *);
231 int xdc_submit_iorq(struct xdc_softc *, int, int);
232 void xdc_tick(void *);
233 void xdc_xdreset(struct xdc_softc *, struct xd_softc *);
234 int xd_dmamem_alloc(bus_dma_tag_t, bus_dmamap_t, bus_dma_segment_t *,
235 int *, bus_size_t, void **, bus_addr_t *);
236 void xd_dmamem_free(bus_dma_tag_t, bus_dmamap_t, bus_dma_segment_t *,
237 int, bus_size_t, void *);
238
239
240 /* machine interrupt hook */
241 int xdcintr(void *);
242
243 /* autoconf */
244 int xdcmatch(struct device *, struct cfdata *, void *);
245 void xdcattach(struct device *, struct device *, void *);
246 int xdmatch(struct device *, struct cfdata *, void *);
247 void xdattach(struct device *, struct device *, void *);
248 static int xdc_probe(void *, bus_space_tag_t, bus_space_handle_t);
249
250 static void xddummystrat(struct buf *);
251 int xdgetdisklabel(struct xd_softc *, void *);
252
253 /* XXX - think about this more.. xd_machdep? */
254 void xdc_md_setup(void);
255 int XDC_DELAY;
256
257 #if defined(__sparc__)
258 #include <sparc/sparc/vaddrs.h>
259 #include <sparc/sparc/cpuvar.h>
260 void xdc_md_setup()
261 {
262 if (CPU_ISSUN4 && cpuinfo.cpu_type == CPUTYP_4_300)
263 XDC_DELAY = XDC_DELAY_4_300;
264 else
265 XDC_DELAY = XDC_DELAY_SPARC;
266 }
267 #elif defined(sun3)
268 void xdc_md_setup()
269 {
270 XDC_DELAY = XDC_DELAY_SUN3;
271 }
272 #else
273 void xdc_md_setup()
274 {
275 XDC_DELAY = 0;
276 }
277 #endif
278
279 /*
280 * cfattach's: device driver interface to autoconfig
281 */
282
283 CFATTACH_DECL(xdc, sizeof(struct xdc_softc),
284 xdcmatch, xdcattach, NULL, NULL);
285
286 CFATTACH_DECL(xd, sizeof(struct xd_softc),
287 xdmatch, xdattach, NULL, NULL);
288
289 extern struct cfdriver xd_cd;
290
291 dev_type_open(xdopen);
292 dev_type_close(xdclose);
293 dev_type_read(xdread);
294 dev_type_write(xdwrite);
295 dev_type_ioctl(xdioctl);
296 dev_type_strategy(xdstrategy);
297 dev_type_dump(xddump);
298 dev_type_size(xdsize);
299
300 const struct bdevsw xd_bdevsw = {
301 xdopen, xdclose, xdstrategy, xdioctl, xddump, xdsize, D_DISK
302 };
303
304 const struct cdevsw xd_cdevsw = {
305 xdopen, xdclose, xdread, xdwrite, xdioctl,
306 nostop, notty, nopoll, nommap, nokqfilter, D_DISK
307 };
308
309 struct xdc_attach_args { /* this is the "aux" args to xdattach */
310 int driveno; /* unit number */
311 int fullmode; /* submit mode */
312 int booting; /* are we booting or not? */
313 };
314
315 /*
316 * dkdriver
317 */
318
319 struct dkdriver xddkdriver = {xdstrategy};
320
321 /*
322 * start: disk label fix code (XXX)
323 */
324
325 static void *xd_labeldata;
326
327 static void
328 xddummystrat(bp)
329 struct buf *bp;
330 {
331 if (bp->b_bcount != XDFM_BPS)
332 panic("xddummystrat");
333 bcopy(xd_labeldata, bp->b_data, XDFM_BPS);
334 bp->b_oflags |= BO_DONE;
335 bp->b_cflags &= ~BC_BUSY;
336 }
337
338 int
339 xdgetdisklabel(xd, b)
340 struct xd_softc *xd;
341 void *b;
342 {
343 const char *err;
344 #if defined(__sparc__) || defined(sun3)
345 struct sun_disklabel *sdl;
346 #endif
347
348 /* We already have the label data in `b'; setup for dummy strategy */
349 xd_labeldata = b;
350
351 /* Required parameter for readdisklabel() */
352 xd->sc_dk.dk_label->d_secsize = XDFM_BPS;
353
354 err = readdisklabel(MAKEDISKDEV(0, device_unit(&xd->sc_dev), RAW_PART),
355 xddummystrat,
356 xd->sc_dk.dk_label, xd->sc_dk.dk_cpulabel);
357 if (err) {
358 aprint_error_dev(&xd->sc_dev, "%s\n", err);
359 return(XD_ERR_FAIL);
360 }
361
362 #if defined(__sparc__) || defined(sun3)
363 /* Ok, we have the label; fill in `pcyl' if there's SunOS magic */
364 sdl = (struct sun_disklabel *)xd->sc_dk.dk_cpulabel->cd_block;
365 if (sdl->sl_magic == SUN_DKMAGIC) {
366 xd->pcyl = sdl->sl_pcylinders;
367 } else
368 #endif
369 {
370 printf("%s: WARNING: no `pcyl' in disk label.\n",
371 device_xname(&xd->sc_dev));
372 xd->pcyl = xd->sc_dk.dk_label->d_ncylinders +
373 xd->sc_dk.dk_label->d_acylinders;
374 printf("%s: WARNING: guessing pcyl=%d (ncyl+acyl)\n",
375 device_xname(&xd->sc_dev), xd->pcyl);
376 }
377
378 xd->ncyl = xd->sc_dk.dk_label->d_ncylinders;
379 xd->acyl = xd->sc_dk.dk_label->d_acylinders;
380 xd->nhead = xd->sc_dk.dk_label->d_ntracks;
381 xd->nsect = xd->sc_dk.dk_label->d_nsectors;
382 xd->sectpercyl = xd->nhead * xd->nsect;
383 xd->sc_dk.dk_label->d_secsize = XDFM_BPS; /* not handled by
384 * sun->bsd */
385 return(XD_ERR_AOK);
386 }
387
388 /*
389 * end: disk label fix code (XXX)
390 */
391
392 /*
393 * Shorthand for allocating, mapping and loading a DMA buffer
394 */
395 int
396 xd_dmamem_alloc(tag, map, seg, nsegp, len, kvap, dmap)
397 bus_dma_tag_t tag;
398 bus_dmamap_t map;
399 bus_dma_segment_t *seg;
400 int *nsegp;
401 bus_size_t len;
402 void * *kvap;
403 bus_addr_t *dmap;
404 {
405 int nseg;
406 int error;
407
408 if ((error = bus_dmamem_alloc(tag, len, 0, 0,
409 seg, 1, &nseg, BUS_DMA_NOWAIT)) != 0) {
410 return (error);
411 }
412
413 if ((error = bus_dmamem_map(tag, seg, nseg,
414 len, kvap,
415 BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) != 0) {
416 bus_dmamem_free(tag, seg, nseg);
417 return (error);
418 }
419
420 if ((error = bus_dmamap_load(tag, map,
421 *kvap, len, NULL,
422 BUS_DMA_NOWAIT)) != 0) {
423 bus_dmamem_unmap(tag, *kvap, len);
424 bus_dmamem_free(tag, seg, nseg);
425 return (error);
426 }
427
428 *dmap = map->dm_segs[0].ds_addr;
429 *nsegp = nseg;
430 return (0);
431 }
432
433 void
434 xd_dmamem_free(tag, map, seg, nseg, len, kva)
435 bus_dma_tag_t tag;
436 bus_dmamap_t map;
437 bus_dma_segment_t *seg;
438 int nseg;
439 bus_size_t len;
440 void * kva;
441 {
442
443 bus_dmamap_unload(tag, map);
444 bus_dmamem_unmap(tag, kva, len);
445 bus_dmamem_free(tag, seg, nseg);
446 }
447
448
449 /*
450 * a u t o c o n f i g f u n c t i o n s
451 */
452
453 /*
454 * xdcmatch: determine if xdc is present or not. we do a
455 * soft reset to detect the xdc.
456 */
457
458 int
459 xdc_probe(arg, tag, handle)
460 void *arg;
461 bus_space_tag_t tag;
462 bus_space_handle_t handle;
463 {
464 struct xdc *xdc = (void *)handle; /* XXX */
465 int del = 0;
466
467 xdc->xdc_csr = XDC_RESET;
468 XDC_WAIT(xdc, del, XDC_RESETUSEC, XDC_RESET);
469 return (del > 0 ? 0 : EIO);
470 }
471
472 int xdcmatch(parent, cf, aux)
473 struct device *parent;
474 struct cfdata *cf;
475 void *aux;
476 {
477 struct vme_attach_args *va = aux;
478 vme_chipset_tag_t ct = va->va_vct;
479 vme_am_t mod;
480 int error;
481
482 mod = VME_AM_A16 | VME_AM_MBO | VME_AM_SUPER | VME_AM_DATA;
483 if (vme_space_alloc(ct, va->r[0].offset, sizeof(struct xdc), mod))
484 return (0);
485
486 error = vme_probe(ct, va->r[0].offset, sizeof(struct xdc),
487 mod, VME_D32, xdc_probe, 0);
488 vme_space_free(va->va_vct, va->r[0].offset, sizeof(struct xdc), mod);
489
490 return (error == 0);
491 }
492
493 /*
494 * xdcattach: attach controller
495 */
496 void
497 xdcattach(parent, self, aux)
498 struct device *parent, *self;
499 void *aux;
500
501 {
502 struct vme_attach_args *va = aux;
503 vme_chipset_tag_t ct = va->va_vct;
504 bus_space_tag_t bt;
505 bus_space_handle_t bh;
506 vme_intr_handle_t ih;
507 vme_am_t mod;
508 struct xdc_softc *xdc = (void *) self;
509 struct xdc_attach_args xa;
510 int lcv, rqno, error;
511 struct xd_iopb_ctrl *ctl;
512 bus_dma_segment_t seg;
513 int rseg;
514 vme_mapresc_t resc;
515 bus_addr_t busaddr;
516
517 xdc_md_setup();
518
519 /* get addressing and intr level stuff from autoconfig and load it
520 * into our xdc_softc. */
521
522 xdc->dmatag = va->va_bdt;
523 mod = VME_AM_A16 | VME_AM_MBO | VME_AM_SUPER | VME_AM_DATA;
524
525 if (vme_space_alloc(ct, va->r[0].offset, sizeof(struct xdc), mod))
526 panic("xdc: vme alloc");
527
528 if (vme_space_map(ct, va->r[0].offset, sizeof(struct xdc),
529 mod, VME_D32, 0, &bt, &bh, &resc) != 0)
530 panic("xdc: vme_map");
531
532 xdc->xdc = (struct xdc *) bh; /* XXX */
533 xdc->ipl = va->ilevel;
534 xdc->vector = va->ivector;
535
536 for (lcv = 0; lcv < XDC_MAXDEV; lcv++)
537 xdc->sc_drives[lcv] = (struct xd_softc *) 0;
538
539 /*
540 * allocate and zero buffers
541 *
542 * note: we simplify the code by allocating the max number of iopbs and
543 * iorq's up front. thus, we avoid linked lists and the costs
544 * associated with them in exchange for wasting a little memory.
545 */
546
547 /* Get DMA handle for misc. transfers */
548 if ((error = vme_dmamap_create(
549 ct, /* VME chip tag */
550 MAXPHYS, /* size */
551 VME_AM_A24, /* address modifier */
552 VME_D32, /* data size */
553 0, /* swap */
554 1, /* nsegments */
555 MAXPHYS, /* maxsegsz */
556 0, /* boundary */
557 BUS_DMA_NOWAIT,
558 &xdc->auxmap)) != 0) {
559
560 aprint_error_dev(&xdc->sc_dev, "DMA buffer map create error %d\n",
561 error);
562 return;
563 }
564
565
566 /* Get DMA handle for mapping iorq descriptors */
567 if ((error = vme_dmamap_create(
568 ct, /* VME chip tag */
569 XDC_MAXIOPB * sizeof(struct xd_iopb),
570 VME_AM_A24, /* address modifier */
571 VME_D32, /* data size */
572 0, /* swap */
573 1, /* nsegments */
574 XDC_MAXIOPB * sizeof(struct xd_iopb),
575 0, /* boundary */
576 BUS_DMA_NOWAIT,
577 &xdc->iopmap)) != 0) {
578
579 aprint_error_dev(&xdc->sc_dev, "DMA buffer map create error %d\n",
580 error);
581 return;
582 }
583
584 /* Get DMA buffer for iorq descriptors */
585 if ((error = xd_dmamem_alloc(xdc->dmatag, xdc->iopmap, &seg, &rseg,
586 XDC_MAXIOPB * sizeof(struct xd_iopb),
587 (void **)&xdc->iopbase,
588 &busaddr)) != 0) {
589 aprint_error_dev(&xdc->sc_dev, "DMA buffer alloc error %d\n",
590 error);
591 return;
592 }
593 xdc->dvmaiopb = (struct xd_iopb *)(u_long)BUS_ADDR_PADDR(busaddr);
594
595 bzero(xdc->iopbase, XDC_MAXIOPB * sizeof(struct xd_iopb));
596
597 xdc->reqs = (struct xd_iorq *)
598 malloc(XDC_MAXIOPB * sizeof(struct xd_iorq),
599 M_DEVBUF, M_NOWAIT|M_ZERO);
600 if (xdc->reqs == NULL)
601 panic("xdc malloc");
602
603 /* init free list, iorq to iopb pointers, and non-zero fields in the
604 * iopb which never change. */
605
606 for (lcv = 0; lcv < XDC_MAXIOPB; lcv++) {
607 xdc->reqs[lcv].iopb = &xdc->iopbase[lcv];
608 xdc->reqs[lcv].dmaiopb = &xdc->dvmaiopb[lcv];
609 xdc->freereq[lcv] = lcv;
610 xdc->iopbase[lcv].fixd = 1; /* always the same */
611 xdc->iopbase[lcv].naddrmod = XDC_ADDRMOD; /* always the same */
612 xdc->iopbase[lcv].intr_vec = xdc->vector; /* always the same */
613
614 if ((error = vme_dmamap_create(
615 ct, /* VME chip tag */
616 MAXPHYS, /* size */
617 VME_AM_A24, /* address modifier */
618 VME_D32, /* data size */
619 0, /* swap */
620 1, /* nsegments */
621 MAXPHYS, /* maxsegsz */
622 0, /* boundary */
623 BUS_DMA_NOWAIT,
624 &xdc->reqs[lcv].dmamap)) != 0) {
625
626 aprint_error_dev(&xdc->sc_dev, "DMA buffer map create error %d\n",
627 error);
628 return;
629 }
630 }
631 xdc->nfree = XDC_MAXIOPB;
632 xdc->nrun = 0;
633 xdc->waithead = xdc->waitend = xdc->nwait = 0;
634 xdc->ndone = 0;
635
636 /* init queue of waiting bufs */
637
638 bufq_alloc(&xdc->sc_wq, "fcfs", 0);
639 callout_init(&xdc->sc_tick_ch, 0);
640
641 /*
642 * section 7 of the manual tells us how to init the controller:
643 * - read controller parameters (6/0)
644 * - write controller parameters (5/0)
645 */
646
647 /* read controller parameters and insure we have a 753/7053 */
648
649 rqno = xdc_cmd(xdc, XDCMD_RDP, XDFUN_CTL, 0, 0, 0, 0, XD_SUB_POLL);
650 if (rqno == XD_ERR_FAIL) {
651 printf(": couldn't read controller params\n");
652 return; /* shouldn't ever happen */
653 }
654 ctl = (struct xd_iopb_ctrl *) &xdc->iopbase[rqno];
655 if (ctl->ctype != XDCT_753) {
656 if (xdc->reqs[rqno].errnum)
657 printf(": %s: ", xdc_e2str(xdc->reqs[rqno].errnum));
658 printf(": doesn't identify as a 753/7053\n");
659 XDC_DONE(xdc, rqno, error);
660 return;
661 }
662 printf(": Xylogics 753/7053, PROM=0x%x.%02x.%02x\n",
663 ctl->eprom_partno, ctl->eprom_lvl, ctl->eprom_rev);
664 XDC_DONE(xdc, rqno, error);
665
666 /* now write controller parameters (xdc_cmd sets all params for us) */
667
668 rqno = xdc_cmd(xdc, XDCMD_WRP, XDFUN_CTL, 0, 0, 0, 0, XD_SUB_POLL);
669 XDC_DONE(xdc, rqno, error);
670 if (error) {
671 aprint_error_dev(&xdc->sc_dev, "controller config error: %s\n",
672 xdc_e2str(error));
673 return;
674 }
675
676 /* link in interrupt with higher level software */
677 vme_intr_map(ct, va->ilevel, va->ivector, &ih);
678 vme_intr_establish(ct, ih, IPL_BIO, xdcintr, xdc);
679 evcnt_attach_dynamic(&xdc->sc_intrcnt, EVCNT_TYPE_INTR, NULL,
680 device_xname(&xdc->sc_dev), "intr");
681
682
683 /* now we must look for disks using autoconfig */
684 xa.fullmode = XD_SUB_POLL;
685 xa.booting = 1;
686
687 for (xa.driveno = 0; xa.driveno < XDC_MAXDEV; xa.driveno++)
688 (void) config_found(self, (void *) &xa, NULL);
689
690 /* start the watchdog clock */
691 callout_reset(&xdc->sc_tick_ch, XDC_TICKCNT, xdc_tick, xdc);
692
693 }
694
695 /*
696 * xdmatch: probe for disk.
697 *
698 * note: we almost always say disk is present. this allows us to
699 * spin up and configure a disk after the system is booted (we can
700 * call xdattach!).
701 */
702 int
703 xdmatch(parent, cf, aux)
704 struct device *parent;
705 struct cfdata *cf;
706 void *aux;
707 {
708 struct xdc_attach_args *xa = aux;
709
710 /* looking for autoconf wildcard or exact match */
711
712 if (cf->cf_loc[XDCCF_DRIVE] != XDCCF_DRIVE_DEFAULT &&
713 cf->cf_loc[XDCCF_DRIVE] != xa->driveno)
714 return 0;
715
716 return 1;
717
718 }
719
720 /*
721 * xdattach: attach a disk. this can be called from autoconf and also
722 * from xdopen/xdstrategy.
723 */
724 void
725 xdattach(parent, self, aux)
726 struct device *parent, *self;
727 void *aux;
728
729 {
730 struct xd_softc *xd = (void *) self;
731 struct xdc_softc *xdc = (void *) parent;
732 struct xdc_attach_args *xa = aux;
733 int rqno, spt = 0, mb, blk, lcv, fmode, s = 0, newstate;
734 struct xd_iopb_drive *driopb;
735 struct dkbad *dkb;
736 int rseg, error;
737 bus_dma_segment_t seg;
738 bus_addr_t busaddr;
739 void * dmaddr;
740 char * buf;
741
742 /*
743 * Always re-initialize the disk structure. We want statistics
744 * to start with a clean slate.
745 */
746 bzero(&xd->sc_dk, sizeof(xd->sc_dk));
747
748 /* if booting, init the xd_softc */
749
750 if (xa->booting) {
751 xd->state = XD_DRIVE_UNKNOWN; /* to start */
752 xd->flags = 0;
753 xd->parent = xdc;
754 }
755 xd->xd_drive = xa->driveno;
756 fmode = xa->fullmode;
757 xdc->sc_drives[xa->driveno] = xd;
758
759 /* if not booting, make sure we are the only process in the attach for
760 * this drive. if locked out, sleep on it. */
761
762 if (!xa->booting) {
763 s = splbio();
764 while (xd->state == XD_DRIVE_ATTACHING) {
765 if (tsleep(&xd->state, PRIBIO, "xdattach", 0)) {
766 splx(s);
767 return;
768 }
769 }
770 printf("%s at %s",
771 device_xname(&xd->sc_dev), device_xname(&xd->parent->sc_dev));
772 }
773
774 /* we now have control */
775 xd->state = XD_DRIVE_ATTACHING;
776 newstate = XD_DRIVE_UNKNOWN;
777
778 buf = NULL;
779 if ((error = xd_dmamem_alloc(xdc->dmatag, xdc->auxmap, &seg, &rseg,
780 XDFM_BPS,
781 (void **)&buf,
782 &busaddr)) != 0) {
783 aprint_error_dev(&xdc->sc_dev, "DMA buffer alloc error %d\n",
784 error);
785 return;
786 }
787 dmaddr = (void *)(u_long)BUS_ADDR_PADDR(busaddr);
788
789 /* first try and reset the drive */
790
791 rqno = xdc_cmd(xdc, XDCMD_RST, 0, xd->xd_drive, 0, 0, 0, fmode);
792 XDC_DONE(xdc, rqno, error);
793 if (error == XD_ERR_NRDY) {
794 printf(" drive %d: off-line\n", xa->driveno);
795 goto done;
796 }
797 if (error) {
798 printf(": ERROR 0x%02x (%s)\n", error, xdc_e2str(error));
799 goto done;
800 }
801 printf(" drive %d: ready\n", xa->driveno);
802
803 /* now set format parameters */
804
805 rqno = xdc_cmd(xdc, XDCMD_WRP, XDFUN_FMT, xd->xd_drive, 0, 0, 0, fmode);
806 XDC_DONE(xdc, rqno, error);
807 if (error) {
808 aprint_error_dev(&xd->sc_dev, "write format parameters failed: %s\n",
809 xdc_e2str(error));
810 goto done;
811 }
812
813 /* get drive parameters */
814 rqno = xdc_cmd(xdc, XDCMD_RDP, XDFUN_DRV, xd->xd_drive, 0, 0, 0, fmode);
815 if (rqno != XD_ERR_FAIL) {
816 driopb = (struct xd_iopb_drive *) &xdc->iopbase[rqno];
817 spt = driopb->sectpertrk;
818 }
819 XDC_DONE(xdc, rqno, error);
820 if (error) {
821 aprint_error_dev(&xd->sc_dev, "read drive parameters failed: %s\n",
822 xdc_e2str(error));
823 goto done;
824 }
825
826 /*
827 * now set drive parameters (to semi-bogus values) so we can read the
828 * disk label.
829 */
830 xd->pcyl = xd->ncyl = 1;
831 xd->acyl = 0;
832 xd->nhead = 1;
833 xd->nsect = 1;
834 xd->sectpercyl = 1;
835 for (lcv = 0; lcv < 126; lcv++) /* init empty bad144 table */
836 xd->dkb.bt_bad[lcv].bt_cyl = xd->dkb.bt_bad[lcv].bt_trksec = 0xffff;
837 rqno = xdc_cmd(xdc, XDCMD_WRP, XDFUN_DRV, xd->xd_drive, 0, 0, 0, fmode);
838 XDC_DONE(xdc, rqno, error);
839 if (error) {
840 aprint_error_dev(&xd->sc_dev, "write drive parameters failed: %s\n",
841 xdc_e2str(error));
842 goto done;
843 }
844
845 /* read disk label */
846 rqno = xdc_cmd(xdc, XDCMD_RD, 0, xd->xd_drive, 0, 1, dmaddr, fmode);
847 XDC_DONE(xdc, rqno, error);
848 if (error) {
849 aprint_error_dev(&xd->sc_dev, "reading disk label failed: %s\n",
850 xdc_e2str(error));
851 goto done;
852 }
853 newstate = XD_DRIVE_NOLABEL;
854
855 xd->hw_spt = spt;
856 /* Attach the disk: must be before getdisklabel to malloc label */
857 disk_init(&xd->sc_dk, device_xname(&xd->sc_dev), &xddkdriver);
858 disk_attach(&xd->sc_dk);
859
860 if (xdgetdisklabel(xd, buf) != XD_ERR_AOK)
861 goto done;
862
863 /* inform the user of what is up */
864 printf("%s: <%s>, pcyl %d, hw_spt %d\n", device_xname(&xd->sc_dev),
865 buf, xd->pcyl, spt);
866 mb = xd->ncyl * (xd->nhead * xd->nsect) / (1048576 / XDFM_BPS);
867 printf("%s: %dMB, %d cyl, %d head, %d sec, %d bytes/sec\n",
868 device_xname(&xd->sc_dev), mb, xd->ncyl, xd->nhead, xd->nsect,
869 XDFM_BPS);
870
871 /* now set the real drive parameters! */
872
873 rqno = xdc_cmd(xdc, XDCMD_WRP, XDFUN_DRV, xd->xd_drive, 0, 0, 0, fmode);
874 XDC_DONE(xdc, rqno, error);
875 if (error) {
876 aprint_error_dev(&xd->sc_dev, "write real drive parameters failed: %s\n",
877 xdc_e2str(error));
878 goto done;
879 }
880 newstate = XD_DRIVE_ONLINE;
881
882 /*
883 * read bad144 table. this table resides on the first sector of the
884 * last track of the disk (i.e. second cyl of "acyl" area).
885 */
886
887 blk = (xd->ncyl + xd->acyl - 1) * (xd->nhead * xd->nsect) + /* last cyl */
888 (xd->nhead - 1) * xd->nsect; /* last head */
889 rqno = xdc_cmd(xdc, XDCMD_RD, 0, xd->xd_drive, blk, 1, dmaddr, fmode);
890 XDC_DONE(xdc, rqno, error);
891 if (error) {
892 aprint_error_dev(&xd->sc_dev, "reading bad144 failed: %s\n",
893 xdc_e2str(error));
894 goto done;
895 }
896
897 /* check dkbad for sanity */
898 dkb = (struct dkbad *) buf;
899 for (lcv = 0; lcv < 126; lcv++) {
900 if ((dkb->bt_bad[lcv].bt_cyl == 0xffff ||
901 dkb->bt_bad[lcv].bt_cyl == 0) &&
902 dkb->bt_bad[lcv].bt_trksec == 0xffff)
903 continue; /* blank */
904 if (dkb->bt_bad[lcv].bt_cyl >= xd->ncyl)
905 break;
906 if ((dkb->bt_bad[lcv].bt_trksec >> 8) >= xd->nhead)
907 break;
908 if ((dkb->bt_bad[lcv].bt_trksec & 0xff) >= xd->nsect)
909 break;
910 }
911 if (lcv != 126) {
912 aprint_error_dev(&xd->sc_dev, "warning: invalid bad144 sector!\n");
913 } else {
914 bcopy(buf, &xd->dkb, XDFM_BPS);
915 }
916
917 done:
918 if (buf != NULL) {
919 xd_dmamem_free(xdc->dmatag, xdc->auxmap,
920 &seg, rseg, XDFM_BPS, buf);
921 }
922
923 xd->state = newstate;
924 if (!xa->booting) {
925 wakeup(&xd->state);
926 splx(s);
927 }
928 }
929
930 /*
931 * end of autoconfig functions
932 */
933
934 /*
935 * { b , c } d e v s w f u n c t i o n s
936 */
937
938 /*
939 * xdclose: close device
940 */
941 int
942 xdclose(dev, flag, fmt, l)
943 dev_t dev;
944 int flag, fmt;
945 struct lwp *l;
946 {
947 struct xd_softc *xd = xd_cd.cd_devs[DISKUNIT(dev)];
948 int part = DISKPART(dev);
949
950 /* clear mask bits */
951
952 switch (fmt) {
953 case S_IFCHR:
954 xd->sc_dk.dk_copenmask &= ~(1 << part);
955 break;
956 case S_IFBLK:
957 xd->sc_dk.dk_bopenmask &= ~(1 << part);
958 break;
959 }
960 xd->sc_dk.dk_openmask = xd->sc_dk.dk_copenmask | xd->sc_dk.dk_bopenmask;
961
962 return 0;
963 }
964
965 /*
966 * xddump: crash dump system
967 */
968 int
969 xddump(dev, blkno, va, size)
970 dev_t dev;
971 daddr_t blkno;
972 void *va;
973 size_t size;
974 {
975 int unit, part;
976 struct xd_softc *xd;
977
978 unit = DISKUNIT(dev);
979 if (unit >= xd_cd.cd_ndevs)
980 return ENXIO;
981 part = DISKPART(dev);
982
983 xd = xd_cd.cd_devs[unit];
984
985 printf("%s%c: crash dump not supported (yet)\n", device_xname(&xd->sc_dev),
986 'a' + part);
987
988 return ENXIO;
989
990 /* outline: globals: "dumplo" == sector number of partition to start
991 * dump at (convert to physical sector with partition table)
992 * "dumpsize" == size of dump in clicks "physmem" == size of physical
993 * memory (clicks, ctob() to get bytes) (normal case: dumpsize ==
994 * physmem)
995 *
996 * dump a copy of physical memory to the dump device starting at sector
997 * "dumplo" in the swap partition (make sure > 0). map in pages as
998 * we go. use polled I/O.
999 *
1000 * XXX how to handle NON_CONTIG? */
1001
1002 }
1003
1004 static enum kauth_device_req
1005 xd_getkauthreq(u_char cmd)
1006 {
1007 enum kauth_device_req req;
1008
1009 switch (cmd) {
1010 case XDCMD_WR:
1011 case XDCMD_XWR:
1012 req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_WRITE;
1013 break;
1014
1015 case XDCMD_RD:
1016 req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_READ;
1017 break;
1018
1019 case XDCMD_RDP:
1020 case XDCMD_XRD:
1021 req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_READCONF;
1022 break;
1023
1024 case XDCMD_WRP:
1025 case XDCMD_RST:
1026 req = KAUTH_REQ_DEVICE_RAWIO_PASSTHRU_WRITECONF;
1027 break;
1028
1029 case XDCMD_NOP:
1030 case XDCMD_SK:
1031 case XDCMD_TST:
1032 default:
1033 req = 0;
1034 break;
1035 }
1036
1037 return (req);
1038 }
1039
1040 /*
1041 * xdioctl: ioctls on XD drives. based on ioctl's of other netbsd disks.
1042 */
1043 int
1044 xdioctl(dev, command, addr, flag, l)
1045 dev_t dev;
1046 u_long command;
1047 void *addr;
1048 int flag;
1049 struct lwp *l;
1050
1051 {
1052 struct xd_softc *xd;
1053 struct xd_iocmd *xio;
1054 int error, s, unit;
1055 #ifdef __HAVE_OLD_DISKLABEL
1056 struct disklabel newlabel;
1057 #endif
1058 struct disklabel *lp;
1059
1060 unit = DISKUNIT(dev);
1061
1062 if (unit >= xd_cd.cd_ndevs || (xd = xd_cd.cd_devs[unit]) == NULL)
1063 return (ENXIO);
1064
1065 /* switch on ioctl type */
1066
1067 switch (command) {
1068 case DIOCSBAD: /* set bad144 info */
1069 if ((flag & FWRITE) == 0)
1070 return EBADF;
1071 s = splbio();
1072 bcopy(addr, &xd->dkb, sizeof(xd->dkb));
1073 splx(s);
1074 return 0;
1075
1076 case DIOCGDINFO: /* get disk label */
1077 bcopy(xd->sc_dk.dk_label, addr, sizeof(struct disklabel));
1078 return 0;
1079 #ifdef __HAVE_OLD_DISKLABEL
1080 case ODIOCGDINFO:
1081 newlabel = *(xd->sc_dk.dk_label);
1082 if (newlabel.d_npartitions > OLDMAXPARTITIONS)
1083 return ENOTTY;
1084 memcpy(addr, &newlabel, sizeof (struct olddisklabel));
1085 return 0;
1086 #endif
1087
1088 case DIOCGPART: /* get partition info */
1089 ((struct partinfo *) addr)->disklab = xd->sc_dk.dk_label;
1090 ((struct partinfo *) addr)->part =
1091 &xd->sc_dk.dk_label->d_partitions[DISKPART(dev)];
1092 return 0;
1093
1094 case DIOCSDINFO: /* set disk label */
1095 #ifdef __HAVE_OLD_DISKLABEL
1096 case ODIOCSDINFO:
1097 if (command == ODIOCSDINFO) {
1098 memset(&newlabel, 0, sizeof newlabel);
1099 memcpy(&newlabel, addr, sizeof (struct olddisklabel));
1100 lp = &newlabel;
1101 } else
1102 #endif
1103 lp = (struct disklabel *)addr;
1104
1105 if ((flag & FWRITE) == 0)
1106 return EBADF;
1107 error = setdisklabel(xd->sc_dk.dk_label,
1108 lp, /* xd->sc_dk.dk_openmask : */ 0,
1109 xd->sc_dk.dk_cpulabel);
1110 if (error == 0) {
1111 if (xd->state == XD_DRIVE_NOLABEL)
1112 xd->state = XD_DRIVE_ONLINE;
1113 }
1114 return error;
1115
1116 case DIOCWLABEL: /* change write status of disk label */
1117 if ((flag & FWRITE) == 0)
1118 return EBADF;
1119 if (*(int *) addr)
1120 xd->flags |= XD_WLABEL;
1121 else
1122 xd->flags &= ~XD_WLABEL;
1123 return 0;
1124
1125 case DIOCWDINFO: /* write disk label */
1126 #ifdef __HAVE_OLD_DISKLABEL
1127 case ODIOCWDINFO:
1128 if (command == ODIOCWDINFO) {
1129 memset(&newlabel, 0, sizeof newlabel);
1130 memcpy(&newlabel, addr, sizeof (struct olddisklabel));
1131 lp = &newlabel;
1132 } else
1133 #endif
1134 lp = (struct disklabel *)addr;
1135
1136 if ((flag & FWRITE) == 0)
1137 return EBADF;
1138 error = setdisklabel(xd->sc_dk.dk_label,
1139 lp, /* xd->sc_dk.dk_openmask : */ 0,
1140 xd->sc_dk.dk_cpulabel);
1141 if (error == 0) {
1142 if (xd->state == XD_DRIVE_NOLABEL)
1143 xd->state = XD_DRIVE_ONLINE;
1144
1145 /* Simulate opening partition 0 so write succeeds. */
1146 xd->sc_dk.dk_openmask |= (1 << 0);
1147 error = writedisklabel(MAKEDISKDEV(major(dev),
1148 DISKUNIT(dev), RAW_PART),
1149 xdstrategy, xd->sc_dk.dk_label,
1150 xd->sc_dk.dk_cpulabel);
1151 xd->sc_dk.dk_openmask =
1152 xd->sc_dk.dk_copenmask | xd->sc_dk.dk_bopenmask;
1153 }
1154 return error;
1155
1156 case DIOSXDCMD: {
1157 enum kauth_device_req req;
1158
1159 xio = (struct xd_iocmd *) addr;
1160 req = xd_getkauthreq(xio->cmd);
1161 if ((error = kauth_authorize_device_passthru(l->l_cred,
1162 dev, req, xio)) != 0)
1163 return (error);
1164 return (xdc_ioctlcmd(xd, dev, xio));
1165 }
1166
1167 default:
1168 return ENOTTY;
1169 }
1170 }
1171 /*
1172 * xdopen: open drive
1173 */
1174
1175 int
1176 xdopen(dev, flag, fmt, l)
1177 dev_t dev;
1178 int flag, fmt;
1179 struct lwp *l;
1180 {
1181 int unit, part;
1182 struct xd_softc *xd;
1183 struct xdc_attach_args xa;
1184
1185 /* first, could it be a valid target? */
1186
1187 unit = DISKUNIT(dev);
1188 if (unit >= xd_cd.cd_ndevs || (xd = xd_cd.cd_devs[unit]) == NULL)
1189 return (ENXIO);
1190 part = DISKPART(dev);
1191
1192 /* do we need to attach the drive? */
1193
1194 if (xd->state == XD_DRIVE_UNKNOWN) {
1195 xa.driveno = xd->xd_drive;
1196 xa.fullmode = XD_SUB_WAIT;
1197 xa.booting = 0;
1198 xdattach((struct device *) xd->parent, (struct device *) xd, &xa);
1199 if (xd->state == XD_DRIVE_UNKNOWN) {
1200 return (EIO);
1201 }
1202 }
1203 /* check for partition */
1204
1205 if (part != RAW_PART &&
1206 (part >= xd->sc_dk.dk_label->d_npartitions ||
1207 xd->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
1208 return (ENXIO);
1209 }
1210 /* set open masks */
1211
1212 switch (fmt) {
1213 case S_IFCHR:
1214 xd->sc_dk.dk_copenmask |= (1 << part);
1215 break;
1216 case S_IFBLK:
1217 xd->sc_dk.dk_bopenmask |= (1 << part);
1218 break;
1219 }
1220 xd->sc_dk.dk_openmask = xd->sc_dk.dk_copenmask | xd->sc_dk.dk_bopenmask;
1221
1222 return 0;
1223 }
1224
1225 int
1226 xdread(dev, uio, flags)
1227 dev_t dev;
1228 struct uio *uio;
1229 int flags;
1230 {
1231
1232 return (physio(xdstrategy, NULL, dev, B_READ, minphys, uio));
1233 }
1234
1235 int
1236 xdwrite(dev, uio, flags)
1237 dev_t dev;
1238 struct uio *uio;
1239 int flags;
1240 {
1241
1242 return (physio(xdstrategy, NULL, dev, B_WRITE, minphys, uio));
1243 }
1244
1245
1246 /*
1247 * xdsize: return size of a partition for a dump
1248 */
1249
1250 int
1251 xdsize(dev)
1252 dev_t dev;
1253
1254 {
1255 struct xd_softc *xdsc;
1256 int unit, part, size, omask;
1257
1258 /* valid unit? */
1259 unit = DISKUNIT(dev);
1260 if (unit >= xd_cd.cd_ndevs || (xdsc = xd_cd.cd_devs[unit]) == NULL)
1261 return (-1);
1262
1263 part = DISKPART(dev);
1264 omask = xdsc->sc_dk.dk_openmask & (1 << part);
1265
1266 if (omask == 0 && xdopen(dev, 0, S_IFBLK, NULL) != 0)
1267 return (-1);
1268
1269 /* do it */
1270 if (xdsc->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
1271 size = -1; /* only give valid size for swap partitions */
1272 else
1273 size = xdsc->sc_dk.dk_label->d_partitions[part].p_size *
1274 (xdsc->sc_dk.dk_label->d_secsize / DEV_BSIZE);
1275 if (omask == 0 && xdclose(dev, 0, S_IFBLK, NULL) != 0)
1276 return (-1);
1277 return (size);
1278 }
1279 /*
1280 * xdstrategy: buffering system interface to xd.
1281 */
1282
1283 void
1284 xdstrategy(bp)
1285 struct buf *bp;
1286
1287 {
1288 struct xd_softc *xd;
1289 struct xdc_softc *parent;
1290 int s, unit;
1291 struct xdc_attach_args xa;
1292
1293 unit = DISKUNIT(bp->b_dev);
1294
1295 /* check for live device */
1296
1297 if (unit >= xd_cd.cd_ndevs || (xd = xd_cd.cd_devs[unit]) == 0 ||
1298 bp->b_blkno < 0 ||
1299 (bp->b_bcount % xd->sc_dk.dk_label->d_secsize) != 0) {
1300 bp->b_error = EINVAL;
1301 goto done;
1302 }
1303 /* do we need to attach the drive? */
1304
1305 if (xd->state == XD_DRIVE_UNKNOWN) {
1306 xa.driveno = xd->xd_drive;
1307 xa.fullmode = XD_SUB_WAIT;
1308 xa.booting = 0;
1309 xdattach((struct device *)xd->parent, (struct device *)xd, &xa);
1310 if (xd->state == XD_DRIVE_UNKNOWN) {
1311 bp->b_error = EIO;
1312 goto done;
1313 }
1314 }
1315 if (xd->state != XD_DRIVE_ONLINE && DISKPART(bp->b_dev) != RAW_PART) {
1316 /* no I/O to unlabeled disks, unless raw partition */
1317 bp->b_error = EIO;
1318 goto done;
1319 }
1320 /* short circuit zero length request */
1321
1322 if (bp->b_bcount == 0)
1323 goto done;
1324
1325 /* check bounds with label (disksubr.c). Determine the size of the
1326 * transfer, and make sure it is within the boundaries of the
1327 * partition. Adjust transfer if needed, and signal errors or early
1328 * completion. */
1329
1330 if (bounds_check_with_label(&xd->sc_dk, bp,
1331 (xd->flags & XD_WLABEL) != 0) <= 0)
1332 goto done;
1333
1334 /*
1335 * now we know we have a valid buf structure that we need to do I/O
1336 * on.
1337 *
1338 * note that we don't disksort because the controller has a sorting
1339 * algorithm built into the hardware.
1340 */
1341
1342 s = splbio(); /* protect the queues */
1343
1344 /* first, give jobs in front of us a chance */
1345 parent = xd->parent;
1346 while (parent->nfree > 0 && BUFQ_PEEK(parent->sc_wq) != NULL)
1347 if (xdc_startbuf(parent, NULL, NULL) != XD_ERR_AOK)
1348 break;
1349
1350 /* if there are no free iorq's, then we just queue and return. the
1351 * buffs will get picked up later by xdcintr().
1352 */
1353
1354 if (parent->nfree == 0) {
1355 BUFQ_PUT(parent->sc_wq, bp);
1356 splx(s);
1357 return;
1358 }
1359
1360 /* now we have free iopb's and we are at splbio... start 'em up */
1361 if (xdc_startbuf(parent, xd, bp) != XD_ERR_AOK) {
1362 return;
1363 }
1364
1365 /* done! */
1366
1367 splx(s);
1368 return;
1369
1370 done: /* tells upper layers we are done with this
1371 * buf */
1372 bp->b_resid = bp->b_bcount;
1373 biodone(bp);
1374 }
1375 /*
1376 * end of {b,c}devsw functions
1377 */
1378
1379 /*
1380 * i n t e r r u p t f u n c t i o n
1381 *
1382 * xdcintr: hardware interrupt.
1383 */
1384 int
1385 xdcintr(v)
1386 void *v;
1387
1388 {
1389 struct xdc_softc *xdcsc = v;
1390
1391 /* kick the event counter */
1392
1393 xdcsc->sc_intrcnt.ev_count++;
1394
1395 /* remove as many done IOPBs as possible */
1396
1397 xdc_remove_iorq(xdcsc);
1398
1399 /* start any iorq's already waiting */
1400
1401 xdc_start(xdcsc, XDC_MAXIOPB);
1402
1403 /* fill up any remaining iorq's with queue'd buffers */
1404
1405 while (xdcsc->nfree > 0 && BUFQ_PEEK(xdcsc->sc_wq) != NULL)
1406 if (xdc_startbuf(xdcsc, NULL, NULL) != XD_ERR_AOK)
1407 break;
1408
1409 return (1);
1410 }
1411 /*
1412 * end of interrupt function
1413 */
1414
1415 /*
1416 * i n t e r n a l f u n c t i o n s
1417 */
1418
1419 /*
1420 * xdc_rqinit: fill out the fields of an I/O request
1421 */
1422
1423 inline void
1424 xdc_rqinit(rq, xdc, xd, md, blk, cnt, db, bp)
1425 struct xd_iorq *rq;
1426 struct xdc_softc *xdc;
1427 struct xd_softc *xd;
1428 int md;
1429 u_long blk;
1430 int cnt;
1431 void *db;
1432 struct buf *bp;
1433 {
1434 rq->xdc = xdc;
1435 rq->xd = xd;
1436 rq->ttl = XDC_MAXTTL + 10;
1437 rq->mode = md;
1438 rq->tries = rq->errnum = rq->lasterror = 0;
1439 rq->blockno = blk;
1440 rq->sectcnt = cnt;
1441 rq->dbuf = db;
1442 rq->buf = bp;
1443 }
1444 /*
1445 * xdc_rqtopb: load up an IOPB based on an iorq
1446 */
1447
1448 void
1449 xdc_rqtopb(iorq, iopb, cmd, subfun)
1450 struct xd_iorq *iorq;
1451 struct xd_iopb *iopb;
1452 int cmd, subfun;
1453
1454 {
1455 u_long block, dp;
1456
1457 /* standard stuff */
1458
1459 iopb->errs = iopb->done = 0;
1460 iopb->comm = cmd;
1461 iopb->errnum = iopb->status = 0;
1462 iopb->subfun = subfun;
1463 if (iorq->xd)
1464 iopb->unit = iorq->xd->xd_drive;
1465 else
1466 iopb->unit = 0;
1467
1468 /* check for alternate IOPB format */
1469
1470 if (cmd == XDCMD_WRP) {
1471 switch (subfun) {
1472 case XDFUN_CTL:{
1473 struct xd_iopb_ctrl *ctrl =
1474 (struct xd_iopb_ctrl *) iopb;
1475 iopb->lll = 0;
1476 iopb->intl = (XD_STATE(iorq->mode) == XD_SUB_POLL)
1477 ? 0
1478 : iorq->xdc->ipl;
1479 ctrl->param_a = XDPA_TMOD | XDPA_DACF;
1480 ctrl->param_b = XDPB_ROR | XDPB_TDT_3_2USEC;
1481 ctrl->param_c = XDPC_OVS | XDPC_COP | XDPC_ASR |
1482 XDPC_RBC | XDPC_ECC2;
1483 ctrl->throttle = XDC_THROTTLE;
1484 ctrl->delay = XDC_DELAY;
1485 break;
1486 }
1487 case XDFUN_DRV:{
1488 struct xd_iopb_drive *drv =
1489 (struct xd_iopb_drive *)iopb;
1490 /* we assume that the disk label has the right
1491 * info */
1492 if (XD_STATE(iorq->mode) == XD_SUB_POLL)
1493 drv->dparam_ipl = (XDC_DPARAM << 3);
1494 else
1495 drv->dparam_ipl = (XDC_DPARAM << 3) |
1496 iorq->xdc->ipl;
1497 drv->maxsect = iorq->xd->nsect - 1;
1498 drv->maxsector = drv->maxsect;
1499 /* note: maxsector != maxsect only if you are
1500 * doing cyl sparing */
1501 drv->headoff = 0;
1502 drv->maxcyl = iorq->xd->pcyl - 1;
1503 drv->maxhead = iorq->xd->nhead - 1;
1504 break;
1505 }
1506 case XDFUN_FMT:{
1507 struct xd_iopb_format *form =
1508 (struct xd_iopb_format *) iopb;
1509 if (XD_STATE(iorq->mode) == XD_SUB_POLL)
1510 form->interleave_ipl = (XDC_INTERLEAVE << 3);
1511 else
1512 form->interleave_ipl = (XDC_INTERLEAVE << 3) |
1513 iorq->xdc->ipl;
1514 form->field1 = XDFM_FIELD1;
1515 form->field2 = XDFM_FIELD2;
1516 form->field3 = XDFM_FIELD3;
1517 form->field4 = XDFM_FIELD4;
1518 form->bytespersec = XDFM_BPS;
1519 form->field6 = XDFM_FIELD6;
1520 form->field7 = XDFM_FIELD7;
1521 break;
1522 }
1523 }
1524 } else {
1525
1526 /* normal IOPB case (harmless to RDP command) */
1527
1528 iopb->lll = 0;
1529 iopb->intl = (XD_STATE(iorq->mode) == XD_SUB_POLL)
1530 ? 0
1531 : iorq->xdc->ipl;
1532 iopb->sectcnt = iorq->sectcnt;
1533 block = iorq->blockno;
1534 if (iorq->xd == NULL || block == 0) {
1535 iopb->sectno = iopb->headno = iopb->cylno = 0;
1536 } else {
1537 iopb->sectno = block % iorq->xd->nsect;
1538 block = block / iorq->xd->nsect;
1539 iopb->headno = block % iorq->xd->nhead;
1540 block = block / iorq->xd->nhead;
1541 iopb->cylno = block;
1542 }
1543 dp = (u_long) iorq->dbuf;
1544 dp = iopb->daddr = (iorq->dbuf == NULL) ? 0 : dp;
1545 iopb->addrmod = ((dp + (XDFM_BPS * iorq->sectcnt)) > 0x1000000)
1546 ? XDC_ADDRMOD32
1547 : XDC_ADDRMOD;
1548 }
1549 }
1550
1551 /*
1552 * xdc_cmd: front end for POLL'd and WAIT'd commands. Returns rqno.
1553 * If you've already got an IORQ, you can call submit directly (currently
1554 * there is no need to do this). NORM requests are handled separately.
1555 */
1556 int
1557 xdc_cmd(xdcsc, cmd, subfn, unit, block, scnt, dptr, fullmode)
1558 struct xdc_softc *xdcsc;
1559 int cmd, subfn, unit, block, scnt;
1560 char *dptr;
1561 int fullmode;
1562
1563 {
1564 int rqno, submode = XD_STATE(fullmode), retry;
1565 struct xd_iorq *iorq;
1566 struct xd_iopb *iopb;
1567
1568 /* get iorq/iopb */
1569 switch (submode) {
1570 case XD_SUB_POLL:
1571 while (xdcsc->nfree == 0) {
1572 if (xdc_piodriver(xdcsc, 0, 1) != XD_ERR_AOK)
1573 return (XD_ERR_FAIL);
1574 }
1575 break;
1576 case XD_SUB_WAIT:
1577 retry = 1;
1578 while (retry) {
1579 while (xdcsc->nfree == 0) {
1580 if (tsleep(&xdcsc->nfree, PRIBIO, "xdnfree", 0))
1581 return (XD_ERR_FAIL);
1582 }
1583 while (xdcsc->ndone > XDC_SUBWAITLIM) {
1584 if (tsleep(&xdcsc->ndone, PRIBIO, "xdsubwait", 0))
1585 return (XD_ERR_FAIL);
1586 }
1587 if (xdcsc->nfree)
1588 retry = 0; /* got it */
1589 }
1590 break;
1591 default:
1592 return (XD_ERR_FAIL); /* illegal */
1593 }
1594 if (xdcsc->nfree == 0)
1595 panic("xdcmd nfree");
1596 rqno = XDC_RQALLOC(xdcsc);
1597 iorq = &xdcsc->reqs[rqno];
1598 iopb = iorq->iopb;
1599
1600
1601 /* init iorq/iopb */
1602
1603 xdc_rqinit(iorq, xdcsc,
1604 (unit == XDC_NOUNIT) ? NULL : xdcsc->sc_drives[unit],
1605 fullmode, block, scnt, dptr, NULL);
1606
1607 /* load IOPB from iorq */
1608
1609 xdc_rqtopb(iorq, iopb, cmd, subfn);
1610
1611 /* submit it for processing */
1612
1613 xdc_submit_iorq(xdcsc, rqno, fullmode); /* error code will be in iorq */
1614
1615 return (rqno);
1616 }
1617 /*
1618 * xdc_startbuf
1619 * start a buffer running, assumes nfree > 0
1620 */
1621
1622 int
1623 xdc_startbuf(xdcsc, xdsc, bp)
1624 struct xdc_softc *xdcsc;
1625 struct xd_softc *xdsc;
1626 struct buf *bp;
1627
1628 {
1629 int rqno, partno;
1630 struct xd_iorq *iorq;
1631 struct xd_iopb *iopb;
1632 u_long block;
1633 /* void *dbuf;*/
1634 int error;
1635
1636 if (!xdcsc->nfree)
1637 panic("xdc_startbuf free");
1638 rqno = XDC_RQALLOC(xdcsc);
1639 iorq = &xdcsc->reqs[rqno];
1640 iopb = iorq->iopb;
1641
1642 /* get buf */
1643
1644 if (bp == NULL) {
1645 bp = BUFQ_GET(xdcsc->sc_wq);
1646 if (bp == NULL)
1647 panic("xdc_startbuf bp");
1648 xdsc = xdcsc->sc_drives[DISKUNIT(bp->b_dev)];
1649 }
1650 partno = DISKPART(bp->b_dev);
1651 #ifdef XDC_DEBUG
1652 printf("xdc_startbuf: %s%c: %s block %d\n", device_xname(&xdsc->sc_dev),
1653 'a' + partno, (bp->b_flags & B_READ) ? "read" : "write", bp->b_blkno);
1654 printf("xdc_startbuf: b_bcount %d, b_data 0x%x\n",
1655 bp->b_bcount, bp->b_data);
1656 #endif
1657
1658 /*
1659 * load request. we have to calculate the correct block number based
1660 * on partition info.
1661 *
1662 * note that iorq points to the buffer as mapped into DVMA space,
1663 * where as the bp->b_data points to its non-DVMA mapping.
1664 */
1665
1666 block = bp->b_blkno + ((partno == RAW_PART) ? 0 :
1667 xdsc->sc_dk.dk_label->d_partitions[partno].p_offset);
1668
1669 error = bus_dmamap_load(xdcsc->dmatag, iorq->dmamap,
1670 bp->b_data, bp->b_bcount, 0, BUS_DMA_NOWAIT);
1671 if (error != 0) {
1672 aprint_error_dev(&xdcsc->sc_dev, "warning: cannot load DMA map\n");
1673 XDC_FREE(xdcsc, rqno);
1674 BUFQ_PUT(xdcsc->sc_wq, bp);
1675 return (XD_ERR_FAIL); /* XXX: need some sort of
1676 * call-back scheme here? */
1677 }
1678 bus_dmamap_sync(xdcsc->dmatag, iorq->dmamap, 0,
1679 iorq->dmamap->dm_mapsize, (bp->b_flags & B_READ)
1680 ? BUS_DMASYNC_PREREAD
1681 : BUS_DMASYNC_PREWRITE);
1682
1683 /* init iorq and load iopb from it */
1684 xdc_rqinit(iorq, xdcsc, xdsc, XD_SUB_NORM | XD_MODE_VERBO, block,
1685 bp->b_bcount / XDFM_BPS,
1686 (void *)(u_long)iorq->dmamap->dm_segs[0].ds_addr,
1687 bp);
1688
1689 xdc_rqtopb(iorq, iopb, (bp->b_flags & B_READ) ? XDCMD_RD : XDCMD_WR, 0);
1690
1691 /* Instrumentation. */
1692 disk_busy(&xdsc->sc_dk);
1693
1694 /* now submit [note that xdc_submit_iorq can never fail on NORM reqs] */
1695
1696 xdc_submit_iorq(xdcsc, rqno, XD_SUB_NORM);
1697 return (XD_ERR_AOK);
1698 }
1699
1700
1701 /*
1702 * xdc_submit_iorq: submit an iorq for processing. returns XD_ERR_AOK
1703 * if ok. if it fail returns an error code. type is XD_SUB_*.
1704 *
1705 * note: caller frees iorq in all cases except NORM
1706 *
1707 * return value:
1708 * NORM: XD_AOK (req pending), XD_FAIL (couldn't submit request)
1709 * WAIT: XD_AOK (success), <error-code> (failed)
1710 * POLL: <same as WAIT>
1711 * NOQ : <same as NORM>
1712 *
1713 * there are three sources for i/o requests:
1714 * [1] xdstrategy: normal block I/O, using "struct buf" system.
1715 * [2] autoconfig/crash dump: these are polled I/O requests, no interrupts.
1716 * [3] open/ioctl: these are I/O requests done in the context of a process,
1717 * and the process should block until they are done.
1718 *
1719 * software state is stored in the iorq structure. each iorq has an
1720 * iopb structure. the hardware understands the iopb structure.
1721 * every command must go through an iopb. a 7053 can only handle
1722 * XDC_MAXIOPB (31) active iopbs at one time. iopbs are allocated in
1723 * DVMA space at boot up time. what happens if we run out of iopb's?
1724 * for i/o type [1], the buffers are queued at the "buff" layer and
1725 * picked up later by the interrupt routine. for case [2] the
1726 * programmed i/o driver is called with a special flag that says
1727 * return when one iopb is free. for case [3] the process can sleep
1728 * on the iorq free list until some iopbs are available.
1729 */
1730
1731
1732 int
1733 xdc_submit_iorq(xdcsc, iorqno, type)
1734 struct xdc_softc *xdcsc;
1735 int iorqno;
1736 int type;
1737
1738 {
1739 u_long iopbaddr;
1740 struct xd_iorq *iorq = &xdcsc->reqs[iorqno];
1741
1742 #ifdef XDC_DEBUG
1743 printf("xdc_submit_iorq(%s, no=%d, type=%d)\n", device_xname(&xdcsc->sc_dev),
1744 iorqno, type);
1745 #endif
1746
1747 /* first check and see if controller is busy */
1748 if (xdcsc->xdc->xdc_csr & XDC_ADDING) {
1749 #ifdef XDC_DEBUG
1750 printf("xdc_submit_iorq: XDC not ready (ADDING)\n");
1751 #endif
1752 if (type == XD_SUB_NOQ)
1753 return (XD_ERR_FAIL); /* failed */
1754 XDC_TWAIT(xdcsc, iorqno); /* put at end of waitq */
1755 switch (type) {
1756 case XD_SUB_NORM:
1757 return XD_ERR_AOK; /* success */
1758 case XD_SUB_WAIT:
1759 while (iorq->iopb->done == 0) {
1760 (void) tsleep(iorq, PRIBIO, "xdciorq", 0);
1761 }
1762 return (iorq->errnum);
1763 case XD_SUB_POLL:
1764 return (xdc_piodriver(xdcsc, iorqno, 0));
1765 default:
1766 panic("xdc_submit_iorq adding");
1767 }
1768 }
1769 #ifdef XDC_DEBUG
1770 {
1771 u_char *rio = (u_char *) iorq->iopb;
1772 int sz = sizeof(struct xd_iopb), lcv;
1773 printf("%s: aio #%d [",
1774 device_xname(&xdcsc->sc_dev), iorq - xdcsc->reqs);
1775 for (lcv = 0; lcv < sz; lcv++)
1776 printf(" %02x", rio[lcv]);
1777 printf("]\n");
1778 }
1779 #endif /* XDC_DEBUG */
1780
1781 /* controller not busy, start command */
1782 iopbaddr = (u_long) iorq->dmaiopb;
1783 XDC_GO(xdcsc->xdc, iopbaddr); /* go! */
1784 xdcsc->nrun++;
1785 /* command now running, wrap it up */
1786 switch (type) {
1787 case XD_SUB_NORM:
1788 case XD_SUB_NOQ:
1789 return (XD_ERR_AOK); /* success */
1790 case XD_SUB_WAIT:
1791 while (iorq->iopb->done == 0) {
1792 (void) tsleep(iorq, PRIBIO, "xdciorq", 0);
1793 }
1794 return (iorq->errnum);
1795 case XD_SUB_POLL:
1796 return (xdc_piodriver(xdcsc, iorqno, 0));
1797 default:
1798 panic("xdc_submit_iorq wrap up");
1799 }
1800 panic("xdc_submit_iorq");
1801 return 0; /* not reached */
1802 }
1803
1804
1805 /*
1806 * xdc_piodriver
1807 *
1808 * programmed i/o driver. this function takes over the computer
1809 * and drains off all i/o requests. it returns the status of the iorq
1810 * the caller is interesting in. if freeone is true, then it returns
1811 * when there is a free iorq.
1812 */
1813 int
1814 xdc_piodriver(xdcsc, iorqno, freeone)
1815 struct xdc_softc *xdcsc;
1816 int iorqno;
1817 int freeone;
1818
1819 {
1820 int nreset = 0;
1821 int retval = 0;
1822 u_long count;
1823 struct xdc *xdc = xdcsc->xdc;
1824 #ifdef XDC_DEBUG
1825 printf("xdc_piodriver(%s, %d, freeone=%d)\n", device_xname(&xdcsc->sc_dev),
1826 iorqno, freeone);
1827 #endif
1828
1829 while (xdcsc->nwait || xdcsc->nrun) {
1830 #ifdef XDC_DEBUG
1831 printf("xdc_piodriver: wait=%d, run=%d\n",
1832 xdcsc->nwait, xdcsc->nrun);
1833 #endif
1834 XDC_WAIT(xdc, count, XDC_MAXTIME, (XDC_REMIOPB | XDC_F_ERROR));
1835 #ifdef XDC_DEBUG
1836 printf("xdc_piodriver: done wait with count = %d\n", count);
1837 #endif
1838 /* we expect some progress soon */
1839 if (count == 0 && nreset >= 2) {
1840 xdc_reset(xdcsc, 0, XD_RSET_ALL, XD_ERR_FAIL, 0);
1841 #ifdef XDC_DEBUG
1842 printf("xdc_piodriver: timeout\n");
1843 #endif
1844 return (XD_ERR_FAIL);
1845 }
1846 if (count == 0) {
1847 if (xdc_reset(xdcsc, 0,
1848 (nreset++ == 0) ? XD_RSET_NONE : iorqno,
1849 XD_ERR_FAIL,
1850 0) == XD_ERR_FAIL)
1851 return (XD_ERR_FAIL); /* flushes all but POLL
1852 * requests, resets */
1853 continue;
1854 }
1855 xdc_remove_iorq(xdcsc); /* could resubmit request */
1856 if (freeone) {
1857 if (xdcsc->nrun < XDC_MAXIOPB) {
1858 #ifdef XDC_DEBUG
1859 printf("xdc_piodriver: done: one free\n");
1860 #endif
1861 return (XD_ERR_AOK);
1862 }
1863 continue; /* don't xdc_start */
1864 }
1865 xdc_start(xdcsc, XDC_MAXIOPB);
1866 }
1867
1868 /* get return value */
1869
1870 retval = xdcsc->reqs[iorqno].errnum;
1871
1872 #ifdef XDC_DEBUG
1873 printf("xdc_piodriver: done, retval = 0x%x (%s)\n",
1874 xdcsc->reqs[iorqno].errnum, xdc_e2str(xdcsc->reqs[iorqno].errnum));
1875 #endif
1876
1877 /* now that we've drained everything, start up any bufs that have
1878 * queued */
1879
1880 while (xdcsc->nfree > 0 && BUFQ_PEEK(xdcsc->sc_wq) != NULL)
1881 if (xdc_startbuf(xdcsc, NULL, NULL) != XD_ERR_AOK)
1882 break;
1883
1884 return (retval);
1885 }
1886
1887 /*
1888 * xdc_reset: reset one drive. NOTE: assumes xdc was just reset.
1889 * we steal iopb[0] for this, but we put it back when we are done.
1890 */
1891 void
1892 xdc_xdreset(xdcsc, xdsc)
1893 struct xdc_softc *xdcsc;
1894 struct xd_softc *xdsc;
1895
1896 {
1897 struct xd_iopb tmpiopb;
1898 u_long addr;
1899 int del;
1900 bcopy(xdcsc->iopbase, &tmpiopb, sizeof(tmpiopb));
1901 bzero(xdcsc->iopbase, sizeof(tmpiopb));
1902 xdcsc->iopbase->comm = XDCMD_RST;
1903 xdcsc->iopbase->unit = xdsc->xd_drive;
1904 addr = (u_long) xdcsc->dvmaiopb;
1905 XDC_GO(xdcsc->xdc, addr); /* go! */
1906 XDC_WAIT(xdcsc->xdc, del, XDC_RESETUSEC, XDC_REMIOPB);
1907 if (del <= 0 || xdcsc->iopbase->errs) {
1908 printf("%s: off-line: %s\n", device_xname(&xdcsc->sc_dev),
1909 xdc_e2str(xdcsc->iopbase->errnum));
1910 xdcsc->xdc->xdc_csr = XDC_RESET;
1911 XDC_WAIT(xdcsc->xdc, del, XDC_RESETUSEC, XDC_RESET);
1912 if (del <= 0)
1913 panic("xdc_reset");
1914 } else {
1915 xdcsc->xdc->xdc_csr = XDC_CLRRIO; /* clear RIO */
1916 }
1917 bcopy(&tmpiopb, xdcsc->iopbase, sizeof(tmpiopb));
1918 }
1919
1920
1921 /*
1922 * xdc_reset: reset everything: requests are marked as errors except
1923 * a polled request (which is resubmitted)
1924 */
1925 int
1926 xdc_reset(xdcsc, quiet, blastmode, error, xdsc)
1927 struct xdc_softc *xdcsc;
1928 int quiet, blastmode, error;
1929 struct xd_softc *xdsc;
1930
1931 {
1932 int del = 0, lcv, retval = XD_ERR_AOK;
1933 int oldfree = xdcsc->nfree;
1934
1935 /* soft reset hardware */
1936
1937 if (!quiet)
1938 printf("%s: soft reset\n", device_xname(&xdcsc->sc_dev));
1939 xdcsc->xdc->xdc_csr = XDC_RESET;
1940 XDC_WAIT(xdcsc->xdc, del, XDC_RESETUSEC, XDC_RESET);
1941 if (del <= 0) {
1942 blastmode = XD_RSET_ALL; /* dead, flush all requests */
1943 retval = XD_ERR_FAIL;
1944 }
1945 if (xdsc)
1946 xdc_xdreset(xdcsc, xdsc);
1947
1948 /* fix queues based on "blast-mode" */
1949
1950 for (lcv = 0; lcv < XDC_MAXIOPB; lcv++) {
1951 register struct xd_iorq *iorq = &xdcsc->reqs[lcv];
1952
1953 if (XD_STATE(iorq->mode) != XD_SUB_POLL &&
1954 XD_STATE(iorq->mode) != XD_SUB_WAIT &&
1955 XD_STATE(iorq->mode) != XD_SUB_NORM)
1956 /* is it active? */
1957 continue;
1958
1959 xdcsc->nrun--; /* it isn't running any more */
1960 if (blastmode == XD_RSET_ALL || blastmode != lcv) {
1961 /* failed */
1962 iorq->errnum = error;
1963 xdcsc->iopbase[lcv].done = xdcsc->iopbase[lcv].errs = 1;
1964 switch (XD_STATE(xdcsc->reqs[lcv].mode)) {
1965 case XD_SUB_NORM:
1966 iorq->buf->b_error = EIO;
1967 iorq->buf->b_resid =
1968 iorq->sectcnt * XDFM_BPS;
1969
1970 bus_dmamap_sync(xdcsc->dmatag, iorq->dmamap, 0,
1971 iorq->dmamap->dm_mapsize,
1972 (iorq->buf->b_flags & B_READ)
1973 ? BUS_DMASYNC_POSTREAD
1974 : BUS_DMASYNC_POSTWRITE);
1975
1976 bus_dmamap_unload(xdcsc->dmatag, iorq->dmamap);
1977
1978 disk_unbusy(&xdcsc->reqs[lcv].xd->sc_dk,
1979 (xdcsc->reqs[lcv].buf->b_bcount -
1980 xdcsc->reqs[lcv].buf->b_resid),
1981 (iorq->buf->b_flags & B_READ));
1982 biodone(iorq->buf);
1983 XDC_FREE(xdcsc, lcv); /* add to free list */
1984 break;
1985 case XD_SUB_WAIT:
1986 wakeup(iorq);
1987 case XD_SUB_POLL:
1988 xdcsc->ndone++;
1989 iorq->mode =
1990 XD_NEWSTATE(iorq->mode, XD_SUB_DONE);
1991 break;
1992 }
1993
1994 } else {
1995
1996 /* resubmit, put at front of wait queue */
1997 XDC_HWAIT(xdcsc, lcv);
1998 }
1999 }
2000
2001 /*
2002 * now, if stuff is waiting, start it.
2003 * since we just reset it should go
2004 */
2005 xdc_start(xdcsc, XDC_MAXIOPB);
2006
2007 /* ok, we did it */
2008 if (oldfree == 0 && xdcsc->nfree)
2009 wakeup(&xdcsc->nfree);
2010
2011 #ifdef XDC_DIAG
2012 del = xdcsc->nwait + xdcsc->nrun + xdcsc->nfree + xdcsc->ndone;
2013 if (del != XDC_MAXIOPB)
2014 printf("%s: diag: xdc_reset miscount (%d should be %d)!\n",
2015 device_xname(&xdcsc->sc_dev), del, XDC_MAXIOPB);
2016 else
2017 if (xdcsc->ndone > XDC_MAXIOPB - XDC_SUBWAITLIM)
2018 printf("%s: diag: lots of done jobs (%d)\n",
2019 device_xname(&xdcsc->sc_dev), xdcsc->ndone);
2020 #endif
2021 printf("RESET DONE\n");
2022 return (retval);
2023 }
2024 /*
2025 * xdc_start: start all waiting buffers
2026 */
2027
2028 void
2029 xdc_start(xdcsc, maxio)
2030 struct xdc_softc *xdcsc;
2031 int maxio;
2032
2033 {
2034 int rqno;
2035 while (maxio && xdcsc->nwait &&
2036 (xdcsc->xdc->xdc_csr & XDC_ADDING) == 0) {
2037 XDC_GET_WAITER(xdcsc, rqno); /* note: rqno is an "out"
2038 * param */
2039 if (xdc_submit_iorq(xdcsc, rqno, XD_SUB_NOQ) != XD_ERR_AOK)
2040 panic("xdc_start"); /* should never happen */
2041 maxio--;
2042 }
2043 }
2044 /*
2045 * xdc_remove_iorq: remove "done" IOPB's.
2046 */
2047
2048 int
2049 xdc_remove_iorq(xdcsc)
2050 struct xdc_softc *xdcsc;
2051
2052 {
2053 int errnum, rqno, comm, errs;
2054 struct xdc *xdc = xdcsc->xdc;
2055 struct xd_iopb *iopb;
2056 struct xd_iorq *iorq;
2057 struct buf *bp;
2058
2059 if (xdc->xdc_csr & XDC_F_ERROR) {
2060 /*
2061 * FATAL ERROR: should never happen under normal use. This
2062 * error is so bad, you can't even tell which IOPB is bad, so
2063 * we dump them all.
2064 */
2065 errnum = xdc->xdc_f_err;
2066 aprint_error_dev(&xdcsc->sc_dev, "fatal error 0x%02x: %s\n",
2067 errnum, xdc_e2str(errnum));
2068 if (xdc_reset(xdcsc, 0, XD_RSET_ALL, errnum, 0) != XD_ERR_AOK) {
2069 aprint_error_dev(&xdcsc->sc_dev, "soft reset failed!\n");
2070 panic("xdc_remove_iorq: controller DEAD");
2071 }
2072 return (XD_ERR_AOK);
2073 }
2074
2075 /*
2076 * get iopb that is done
2077 *
2078 * hmm... I used to read the address of the done IOPB off the VME
2079 * registers and calculate the rqno directly from that. that worked
2080 * until I started putting a load on the controller. when loaded, i
2081 * would get interrupts but neither the REMIOPB or F_ERROR bits would
2082 * be set, even after DELAY'ing a while! later on the timeout
2083 * routine would detect IOPBs that were marked "running" but their
2084 * "done" bit was set. rather than dealing directly with this
2085 * problem, it is just easier to look at all running IOPB's for the
2086 * done bit.
2087 */
2088 if (xdc->xdc_csr & XDC_REMIOPB) {
2089 xdc->xdc_csr = XDC_CLRRIO;
2090 }
2091
2092 for (rqno = 0; rqno < XDC_MAXIOPB; rqno++) {
2093 iorq = &xdcsc->reqs[rqno];
2094 if (iorq->mode == 0 || XD_STATE(iorq->mode) == XD_SUB_DONE)
2095 continue; /* free, or done */
2096 iopb = &xdcsc->iopbase[rqno];
2097 if (iopb->done == 0)
2098 continue; /* not done yet */
2099
2100 #ifdef XDC_DEBUG
2101 {
2102 u_char *rio = (u_char *) iopb;
2103 int sz = sizeof(struct xd_iopb), lcv;
2104 printf("%s: rio #%d [", device_xname(&xdcsc->sc_dev), rqno);
2105 for (lcv = 0; lcv < sz; lcv++)
2106 printf(" %02x", rio[lcv]);
2107 printf("]\n");
2108 }
2109 #endif /* XDC_DEBUG */
2110
2111 xdcsc->nrun--;
2112
2113 comm = iopb->comm;
2114 errs = iopb->errs;
2115
2116 if (errs)
2117 iorq->errnum = iopb->errnum;
2118 else
2119 iorq->errnum = 0;
2120
2121 /* handle non-fatal errors */
2122
2123 if (errs &&
2124 xdc_error(xdcsc, iorq, iopb, rqno, comm) == XD_ERR_AOK)
2125 continue; /* AOK: we resubmitted it */
2126
2127
2128 /* this iorq is now done (hasn't been restarted or anything) */
2129
2130 if ((iorq->mode & XD_MODE_VERBO) && iorq->lasterror)
2131 xdc_perror(iorq, iopb, 0);
2132
2133 /* now, if read/write check to make sure we got all the data
2134 * we needed. (this may not be the case if we got an error in
2135 * the middle of a multisector request). */
2136
2137 if ((iorq->mode & XD_MODE_B144) != 0 && errs == 0 &&
2138 (comm == XDCMD_RD || comm == XDCMD_WR)) {
2139 /* we just successfully processed a bad144 sector
2140 * note: if we are in bad 144 mode, the pointers have
2141 * been advanced already (see above) and are pointing
2142 * at the bad144 sector. to exit bad144 mode, we
2143 * must advance the pointers 1 sector and issue a new
2144 * request if there are still sectors left to process
2145 *
2146 */
2147 XDC_ADVANCE(iorq, 1); /* advance 1 sector */
2148
2149 /* exit b144 mode */
2150 iorq->mode = iorq->mode & (~XD_MODE_B144);
2151
2152 if (iorq->sectcnt) { /* more to go! */
2153 iorq->lasterror = iorq->errnum = iopb->errnum = 0;
2154 iopb->errs = iopb->done = 0;
2155 iorq->tries = 0;
2156 iopb->sectcnt = iorq->sectcnt;
2157 iopb->cylno = iorq->blockno /
2158 iorq->xd->sectpercyl;
2159 iopb->headno =
2160 (iorq->blockno / iorq->xd->nhead) %
2161 iorq->xd->nhead;
2162 iopb->sectno = iorq->blockno % XDFM_BPS;
2163 iopb->daddr = (u_long) iorq->dbuf;
2164 XDC_HWAIT(xdcsc, rqno);
2165 xdc_start(xdcsc, 1); /* resubmit */
2166 continue;
2167 }
2168 }
2169 /* final cleanup, totally done with this request */
2170
2171 switch (XD_STATE(iorq->mode)) {
2172 case XD_SUB_NORM:
2173 bp = iorq->buf;
2174 if (errs) {
2175 bp->b_error = EIO;
2176 bp->b_resid = iorq->sectcnt * XDFM_BPS;
2177 } else {
2178 bp->b_resid = 0; /* done */
2179 }
2180 bus_dmamap_sync(xdcsc->dmatag, iorq->dmamap, 0,
2181 iorq->dmamap->dm_mapsize,
2182 (bp->b_flags & B_READ)
2183 ? BUS_DMASYNC_POSTREAD
2184 : BUS_DMASYNC_POSTWRITE);
2185 bus_dmamap_unload(xdcsc->dmatag, iorq->dmamap);
2186
2187 disk_unbusy(&iorq->xd->sc_dk,
2188 (bp->b_bcount - bp->b_resid),
2189 (bp->b_flags & B_READ));
2190 XDC_FREE(xdcsc, rqno);
2191 biodone(bp);
2192 break;
2193 case XD_SUB_WAIT:
2194 iorq->mode = XD_NEWSTATE(iorq->mode, XD_SUB_DONE);
2195 xdcsc->ndone++;
2196 wakeup(iorq);
2197 break;
2198 case XD_SUB_POLL:
2199 iorq->mode = XD_NEWSTATE(iorq->mode, XD_SUB_DONE);
2200 xdcsc->ndone++;
2201 break;
2202 }
2203 }
2204
2205 return (XD_ERR_AOK);
2206 }
2207
2208 /*
2209 * xdc_perror: print error.
2210 * - if still_trying is true: we got an error, retried and got a
2211 * different error. in that case lasterror is the old error,
2212 * and errnum is the new one.
2213 * - if still_trying is not true, then if we ever had an error it
2214 * is in lasterror. also, if iorq->errnum == 0, then we recovered
2215 * from that error (otherwise iorq->errnum == iorq->lasterror).
2216 */
2217 void
2218 xdc_perror(iorq, iopb, still_trying)
2219 struct xd_iorq *iorq;
2220 struct xd_iopb *iopb;
2221 int still_trying;
2222
2223 {
2224
2225 int error = iorq->lasterror;
2226
2227 printf("%s", (iorq->xd) ? device_xname(&iorq->xd->sc_dev)
2228 : device_xname(&iorq->xdc->sc_dev));
2229 if (iorq->buf)
2230 printf("%c: ", 'a' + DISKPART(iorq->buf->b_dev));
2231 if (iopb->comm == XDCMD_RD || iopb->comm == XDCMD_WR)
2232 printf("%s %d/%d/%d: ",
2233 (iopb->comm == XDCMD_RD) ? "read" : "write",
2234 iopb->cylno, iopb->headno, iopb->sectno);
2235 printf("%s", xdc_e2str(error));
2236
2237 if (still_trying)
2238 printf(" [still trying, new error=%s]", xdc_e2str(iorq->errnum));
2239 else
2240 if (iorq->errnum == 0)
2241 printf(" [recovered in %d tries]", iorq->tries);
2242
2243 printf("\n");
2244 }
2245
2246 /*
2247 * xdc_error: non-fatal error encountered... recover.
2248 * return AOK if resubmitted, return FAIL if this iopb is done
2249 */
2250 int
2251 xdc_error(xdcsc, iorq, iopb, rqno, comm)
2252 struct xdc_softc *xdcsc;
2253 struct xd_iorq *iorq;
2254 struct xd_iopb *iopb;
2255 int rqno, comm;
2256
2257 {
2258 int errnum = iorq->errnum;
2259 int erract = errnum & XD_ERA_MASK;
2260 int oldmode, advance;
2261 #ifdef __sparc__
2262 int i;
2263 #endif
2264
2265 if (erract == XD_ERA_RSET) { /* some errors require a reset */
2266 oldmode = iorq->mode;
2267 iorq->mode = XD_SUB_DONE | (~XD_SUB_MASK & oldmode);
2268 xdcsc->ndone++;
2269 /* make xdc_start ignore us */
2270 xdc_reset(xdcsc, 1, XD_RSET_NONE, errnum, iorq->xd);
2271 iorq->mode = oldmode;
2272 xdcsc->ndone--;
2273 }
2274 /* check for read/write to a sector in bad144 table if bad: redirect
2275 * request to bad144 area */
2276
2277 if ((comm == XDCMD_RD || comm == XDCMD_WR) &&
2278 (iorq->mode & XD_MODE_B144) == 0) {
2279 advance = iorq->sectcnt - iopb->sectcnt;
2280 XDC_ADVANCE(iorq, advance);
2281 #ifdef __sparc__
2282 if ((i = isbad(&iorq->xd->dkb, iorq->blockno / iorq->xd->sectpercyl,
2283 (iorq->blockno / iorq->xd->nsect) % iorq->xd->nhead,
2284 iorq->blockno % iorq->xd->nsect)) != -1) {
2285 iorq->mode |= XD_MODE_B144; /* enter bad144 mode &
2286 * redirect */
2287 iopb->errnum = iopb->done = iopb->errs = 0;
2288 iopb->sectcnt = 1;
2289 iopb->cylno = (iorq->xd->ncyl + iorq->xd->acyl) - 2;
2290 /* second to last acyl */
2291 i = iorq->xd->sectpercyl - 1 - i; /* follow bad144
2292 * standard */
2293 iopb->headno = i / iorq->xd->nhead;
2294 iopb->sectno = i % iorq->xd->nhead;
2295 XDC_HWAIT(xdcsc, rqno);
2296 xdc_start(xdcsc, 1); /* resubmit */
2297 return (XD_ERR_AOK); /* recovered! */
2298 }
2299 #endif
2300 }
2301
2302 /*
2303 * it isn't a bad144 sector, must be real error! see if we can retry
2304 * it?
2305 */
2306 if ((iorq->mode & XD_MODE_VERBO) && iorq->lasterror)
2307 xdc_perror(iorq, iopb, 1); /* inform of error state
2308 * change */
2309 iorq->lasterror = errnum;
2310
2311 if ((erract == XD_ERA_RSET || erract == XD_ERA_HARD)
2312 && iorq->tries < XDC_MAXTRIES) { /* retry? */
2313 iorq->tries++;
2314 iorq->errnum = iopb->errnum = iopb->done = iopb->errs = 0;
2315 XDC_HWAIT(xdcsc, rqno);
2316 xdc_start(xdcsc, 1); /* restart */
2317 return (XD_ERR_AOK); /* recovered! */
2318 }
2319
2320 /* failed to recover from this error */
2321 return (XD_ERR_FAIL);
2322 }
2323
2324 /*
2325 * xdc_tick: make sure xd is still alive and ticking (err, kicking).
2326 */
2327 void
2328 xdc_tick(arg)
2329 void *arg;
2330
2331 {
2332 struct xdc_softc *xdcsc = arg;
2333 int lcv, s, reset = 0;
2334 #ifdef XDC_DIAG
2335 int nwait, nrun, nfree, ndone, whd = 0;
2336 u_char fqc[XDC_MAXIOPB], wqc[XDC_MAXIOPB], mark[XDC_MAXIOPB];
2337 s = splbio();
2338 nwait = xdcsc->nwait;
2339 nrun = xdcsc->nrun;
2340 nfree = xdcsc->nfree;
2341 ndone = xdcsc->ndone;
2342 bcopy(xdcsc->waitq, wqc, sizeof(wqc));
2343 bcopy(xdcsc->freereq, fqc, sizeof(fqc));
2344 splx(s);
2345 if (nwait + nrun + nfree + ndone != XDC_MAXIOPB) {
2346 printf("%s: diag: IOPB miscount (got w/f/r/d %d/%d/%d/%d, wanted %d)\n",
2347 device_xname(&xdcsc->sc_dev), nwait, nfree, nrun, ndone,
2348 XDC_MAXIOPB);
2349 bzero(mark, sizeof(mark));
2350 printf("FREE: ");
2351 for (lcv = nfree; lcv > 0; lcv--) {
2352 printf("%d ", fqc[lcv - 1]);
2353 mark[fqc[lcv - 1]] = 1;
2354 }
2355 printf("\nWAIT: ");
2356 lcv = nwait;
2357 while (lcv > 0) {
2358 printf("%d ", wqc[whd]);
2359 mark[wqc[whd]] = 1;
2360 whd = (whd + 1) % XDC_MAXIOPB;
2361 lcv--;
2362 }
2363 printf("\n");
2364 for (lcv = 0; lcv < XDC_MAXIOPB; lcv++) {
2365 if (mark[lcv] == 0)
2366 printf("MARK: running %d: mode %d done %d errs %d errnum 0x%x ttl %d buf %p\n",
2367 lcv, xdcsc->reqs[lcv].mode,
2368 xdcsc->iopbase[lcv].done,
2369 xdcsc->iopbase[lcv].errs,
2370 xdcsc->iopbase[lcv].errnum,
2371 xdcsc->reqs[lcv].ttl, xdcsc->reqs[lcv].buf);
2372 }
2373 } else
2374 if (ndone > XDC_MAXIOPB - XDC_SUBWAITLIM)
2375 printf("%s: diag: lots of done jobs (%d)\n",
2376 device_xname(&xdcsc->sc_dev), ndone);
2377
2378 #endif
2379 #ifdef XDC_DEBUG
2380 printf("%s: tick: csr 0x%x, w/f/r/d %d/%d/%d/%d\n",
2381 device_xname(&xdcsc->sc_dev),
2382 xdcsc->xdc->xdc_csr, xdcsc->nwait, xdcsc->nfree, xdcsc->nrun,
2383 xdcsc->ndone);
2384 for (lcv = 0; lcv < XDC_MAXIOPB; lcv++) {
2385 if (xdcsc->reqs[lcv].mode)
2386 printf("running %d: mode %d done %d errs %d errnum 0x%x\n",
2387 lcv,
2388 xdcsc->reqs[lcv].mode, xdcsc->iopbase[lcv].done,
2389 xdcsc->iopbase[lcv].errs, xdcsc->iopbase[lcv].errnum);
2390 }
2391 #endif
2392
2393 /* reduce ttl for each request if one goes to zero, reset xdc */
2394 s = splbio();
2395 for (lcv = 0; lcv < XDC_MAXIOPB; lcv++) {
2396 if (xdcsc->reqs[lcv].mode == 0 ||
2397 XD_STATE(xdcsc->reqs[lcv].mode) == XD_SUB_DONE)
2398 continue;
2399 xdcsc->reqs[lcv].ttl--;
2400 if (xdcsc->reqs[lcv].ttl == 0)
2401 reset = 1;
2402 }
2403 if (reset) {
2404 printf("%s: watchdog timeout\n", device_xname(&xdcsc->sc_dev));
2405 xdc_reset(xdcsc, 0, XD_RSET_NONE, XD_ERR_FAIL, NULL);
2406 }
2407 splx(s);
2408
2409 /* until next time */
2410
2411 callout_reset(&xdcsc->sc_tick_ch, XDC_TICKCNT, xdc_tick, xdcsc);
2412 }
2413
2414 /*
2415 * xdc_ioctlcmd: this function provides a user level interface to the
2416 * controller via ioctl. this allows "format" programs to be written
2417 * in user code, and is also useful for some debugging. we return
2418 * an error code. called at user priority.
2419 */
2420 int
2421 xdc_ioctlcmd(xd, dev, xio)
2422 struct xd_softc *xd;
2423 dev_t dev;
2424 struct xd_iocmd *xio;
2425
2426 {
2427 int s, rqno, dummy;
2428 char *dvmabuf = NULL, *buf = NULL;
2429 struct xdc_softc *xdcsc;
2430 int rseg, error;
2431 bus_dma_segment_t seg;
2432
2433 /* check sanity of requested command */
2434
2435 switch (xio->cmd) {
2436
2437 case XDCMD_NOP: /* no op: everything should be zero */
2438 if (xio->subfn || xio->dptr || xio->dlen ||
2439 xio->block || xio->sectcnt)
2440 return (EINVAL);
2441 break;
2442
2443 case XDCMD_RD: /* read / write sectors (up to XD_IOCMD_MAXS) */
2444 case XDCMD_WR:
2445 if (xio->subfn || xio->sectcnt > XD_IOCMD_MAXS ||
2446 xio->sectcnt * XDFM_BPS != xio->dlen || xio->dptr == NULL)
2447 return (EINVAL);
2448 break;
2449
2450 case XDCMD_SK: /* seek: doesn't seem useful to export this */
2451 return (EINVAL);
2452
2453 case XDCMD_WRP: /* write parameters */
2454 return (EINVAL);/* not useful, except maybe drive
2455 * parameters... but drive parameters should
2456 * go via disklabel changes */
2457
2458 case XDCMD_RDP: /* read parameters */
2459 if (xio->subfn != XDFUN_DRV ||
2460 xio->dlen || xio->block || xio->dptr)
2461 return (EINVAL); /* allow read drive params to
2462 * get hw_spt */
2463 xio->sectcnt = xd->hw_spt; /* we already know the answer */
2464 return (0);
2465 break;
2466
2467 case XDCMD_XRD: /* extended read/write */
2468 case XDCMD_XWR:
2469
2470 switch (xio->subfn) {
2471
2472 case XDFUN_THD:/* track headers */
2473 if (xio->sectcnt != xd->hw_spt ||
2474 (xio->block % xd->nsect) != 0 ||
2475 xio->dlen != XD_IOCMD_HSZ * xd->hw_spt ||
2476 xio->dptr == NULL)
2477 return (EINVAL);
2478 xio->sectcnt = 0;
2479 break;
2480
2481 case XDFUN_FMT:/* NOTE: also XDFUN_VFY */
2482 if (xio->cmd == XDCMD_XRD)
2483 return (EINVAL); /* no XDFUN_VFY */
2484 if (xio->sectcnt || xio->dlen ||
2485 (xio->block % xd->nsect) != 0 || xio->dptr)
2486 return (EINVAL);
2487 break;
2488
2489 case XDFUN_HDR:/* header, header verify, data, data ECC */
2490 return (EINVAL); /* not yet */
2491
2492 case XDFUN_DM: /* defect map */
2493 case XDFUN_DMX:/* defect map (alternate location) */
2494 if (xio->sectcnt || xio->dlen != XD_IOCMD_DMSZ ||
2495 (xio->block % xd->nsect) != 0 || xio->dptr == NULL)
2496 return (EINVAL);
2497 break;
2498
2499 default:
2500 return (EINVAL);
2501 }
2502 break;
2503
2504 case XDCMD_TST: /* diagnostics */
2505 return (EINVAL);
2506
2507 default:
2508 return (EINVAL);/* ??? */
2509 }
2510
2511 xdcsc = xd->parent;
2512
2513 /* create DVMA buffer for request if needed */
2514 if (xio->dlen) {
2515 bus_addr_t busbuf;
2516
2517 if ((error = xd_dmamem_alloc(xdcsc->dmatag, xdcsc->auxmap,
2518 &seg, &rseg,
2519 xio->dlen, (void **)&buf,
2520 &busbuf)) != 0) {
2521 return (error);
2522 }
2523 dvmabuf = (void *)(u_long)BUS_ADDR_PADDR(busbuf);
2524
2525 if (xio->cmd == XDCMD_WR || xio->cmd == XDCMD_XWR) {
2526 if ((error = copyin(xio->dptr, buf, xio->dlen)) != 0) {
2527 bus_dmamem_unmap(xdcsc->dmatag, buf, xio->dlen);
2528 bus_dmamem_free(xdcsc->dmatag, &seg, rseg);
2529 return (error);
2530 }
2531 }
2532 }
2533
2534 /* do it! */
2535
2536 error = 0;
2537 s = splbio();
2538 rqno = xdc_cmd(xdcsc, xio->cmd, xio->subfn, xd->xd_drive, xio->block,
2539 xio->sectcnt, dvmabuf, XD_SUB_WAIT);
2540 if (rqno == XD_ERR_FAIL) {
2541 error = EIO;
2542 goto done;
2543 }
2544 xio->errnum = xdcsc->reqs[rqno].errnum;
2545 xio->tries = xdcsc->reqs[rqno].tries;
2546 XDC_DONE(xdcsc, rqno, dummy);
2547
2548 if (xio->cmd == XDCMD_RD || xio->cmd == XDCMD_XRD)
2549 error = copyout(buf, xio->dptr, xio->dlen);
2550
2551 done:
2552 splx(s);
2553 if (dvmabuf) {
2554 xd_dmamem_free(xdcsc->dmatag, xdcsc->auxmap, &seg, rseg,
2555 xio->dlen, buf);
2556 }
2557 return (error);
2558 }
2559
2560 /*
2561 * xdc_e2str: convert error code number into an error string
2562 */
2563 const char *
2564 xdc_e2str(no)
2565 int no;
2566 {
2567 switch (no) {
2568 case XD_ERR_FAIL:
2569 return ("Software fatal error");
2570 case XD_ERR_AOK:
2571 return ("Successful completion");
2572 case XD_ERR_ICYL:
2573 return ("Illegal cylinder address");
2574 case XD_ERR_IHD:
2575 return ("Illegal head address");
2576 case XD_ERR_ISEC:
2577 return ("Illgal sector address");
2578 case XD_ERR_CZER:
2579 return ("Count zero");
2580 case XD_ERR_UIMP:
2581 return ("Unimplemented command");
2582 case XD_ERR_IF1:
2583 return ("Illegal field length 1");
2584 case XD_ERR_IF2:
2585 return ("Illegal field length 2");
2586 case XD_ERR_IF3:
2587 return ("Illegal field length 3");
2588 case XD_ERR_IF4:
2589 return ("Illegal field length 4");
2590 case XD_ERR_IF5:
2591 return ("Illegal field length 5");
2592 case XD_ERR_IF6:
2593 return ("Illegal field length 6");
2594 case XD_ERR_IF7:
2595 return ("Illegal field length 7");
2596 case XD_ERR_ISG:
2597 return ("Illegal scatter/gather length");
2598 case XD_ERR_ISPT:
2599 return ("Not enough sectors per track");
2600 case XD_ERR_ALGN:
2601 return ("Next IOPB address alignment error");
2602 case XD_ERR_SGAL:
2603 return ("Scatter/gather address alignment error");
2604 case XD_ERR_SGEC:
2605 return ("Scatter/gather with auto-ECC");
2606 case XD_ERR_SECC:
2607 return ("Soft ECC corrected");
2608 case XD_ERR_SIGN:
2609 return ("ECC ignored");
2610 case XD_ERR_ASEK:
2611 return ("Auto-seek retry recovered");
2612 case XD_ERR_RTRY:
2613 return ("Soft retry recovered");
2614 case XD_ERR_HECC:
2615 return ("Hard data ECC");
2616 case XD_ERR_NHDR:
2617 return ("Header not found");
2618 case XD_ERR_NRDY:
2619 return ("Drive not ready");
2620 case XD_ERR_TOUT:
2621 return ("Operation timeout");
2622 case XD_ERR_VTIM:
2623 return ("VMEDMA timeout");
2624 case XD_ERR_DSEQ:
2625 return ("Disk sequencer error");
2626 case XD_ERR_HDEC:
2627 return ("Header ECC error");
2628 case XD_ERR_RVFY:
2629 return ("Read verify");
2630 case XD_ERR_VFER:
2631 return ("Fatail VMEDMA error");
2632 case XD_ERR_VBUS:
2633 return ("VMEbus error");
2634 case XD_ERR_DFLT:
2635 return ("Drive faulted");
2636 case XD_ERR_HECY:
2637 return ("Header error/cyliner");
2638 case XD_ERR_HEHD:
2639 return ("Header error/head");
2640 case XD_ERR_NOCY:
2641 return ("Drive not on-cylinder");
2642 case XD_ERR_SEEK:
2643 return ("Seek error");
2644 case XD_ERR_ILSS:
2645 return ("Illegal sector size");
2646 case XD_ERR_SEC:
2647 return ("Soft ECC");
2648 case XD_ERR_WPER:
2649 return ("Write-protect error");
2650 case XD_ERR_IRAM:
2651 return ("IRAM self test failure");
2652 case XD_ERR_MT3:
2653 return ("Maintenance test 3 failure (DSKCEL RAM)");
2654 case XD_ERR_MT4:
2655 return ("Maintenance test 4 failure (header shift reg)");
2656 case XD_ERR_MT5:
2657 return ("Maintenance test 5 failure (VMEDMA regs)");
2658 case XD_ERR_MT6:
2659 return ("Maintenance test 6 failure (REGCEL chip)");
2660 case XD_ERR_MT7:
2661 return ("Maintenance test 7 failure (buffer parity)");
2662 case XD_ERR_MT8:
2663 return ("Maintenance test 8 failure (disk FIFO)");
2664 case XD_ERR_IOCK:
2665 return ("IOPB checksum miscompare");
2666 case XD_ERR_IODM:
2667 return ("IOPB DMA fatal");
2668 case XD_ERR_IOAL:
2669 return ("IOPB address alignment error");
2670 case XD_ERR_FIRM:
2671 return ("Firmware error");
2672 case XD_ERR_MMOD:
2673 return ("Illegal maintenance mode test number");
2674 case XD_ERR_ACFL:
2675 return ("ACFAIL asserted");
2676 default:
2677 return ("Unknown error");
2678 }
2679 }
2680