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