1 /* $NetBSD: xd.c,v 1.76 2008/06/11 21:25:31 drochner 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.76 2008/06/11 21:25:31 drochner 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 = device_private(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 = device_private(self); 731 struct xdc_softc *xdc = device_private(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 = device_lookup_private(&xd_cd, 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 part = DISKPART(dev); 980 981 xd = device_lookup_private(&xd_cd, unit); 982 if (!xd) 983 return ENXIO; 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 ((xd = device_lookup_private(&xd_cd, 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 ((xd = device_lookup_private(&xd_cd, 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 ((xdsc = device_lookup_private(&xd_cd, 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 (!(xd = device_lookup_private(&xd_cd, unit)) || 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