rd.c revision 1.47
1/* $NetBSD: rd.c,v 1.47 2002/02/10 00:49:57 gmcgarry Exp $ */ 2 3/*- 4 * Copyright (c) 1996, 1997 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Jason R. Thorpe. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 3. All advertising materials mentioning features or use of this software 19 * must display the following acknowledgement: 20 * This product includes software developed by the NetBSD 21 * Foundation, Inc. and its contributors. 22 * 4. Neither the name of The NetBSD Foundation nor the names of its 23 * contributors may be used to endorse or promote products derived 24 * from this software without specific prior written permission. 25 * 26 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 27 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 28 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 29 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 30 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 31 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 32 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 33 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 34 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 35 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 36 * POSSIBILITY OF SUCH DAMAGE. 37 */ 38 39/* 40 * Copyright (c) 1988 University of Utah. 41 * Copyright (c) 1982, 1990, 1993 42 * The Regents of the University of California. All rights reserved. 43 * 44 * This code is derived from software contributed to Berkeley by 45 * the Systems Programming Group of the University of Utah Computer 46 * Science Department. 47 * 48 * Redistribution and use in source and binary forms, with or without 49 * modification, are permitted provided that the following conditions 50 * are met: 51 * 1. Redistributions of source code must retain the above copyright 52 * notice, this list of conditions and the following disclaimer. 53 * 2. Redistributions in binary form must reproduce the above copyright 54 * notice, this list of conditions and the following disclaimer in the 55 * documentation and/or other materials provided with the distribution. 56 * 3. All advertising materials mentioning features or use of this software 57 * must display the following acknowledgement: 58 * This product includes software developed by the University of 59 * California, Berkeley and its contributors. 60 * 4. Neither the name of the University nor the names of its contributors 61 * may be used to endorse or promote products derived from this software 62 * without specific prior written permission. 63 * 64 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 65 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 66 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 67 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 68 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 69 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 70 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 71 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 72 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 73 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 74 * SUCH DAMAGE. 75 * 76 * from: Utah $Hdr: rd.c 1.44 92/12/26$ 77 * 78 * @(#)rd.c 8.2 (Berkeley) 5/19/94 79 */ 80 81/* 82 * CS80/SS80 disk driver 83 */ 84 85#include "opt_useleds.h" 86#include "rnd.h" 87 88#include <sys/param.h> 89#include <sys/systm.h> 90#include <sys/buf.h> 91#include <sys/conf.h> 92#include <sys/device.h> 93#include <sys/disk.h> 94#include <sys/disklabel.h> 95#include <sys/fcntl.h> 96#include <sys/ioctl.h> 97#include <sys/proc.h> 98#include <sys/stat.h> 99 100#if NRND > 0 101#include <sys/rnd.h> 102#endif 103 104#include <hp300/dev/hpibvar.h> 105 106#include <hp300/dev/rdreg.h> 107#include <hp300/dev/rdvar.h> 108 109#ifdef USELEDS 110#include <hp300/hp300/leds.h> 111#endif 112 113int rderrthresh = RDRETRY-1; /* when to start reporting errors */ 114 115#ifdef DEBUG 116/* error message tables */ 117char *err_reject[] = { 118 0, 0, 119 "channel parity error", /* 0x2000 */ 120 0, 0, 121 "illegal opcode", /* 0x0400 */ 122 "module addressing", /* 0x0200 */ 123 "address bounds", /* 0x0100 */ 124 "parameter bounds", /* 0x0080 */ 125 "illegal parameter", /* 0x0040 */ 126 "message sequence", /* 0x0020 */ 127 0, 128 "message length", /* 0x0008 */ 129 0, 0, 0 130}; 131 132char *err_fault[] = { 133 0, 134 "cross unit", /* 0x4000 */ 135 0, 136 "controller fault", /* 0x1000 */ 137 0, 0, 138 "unit fault", /* 0x0200 */ 139 0, 140 "diagnostic result", /* 0x0080 */ 141 0, 142 "operator release request", /* 0x0020 */ 143 "diagnostic release request", /* 0x0010 */ 144 "internal maintenance release request", /* 0x0008 */ 145 0, 146 "power fail", /* 0x0002 */ 147 "retransmit" /* 0x0001 */ 148}; 149 150char *err_access[] = { 151 "illegal parallel operation", /* 0x8000 */ 152 "uninitialized media", /* 0x4000 */ 153 "no spares available", /* 0x2000 */ 154 "not ready", /* 0x1000 */ 155 "write protect", /* 0x0800 */ 156 "no data found", /* 0x0400 */ 157 0, 0, 158 "unrecoverable data overflow", /* 0x0080 */ 159 "unrecoverable data", /* 0x0040 */ 160 0, 161 "end of file", /* 0x0010 */ 162 "end of volume", /* 0x0008 */ 163 0, 0, 0 164}; 165 166char *err_info[] = { 167 "operator release request", /* 0x8000 */ 168 "diagnostic release request", /* 0x4000 */ 169 "internal maintenance release request", /* 0x2000 */ 170 "media wear", /* 0x1000 */ 171 "latency induced", /* 0x0800 */ 172 0, 0, 173 "auto sparing invoked", /* 0x0100 */ 174 0, 175 "recoverable data overflow", /* 0x0040 */ 176 "marginal data", /* 0x0020 */ 177 "recoverable data", /* 0x0010 */ 178 0, 179 "maintenance track overflow", /* 0x0004 */ 180 0, 0 181}; 182 183int rddebug = 0x80; 184#define RDB_FOLLOW 0x01 185#define RDB_STATUS 0x02 186#define RDB_IDENT 0x04 187#define RDB_IO 0x08 188#define RDB_ASYNC 0x10 189#define RDB_ERROR 0x80 190#endif 191 192/* 193 * Misc. HW description, indexed by sc_type. 194 * Nothing really critical here, could do without it. 195 */ 196struct rdidentinfo rdidentinfo[] = { 197 { RD7946AID, 0, "7945A", NRD7945ABPT, 198 NRD7945ATRK, 968, 108416 }, 199 200 { RD9134DID, 1, "9134D", NRD9134DBPT, 201 NRD9134DTRK, 303, 29088 }, 202 203 { RD9134LID, 1, "9122S", NRD9122SBPT, 204 NRD9122STRK, 77, 1232 }, 205 206 { RD7912PID, 0, "7912P", NRD7912PBPT, 207 NRD7912PTRK, 572, 128128 }, 208 209 { RD7914PID, 0, "7914P", NRD7914PBPT, 210 NRD7914PTRK, 1152, 258048 }, 211 212 { RD7958AID, 0, "7958A", NRD7958ABPT, 213 NRD7958ATRK, 1013, 255276 }, 214 215 { RD7957AID, 0, "7957A", NRD7957ABPT, 216 NRD7957ATRK, 1036, 159544 }, 217 218 { RD7933HID, 0, "7933H", NRD7933HBPT, 219 NRD7933HTRK, 1321, 789958 }, 220 221 { RD9134LID, 1, "9134L", NRD9134LBPT, 222 NRD9134LTRK, 973, 77840 }, 223 224 { RD7936HID, 0, "7936H", NRD7936HBPT, 225 NRD7936HTRK, 698, 600978 }, 226 227 { RD7937HID, 0, "7937H", NRD7937HBPT, 228 NRD7937HTRK, 698, 1116102 }, 229 230 { RD7914CTID, 0, "7914CT", NRD7914PBPT, 231 NRD7914PTRK, 1152, 258048 }, 232 233 { RD7946AID, 0, "7946A", NRD7945ABPT, 234 NRD7945ATRK, 968, 108416 }, 235 236 { RD9134LID, 1, "9122D", NRD9122SBPT, 237 NRD9122STRK, 77, 1232 }, 238 239 { RD7957BID, 0, "7957B", NRD7957BBPT, 240 NRD7957BTRK, 1269, 159894 }, 241 242 { RD7958BID, 0, "7958B", NRD7958BBPT, 243 NRD7958BTRK, 786, 297108 }, 244 245 { RD7959BID, 0, "7959B", NRD7959BBPT, 246 NRD7959BTRK, 1572, 594216 }, 247 248 { RD2200AID, 0, "2200A", NRD2200ABPT, 249 NRD2200ATRK, 1449, 654948 }, 250 251 { RD2203AID, 0, "2203A", NRD2203ABPT, 252 NRD2203ATRK, 1449, 1309896 } 253}; 254int numrdidentinfo = sizeof(rdidentinfo) / sizeof(rdidentinfo[0]); 255 256bdev_decl(rd); 257cdev_decl(rd); 258 259int rdident __P((struct device *, struct rd_softc *, 260 struct hpibbus_attach_args *)); 261void rdreset __P((struct rd_softc *)); 262void rdustart __P((struct rd_softc *)); 263int rdgetinfo __P((dev_t)); 264void rdrestart __P((void *)); 265struct buf *rdfinish __P((struct rd_softc *, struct buf *)); 266 267void rdgetdefaultlabel __P((struct rd_softc *, struct disklabel *)); 268void rdrestart __P((void *)); 269void rdustart __P((struct rd_softc *)); 270struct buf *rdfinish __P((struct rd_softc *, struct buf *)); 271void rdstart __P((void *)); 272void rdgo __P((void *)); 273void rdintr __P((void *)); 274int rdstatus __P((struct rd_softc *)); 275int rderror __P((int)); 276#ifdef DEBUG 277void rdprinterr __P((char *, short, char **)); 278#endif 279 280int rdmatch __P((struct device *, struct cfdata *, void *)); 281void rdattach __P((struct device *, struct device *, void *)); 282 283struct cfattach rd_ca = { 284 sizeof(struct rd_softc), rdmatch, rdattach 285}; 286 287extern struct cfdriver rd_cd; 288 289int 290rdmatch(parent, match, aux) 291 struct device *parent; 292 struct cfdata *match; 293 void *aux; 294{ 295 struct hpibbus_attach_args *ha = aux; 296 297 /* 298 * Set punit if operator specified one in the kernel 299 * configuration file. 300 */ 301 if (match->hpibbuscf_punit != HPIBBUSCF_PUNIT_DEFAULT && 302 match->hpibbuscf_punit < HPIB_NPUNITS) 303 ha->ha_punit = match->hpibbuscf_punit; 304 305 if (rdident(parent, NULL, ha) == 0) { 306 /* 307 * XXX Some aging HP-IB drives are slow to 308 * XXX respond; give them a chance to catch 309 * XXX up and probe them again. 310 */ 311 delay(10000); 312 ha->ha_id = hpibid(parent->dv_unit, ha->ha_slave); 313 return (rdident(parent, NULL, ha)); 314 } 315 return (1); 316} 317 318void 319rdattach(parent, self, aux) 320 struct device *parent, *self; 321 void *aux; 322{ 323 struct rd_softc *sc = (struct rd_softc *)self; 324 struct hpibbus_attach_args *ha = aux; 325 326 BUFQ_INIT(&sc->sc_tab); 327 328 if (rdident(parent, sc, ha) == 0) { 329 printf("\n%s: didn't respond to describe command!\n", 330 sc->sc_dev.dv_xname); 331 return; 332 } 333 334 /* 335 * Initialize and attach the disk structure. 336 */ 337 memset(&sc->sc_dkdev, 0, sizeof(sc->sc_dkdev)); 338 sc->sc_dkdev.dk_name = sc->sc_dev.dv_xname; 339 disk_attach(&sc->sc_dkdev); 340 341 sc->sc_slave = ha->ha_slave; 342 sc->sc_punit = ha->ha_punit; 343 344 callout_init(&sc->sc_restart_ch); 345 346 /* Initialize the hpib job queue entry */ 347 sc->sc_hq.hq_softc = sc; 348 sc->sc_hq.hq_slave = sc->sc_slave; 349 sc->sc_hq.hq_start = rdstart; 350 sc->sc_hq.hq_go = rdgo; 351 sc->sc_hq.hq_intr = rdintr; 352 353 sc->sc_flags = RDF_ALIVE; 354#ifdef DEBUG 355 /* always report errors */ 356 if (rddebug & RDB_ERROR) 357 rderrthresh = 0; 358#endif 359#if NRND > 0 360 /* 361 * attach the device into the random source list 362 */ 363 rnd_attach_source(&sc->rnd_source, sc->sc_dev.dv_xname, 364 RND_TYPE_DISK, 0); 365#endif 366} 367 368int 369rdident(parent, sc, ha) 370 struct device *parent; 371 struct rd_softc *sc; 372 struct hpibbus_attach_args *ha; 373{ 374 struct rd_describe *desc = sc != NULL ? &sc->sc_rddesc : NULL; 375 u_char stat, cmd[3]; 376 char name[7]; 377 int i, id, n, ctlr, slave; 378 379 ctlr = parent->dv_unit; 380 slave = ha->ha_slave; 381 382 /* Verify that we have a CS80 device. */ 383 if ((ha->ha_id & 0x200) == 0) 384 return (0); 385 386 /* Is it one of the disks we support? */ 387 for (id = 0; id < numrdidentinfo; id++) 388 if (ha->ha_id == rdidentinfo[id].ri_hwid) 389 break; 390 if (id == numrdidentinfo || ha->ha_punit > rdidentinfo[id].ri_maxunum) 391 return (0); 392 393 /* 394 * If we're just probing for the device, that's all the 395 * work we need to do. 396 */ 397 if (sc == NULL) 398 return (1); 399 400 /* 401 * Reset device and collect description 402 */ 403 rdreset(sc); 404 cmd[0] = C_SUNIT(ha->ha_punit); 405 cmd[1] = C_SVOL(0); 406 cmd[2] = C_DESC; 407 hpibsend(ctlr, slave, C_CMD, cmd, sizeof(cmd)); 408 hpibrecv(ctlr, slave, C_EXEC, desc, 37); 409 hpibrecv(ctlr, slave, C_QSTAT, &stat, sizeof(stat)); 410 memset(name, 0, sizeof(name)); 411 if (stat == 0) { 412 n = desc->d_name; 413 for (i = 5; i >= 0; i--) { 414 name[i] = (n & 0xf) + '0'; 415 n >>= 4; 416 } 417 } 418 419#ifdef DEBUG 420 if (rddebug & RDB_IDENT) { 421 printf("\n%s: name: %x ('%s')\n", 422 sc->sc_dev.dv_xname, desc->d_name, name); 423 printf(" iuw %x, maxxfr %d, ctype %d\n", 424 desc->d_iuw, desc->d_cmaxxfr, desc->d_ctype); 425 printf(" utype %d, bps %d, blkbuf %d, burst %d, blktime %d\n", 426 desc->d_utype, desc->d_sectsize, 427 desc->d_blkbuf, desc->d_burstsize, desc->d_blocktime); 428 printf(" avxfr %d, ort %d, atp %d, maxint %d, fv %x, rv %x\n", 429 desc->d_uavexfr, desc->d_retry, desc->d_access, 430 desc->d_maxint, desc->d_fvbyte, desc->d_rvbyte); 431 printf(" maxcyl/head/sect %d/%d/%d, maxvsect %d, inter %d\n", 432 desc->d_maxcyl, desc->d_maxhead, desc->d_maxsect, 433 desc->d_maxvsectl, desc->d_interleave); 434 printf("%s", sc->sc_dev.dv_xname); 435 } 436#endif 437 438 /* 439 * Take care of a couple of anomolies: 440 * 1. 7945A and 7946A both return same HW id 441 * 2. 9122S and 9134D both return same HW id 442 * 3. 9122D and 9134L both return same HW id 443 */ 444 switch (ha->ha_id) { 445 case RD7946AID: 446 if (memcmp(name, "079450", 6) == 0) 447 id = RD7945A; 448 else 449 id = RD7946A; 450 break; 451 452 case RD9134LID: 453 if (memcmp(name, "091340", 6) == 0) 454 id = RD9134L; 455 else 456 id = RD9122D; 457 break; 458 459 case RD9134DID: 460 if (memcmp(name, "091220", 6) == 0) 461 id = RD9122S; 462 else 463 id = RD9134D; 464 break; 465 } 466 467 sc->sc_type = id; 468 469 /* 470 * XXX We use DEV_BSIZE instead of the sector size value pulled 471 * XXX off the driver because all of this code assumes 512 byte 472 * XXX blocks. ICK! 473 */ 474 printf(": %s\n", rdidentinfo[id].ri_desc); 475 printf("%s: %d cylinders, %d heads, %d blocks, %d bytes/block\n", 476 sc->sc_dev.dv_xname, rdidentinfo[id].ri_ncyl, 477 rdidentinfo[id].ri_ntpc, rdidentinfo[id].ri_nblocks, 478 DEV_BSIZE); 479 480 return (1); 481} 482 483void 484rdreset(rs) 485 struct rd_softc *rs; 486{ 487 int ctlr = rs->sc_dev.dv_parent->dv_unit; 488 int slave = rs->sc_slave; 489 u_char stat; 490 491 rs->sc_clear.c_unit = C_SUNIT(rs->sc_punit); 492 rs->sc_clear.c_cmd = C_CLEAR; 493 hpibsend(ctlr, slave, C_TCMD, &rs->sc_clear, sizeof(rs->sc_clear)); 494 hpibswait(ctlr, slave); 495 hpibrecv(ctlr, slave, C_QSTAT, &stat, sizeof(stat)); 496 497 rs->sc_src.c_unit = C_SUNIT(RDCTLR); 498 rs->sc_src.c_nop = C_NOP; 499 rs->sc_src.c_cmd = C_SREL; 500 rs->sc_src.c_param = C_REL; 501 hpibsend(ctlr, slave, C_CMD, &rs->sc_src, sizeof(rs->sc_src)); 502 hpibswait(ctlr, slave); 503 hpibrecv(ctlr, slave, C_QSTAT, &stat, sizeof(stat)); 504 505 rs->sc_ssmc.c_unit = C_SUNIT(rs->sc_punit); 506 rs->sc_ssmc.c_cmd = C_SSM; 507 rs->sc_ssmc.c_refm = REF_MASK; 508 rs->sc_ssmc.c_fefm = FEF_MASK; 509 rs->sc_ssmc.c_aefm = AEF_MASK; 510 rs->sc_ssmc.c_iefm = IEF_MASK; 511 hpibsend(ctlr, slave, C_CMD, &rs->sc_ssmc, sizeof(rs->sc_ssmc)); 512 hpibswait(ctlr, slave); 513 hpibrecv(ctlr, slave, C_QSTAT, &stat, sizeof(stat)); 514#ifdef DEBUG 515 rs->sc_stats.rdresets++; 516#endif 517} 518 519/* 520 * Read or constuct a disklabel 521 */ 522int 523rdgetinfo(dev) 524 dev_t dev; 525{ 526 int unit = rdunit(dev); 527 struct rd_softc *rs = rd_cd.cd_devs[unit]; 528 struct disklabel *lp = rs->sc_dkdev.dk_label; 529 struct partition *pi; 530 char *msg; 531 532 /* 533 * Set some default values to use while reading the label 534 * or to use if there isn't a label. 535 */ 536 memset((caddr_t)lp, 0, sizeof *lp); 537 lp->d_type = DTYPE_HPIB; 538 lp->d_secsize = DEV_BSIZE; 539 lp->d_nsectors = 32; 540 lp->d_ntracks = 20; 541 lp->d_ncylinders = 1; 542 lp->d_secpercyl = 32*20; 543 lp->d_npartitions = 3; 544 lp->d_partitions[2].p_offset = 0; 545 lp->d_partitions[2].p_size = LABELSECTOR+1; 546 547 /* 548 * Now try to read the disklabel 549 */ 550 msg = readdisklabel(rdlabdev(dev), rdstrategy, lp, NULL); 551 if (msg == NULL) 552 return (0); 553 554 pi = lp->d_partitions; 555 printf("%s: WARNING: %s, ", rs->sc_dev.dv_xname, msg); 556#ifdef COMPAT_NOLABEL 557 printf("using old default partitioning\n"); 558 rdmakedisklabel(unit, lp); 559#else 560 printf("defining `c' partition as entire disk\n"); 561 pi[2].p_size = rdidentinfo[rs->sc_type].ri_nblocks; 562 /* XXX reset other info since readdisklabel screws with it */ 563 lp->d_npartitions = 3; 564 pi[0].p_size = 0; 565#endif 566 return(0); 567} 568 569int 570rdopen(dev, flags, mode, p) 571 dev_t dev; 572 int flags, mode; 573 struct proc *p; 574{ 575 int unit = rdunit(dev); 576 struct rd_softc *rs; 577 int error, mask, part; 578 579 if (unit >= rd_cd.cd_ndevs || 580 (rs = rd_cd.cd_devs[unit]) == NULL || 581 (rs->sc_flags & RDF_ALIVE) == 0) 582 return (ENXIO); 583 584 /* 585 * Wait for any pending opens/closes to complete 586 */ 587 while (rs->sc_flags & (RDF_OPENING|RDF_CLOSING)) 588 (void) tsleep(rs, PRIBIO, "rdopen", 0); 589 590 /* 591 * On first open, get label and partition info. 592 * We may block reading the label, so be careful 593 * to stop any other opens. 594 */ 595 if (rs->sc_dkdev.dk_openmask == 0) { 596 rs->sc_flags |= RDF_OPENING; 597 error = rdgetinfo(dev); 598 rs->sc_flags &= ~RDF_OPENING; 599 wakeup((caddr_t)rs); 600 if (error) 601 return(error); 602 } 603 604 part = rdpart(dev); 605 mask = 1 << part; 606 607 /* Check that the partition exists. */ 608 if (part != RAW_PART && 609 (part > rs->sc_dkdev.dk_label->d_npartitions || 610 rs->sc_dkdev.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) 611 return (ENXIO); 612 613 /* Ensure only one open at a time. */ 614 switch (mode) { 615 case S_IFCHR: 616 rs->sc_dkdev.dk_copenmask |= mask; 617 break; 618 case S_IFBLK: 619 rs->sc_dkdev.dk_bopenmask |= mask; 620 break; 621 } 622 rs->sc_dkdev.dk_openmask = 623 rs->sc_dkdev.dk_copenmask | rs->sc_dkdev.dk_bopenmask; 624 625 return(0); 626} 627 628int 629rdclose(dev, flag, mode, p) 630 dev_t dev; 631 int flag, mode; 632 struct proc *p; 633{ 634 int unit = rdunit(dev); 635 struct rd_softc *rs = rd_cd.cd_devs[unit]; 636 struct disk *dk = &rs->sc_dkdev; 637 int mask, s; 638 639 mask = 1 << rdpart(dev); 640 if (mode == S_IFCHR) 641 dk->dk_copenmask &= ~mask; 642 else 643 dk->dk_bopenmask &= ~mask; 644 dk->dk_openmask = dk->dk_copenmask | dk->dk_bopenmask; 645 /* 646 * On last close, we wait for all activity to cease since 647 * the label/parition info will become invalid. Since we 648 * might sleep, we must block any opens while we are here. 649 * Note we don't have to about other closes since we know 650 * we are the last one. 651 */ 652 if (dk->dk_openmask == 0) { 653 rs->sc_flags |= RDF_CLOSING; 654 s = splbio(); 655 while (rs->sc_active) { 656 rs->sc_flags |= RDF_WANTED; 657 (void) tsleep(&rs->sc_tab, PRIBIO, "rdclose", 0); 658 } 659 splx(s); 660 rs->sc_flags &= ~(RDF_CLOSING|RDF_WLABEL); 661 wakeup((caddr_t)rs); 662 } 663 return(0); 664} 665 666void 667rdstrategy(bp) 668 struct buf *bp; 669{ 670 int unit = rdunit(bp->b_dev); 671 struct rd_softc *rs = rd_cd.cd_devs[unit]; 672 struct partition *pinfo; 673 daddr_t bn; 674 int sz, s; 675 int offset; 676 677#ifdef DEBUG 678 if (rddebug & RDB_FOLLOW) 679 printf("rdstrategy(%p): dev %x, bn %x, bcount %lx, %c\n", 680 bp, bp->b_dev, bp->b_blkno, bp->b_bcount, 681 (bp->b_flags & B_READ) ? 'R' : 'W'); 682#endif 683 bn = bp->b_blkno; 684 sz = howmany(bp->b_bcount, DEV_BSIZE); 685 pinfo = &rs->sc_dkdev.dk_label->d_partitions[rdpart(bp->b_dev)]; 686 687 /* Don't perform partition translation on RAW_PART. */ 688 offset = (rdpart(bp->b_dev) == RAW_PART) ? 0 : pinfo->p_offset; 689 690 if (rdpart(bp->b_dev) != RAW_PART) { 691 /* 692 * XXX This block of code belongs in 693 * XXX bounds_check_with_label() 694 */ 695 696 if (bn < 0 || bn + sz > pinfo->p_size) { 697 sz = pinfo->p_size - bn; 698 if (sz == 0) { 699 bp->b_resid = bp->b_bcount; 700 goto done; 701 } 702 if (sz < 0) { 703 bp->b_error = EINVAL; 704 goto bad; 705 } 706 bp->b_bcount = dbtob(sz); 707 } 708 /* 709 * Check for write to write protected label 710 */ 711 if (bn + offset <= LABELSECTOR && 712#if LABELSECTOR != 0 713 bn + offset + sz > LABELSECTOR && 714#endif 715 !(bp->b_flags & B_READ) && !(rs->sc_flags & RDF_WLABEL)) { 716 bp->b_error = EROFS; 717 goto bad; 718 } 719 } 720 bp->b_rawblkno = bn + offset; 721 s = splbio(); 722 disksort_blkno(&rs->sc_tab, bp); 723 if (rs->sc_active == 0) { 724 rs->sc_active = 1; 725 rdustart(rs); 726 } 727 splx(s); 728 return; 729bad: 730 bp->b_flags |= B_ERROR; 731done: 732 biodone(bp); 733} 734 735/* 736 * Called from timeout() when handling maintenance releases 737 */ 738void 739rdrestart(arg) 740 void *arg; 741{ 742 int s = splbio(); 743 rdustart((struct rd_softc *)arg); 744 splx(s); 745} 746 747void 748rdustart(rs) 749 struct rd_softc *rs; 750{ 751 struct buf *bp; 752 753 bp = BUFQ_FIRST(&rs->sc_tab); 754 rs->sc_addr = bp->b_data; 755 rs->sc_resid = bp->b_bcount; 756 if (hpibreq(rs->sc_dev.dv_parent, &rs->sc_hq)) 757 rdstart(rs); 758} 759 760struct buf * 761rdfinish(rs, bp) 762 struct rd_softc *rs; 763 struct buf *bp; 764{ 765 766 rs->sc_errcnt = 0; 767 BUFQ_REMOVE(&rs->sc_tab, bp); 768 bp->b_resid = 0; 769 biodone(bp); 770 hpibfree(rs->sc_dev.dv_parent, &rs->sc_hq); 771 if ((bp = BUFQ_FIRST(&rs->sc_tab)) != NULL) 772 return (bp); 773 rs->sc_active = 0; 774 if (rs->sc_flags & RDF_WANTED) { 775 rs->sc_flags &= ~RDF_WANTED; 776 wakeup((caddr_t)&rs->sc_tab); 777 } 778 return (NULL); 779} 780 781void 782rdstart(arg) 783 void *arg; 784{ 785 struct rd_softc *rs = arg; 786 struct buf *bp = BUFQ_FIRST(&rs->sc_tab); 787 int part, ctlr, slave; 788 789 ctlr = rs->sc_dev.dv_parent->dv_unit; 790 slave = rs->sc_slave; 791 792again: 793#ifdef DEBUG 794 if (rddebug & RDB_FOLLOW) 795 printf("rdstart(%s): bp %p, %c\n", rs->sc_dev.dv_xname, bp, 796 (bp->b_flags & B_READ) ? 'R' : 'W'); 797#endif 798 part = rdpart(bp->b_dev); 799 rs->sc_flags |= RDF_SEEK; 800 rs->sc_ioc.c_unit = C_SUNIT(rs->sc_punit); 801 rs->sc_ioc.c_volume = C_SVOL(0); 802 rs->sc_ioc.c_saddr = C_SADDR; 803 rs->sc_ioc.c_hiaddr = 0; 804 rs->sc_ioc.c_addr = RDBTOS(bp->b_rawblkno); 805 rs->sc_ioc.c_nop2 = C_NOP; 806 rs->sc_ioc.c_slen = C_SLEN; 807 rs->sc_ioc.c_len = rs->sc_resid; 808 rs->sc_ioc.c_cmd = bp->b_flags & B_READ ? C_READ : C_WRITE; 809#ifdef DEBUG 810 if (rddebug & RDB_IO) 811 printf("rdstart: hpibsend(%x, %x, %x, %p, %x)\n", 812 ctlr, slave, C_CMD, 813 &rs->sc_ioc.c_unit, sizeof(rs->sc_ioc)-2); 814#endif 815 if (hpibsend(ctlr, slave, C_CMD, &rs->sc_ioc.c_unit, 816 sizeof(rs->sc_ioc)-2) == sizeof(rs->sc_ioc)-2) { 817 818 /* Instrumentation. */ 819 disk_busy(&rs->sc_dkdev); 820 rs->sc_dkdev.dk_seek++; 821 822#ifdef DEBUG 823 if (rddebug & RDB_IO) 824 printf("rdstart: hpibawait(%x)\n", ctlr); 825#endif 826 hpibawait(ctlr); 827 return; 828 } 829 /* 830 * Experience has shown that the hpibwait in this hpibsend will 831 * occasionally timeout. It appears to occur mostly on old 7914 832 * drives with full maintenance tracks. We should probably 833 * integrate this with the backoff code in rderror. 834 */ 835#ifdef DEBUG 836 if (rddebug & RDB_ERROR) 837 printf("%s: rdstart: cmd %x adr %lx blk %d len %d ecnt %d\n", 838 rs->sc_dev.dv_xname, rs->sc_ioc.c_cmd, rs->sc_ioc.c_addr, 839 bp->b_blkno, rs->sc_resid, rs->sc_errcnt); 840 rs->sc_stats.rdretries++; 841#endif 842 rs->sc_flags &= ~RDF_SEEK; 843 rdreset(rs); 844 if (rs->sc_errcnt++ < RDRETRY) 845 goto again; 846 printf("%s: rdstart err: cmd 0x%x sect %ld blk %d len %d\n", 847 rs->sc_dev.dv_xname, rs->sc_ioc.c_cmd, rs->sc_ioc.c_addr, 848 bp->b_blkno, rs->sc_resid); 849 bp->b_flags |= B_ERROR; 850 bp->b_error = EIO; 851 bp = rdfinish(rs, bp); 852 if (bp) { 853 rs->sc_addr = bp->b_data; 854 rs->sc_resid = bp->b_bcount; 855 if (hpibreq(rs->sc_dev.dv_parent, &rs->sc_hq)) 856 goto again; 857 } 858} 859 860void 861rdgo(arg) 862 void *arg; 863{ 864 struct rd_softc *rs = arg; 865 struct buf *bp = BUFQ_FIRST(&rs->sc_tab); 866 int rw, ctlr, slave; 867 868 ctlr = rs->sc_dev.dv_parent->dv_unit; 869 slave = rs->sc_slave; 870 871 rw = bp->b_flags & B_READ; 872 873 /* Instrumentation. */ 874 disk_busy(&rs->sc_dkdev); 875 876#ifdef USELEDS 877 ledcontrol(0, 0, LED_DISK); 878#endif 879 hpibgo(ctlr, slave, C_EXEC, rs->sc_addr, rs->sc_resid, rw, rw != 0); 880} 881 882/* ARGSUSED */ 883void 884rdintr(arg) 885 void *arg; 886{ 887 struct rd_softc *rs = arg; 888 int unit = rs->sc_dev.dv_unit; 889 struct buf *bp = BUFQ_FIRST(&rs->sc_tab); 890 u_char stat = 13; /* in case hpibrecv fails */ 891 int rv, restart, ctlr, slave; 892 893 ctlr = rs->sc_dev.dv_parent->dv_unit; 894 slave = rs->sc_slave; 895 896#ifdef DEBUG 897 if (rddebug & RDB_FOLLOW) 898 printf("rdintr(%d): bp %p, %c, flags %x\n", unit, bp, 899 (bp->b_flags & B_READ) ? 'R' : 'W', rs->sc_flags); 900 if (bp == NULL) { 901 printf("%s: bp == NULL\n", rs->sc_dev.dv_xname); 902 return; 903 } 904#endif 905 disk_unbusy(&rs->sc_dkdev, (bp->b_bcount - bp->b_resid)); 906 907 if (rs->sc_flags & RDF_SEEK) { 908 rs->sc_flags &= ~RDF_SEEK; 909 if (hpibustart(ctlr)) 910 rdgo(rs); 911 return; 912 } 913 if ((rs->sc_flags & RDF_SWAIT) == 0) { 914#ifdef DEBUG 915 rs->sc_stats.rdpolltries++; 916#endif 917 if (hpibpptest(ctlr, slave) == 0) { 918#ifdef DEBUG 919 rs->sc_stats.rdpollwaits++; 920#endif 921 922 /* Instrumentation. */ 923 disk_busy(&rs->sc_dkdev); 924 rs->sc_flags |= RDF_SWAIT; 925 hpibawait(ctlr); 926 return; 927 } 928 } else 929 rs->sc_flags &= ~RDF_SWAIT; 930 rv = hpibrecv(ctlr, slave, C_QSTAT, &stat, 1); 931 if (rv != 1 || stat) { 932#ifdef DEBUG 933 if (rddebug & RDB_ERROR) 934 printf("rdintr: recv failed or bad stat %d\n", stat); 935#endif 936 restart = rderror(unit); 937#ifdef DEBUG 938 rs->sc_stats.rdretries++; 939#endif 940 if (rs->sc_errcnt++ < RDRETRY) { 941 if (restart) 942 rdstart(rs); 943 return; 944 } 945 bp->b_flags |= B_ERROR; 946 bp->b_error = EIO; 947 } 948 if (rdfinish(rs, bp)) 949 rdustart(rs); 950#if NRND > 0 951 rnd_add_uint32(&rs->rnd_source, bp->b_blkno); 952#endif 953} 954 955int 956rdstatus(rs) 957 struct rd_softc *rs; 958{ 959 int c, s; 960 u_char stat; 961 int rv; 962 963 c = rs->sc_dev.dv_parent->dv_unit; 964 s = rs->sc_slave; 965 rs->sc_rsc.c_unit = C_SUNIT(rs->sc_punit); 966 rs->sc_rsc.c_sram = C_SRAM; 967 rs->sc_rsc.c_ram = C_RAM; 968 rs->sc_rsc.c_cmd = C_STATUS; 969 memset((caddr_t)&rs->sc_stat, 0, sizeof(rs->sc_stat)); 970 rv = hpibsend(c, s, C_CMD, &rs->sc_rsc, sizeof(rs->sc_rsc)); 971 if (rv != sizeof(rs->sc_rsc)) { 972#ifdef DEBUG 973 if (rddebug & RDB_STATUS) 974 printf("rdstatus: send C_CMD failed %d != %d\n", 975 rv, sizeof(rs->sc_rsc)); 976#endif 977 return(1); 978 } 979 rv = hpibrecv(c, s, C_EXEC, &rs->sc_stat, sizeof(rs->sc_stat)); 980 if (rv != sizeof(rs->sc_stat)) { 981#ifdef DEBUG 982 if (rddebug & RDB_STATUS) 983 printf("rdstatus: send C_EXEC failed %d != %d\n", 984 rv, sizeof(rs->sc_stat)); 985#endif 986 return(1); 987 } 988 rv = hpibrecv(c, s, C_QSTAT, &stat, 1); 989 if (rv != 1 || stat) { 990#ifdef DEBUG 991 if (rddebug & RDB_STATUS) 992 printf("rdstatus: recv failed %d or bad stat %d\n", 993 rv, stat); 994#endif 995 return(1); 996 } 997 return(0); 998} 999 1000/* 1001 * Deal with errors. 1002 * Returns 1 if request should be restarted, 1003 * 0 if we should just quietly give up. 1004 */ 1005int 1006rderror(unit) 1007 int unit; 1008{ 1009 struct rd_softc *rs = rd_cd.cd_devs[unit]; 1010 struct rd_stat *sp; 1011 struct buf *bp; 1012 daddr_t hwbn, pbn; 1013 char *hexstr __P((int, int)); /* XXX */ 1014 1015 if (rdstatus(rs)) { 1016#ifdef DEBUG 1017 printf("%s: couldn't get status\n", rs->sc_dev.dv_xname); 1018#endif 1019 rdreset(rs); 1020 return(1); 1021 } 1022 sp = &rs->sc_stat; 1023 if (sp->c_fef & FEF_REXMT) 1024 return(1); 1025 if (sp->c_fef & FEF_PF) { 1026 rdreset(rs); 1027 return(1); 1028 } 1029 /* 1030 * Unit requests release for internal maintenance. 1031 * We just delay awhile and try again later. Use expontially 1032 * increasing backoff ala ethernet drivers since we don't really 1033 * know how long the maintenance will take. With RDWAITC and 1034 * RDRETRY as defined, the range is 1 to 32 seconds. 1035 */ 1036 if (sp->c_fef & FEF_IMR) { 1037 extern int hz; 1038 int rdtimo = RDWAITC << rs->sc_errcnt; 1039#ifdef DEBUG 1040 printf("%s: internal maintenance, %d second timeout\n", 1041 rs->sc_dev.dv_xname, rdtimo); 1042 rs->sc_stats.rdtimeouts++; 1043#endif 1044 hpibfree(rs->sc_dev.dv_parent, &rs->sc_hq); 1045 callout_reset(&rs->sc_restart_ch, rdtimo * hz, rdrestart, rs); 1046 return(0); 1047 } 1048 /* 1049 * Only report error if we have reached the error reporting 1050 * threshhold. By default, this will only report after the 1051 * retry limit has been exceeded. 1052 */ 1053 if (rs->sc_errcnt < rderrthresh) 1054 return(1); 1055 1056 /* 1057 * First conjure up the block number at which the error occurred. 1058 * Note that not all errors report a block number, in that case 1059 * we just use b_blkno. 1060 */ 1061 bp = BUFQ_FIRST(&rs->sc_tab); 1062 pbn = rs->sc_dkdev.dk_label->d_partitions[rdpart(bp->b_dev)].p_offset; 1063 if ((sp->c_fef & FEF_CU) || (sp->c_fef & FEF_DR) || 1064 (sp->c_ief & IEF_RRMASK)) { 1065 hwbn = RDBTOS(pbn + bp->b_blkno); 1066 pbn = bp->b_blkno; 1067 } else { 1068 hwbn = sp->c_blk; 1069 pbn = RDSTOB(hwbn) - pbn; 1070 } 1071 /* 1072 * Now output a generic message suitable for badsect. 1073 * Note that we don't use harderr cuz it just prints 1074 * out b_blkno which is just the beginning block number 1075 * of the transfer, not necessary where the error occurred. 1076 */ 1077 printf("%s%c: hard error sn%d\n", rs->sc_dev.dv_xname, 1078 'a'+rdpart(bp->b_dev), pbn); 1079 /* 1080 * Now report the status as returned by the hardware with 1081 * attempt at interpretation (unless debugging). 1082 */ 1083 printf("%s %s error:", rs->sc_dev.dv_xname, 1084 (bp->b_flags & B_READ) ? "read" : "write"); 1085#ifdef DEBUG 1086 if (rddebug & RDB_ERROR) { 1087 /* status info */ 1088 printf("\n volume: %d, unit: %d\n", 1089 (sp->c_vu>>4)&0xF, sp->c_vu&0xF); 1090 rdprinterr("reject", sp->c_ref, err_reject); 1091 rdprinterr("fault", sp->c_fef, err_fault); 1092 rdprinterr("access", sp->c_aef, err_access); 1093 rdprinterr("info", sp->c_ief, err_info); 1094 printf(" block: %d, P1-P10: ", hwbn); 1095 printf("0x%x", *(u_int *)&sp->c_raw[0]); 1096 printf("0x%x", *(u_int *)&sp->c_raw[4]); 1097 printf("0x%x\n", *(u_short *)&sp->c_raw[8]); 1098 /* command */ 1099 printf(" ioc: "); 1100 printf("0x%x", *(u_int *)&rs->sc_ioc.c_pad); 1101 printf("0x%x", *(u_short *)&rs->sc_ioc.c_hiaddr); 1102 printf("0x%x", *(u_int *)&rs->sc_ioc.c_addr); 1103 printf("0x%x", *(u_short *)&rs->sc_ioc.c_nop2); 1104 printf("0x%x", *(u_int *)&rs->sc_ioc.c_len); 1105 printf("0x%x\n", *(u_short *)&rs->sc_ioc.c_cmd); 1106 return(1); 1107 } 1108#endif 1109 printf(" v%d u%d, R0x%x F0x%x A0x%x I0x%x\n", 1110 (sp->c_vu>>4)&0xF, sp->c_vu&0xF, 1111 sp->c_ref, sp->c_fef, sp->c_aef, sp->c_ief); 1112 printf("P1-P10: "); 1113 printf("0x%x", *(u_int *)&sp->c_raw[0]); 1114 printf("0x%x", *(u_int *)&sp->c_raw[4]); 1115 printf("0x%x\n", *(u_short *)&sp->c_raw[8]); 1116 return(1); 1117} 1118 1119int 1120rdread(dev, uio, flags) 1121 dev_t dev; 1122 struct uio *uio; 1123 int flags; 1124{ 1125 1126 return (physio(rdstrategy, NULL, dev, B_READ, minphys, uio)); 1127} 1128 1129int 1130rdwrite(dev, uio, flags) 1131 dev_t dev; 1132 struct uio *uio; 1133 int flags; 1134{ 1135 1136 return (physio(rdstrategy, NULL, dev, B_WRITE, minphys, uio)); 1137} 1138 1139int 1140rdioctl(dev, cmd, data, flag, p) 1141 dev_t dev; 1142 u_long cmd; 1143 caddr_t data; 1144 int flag; 1145 struct proc *p; 1146{ 1147 int unit = rdunit(dev); 1148 struct rd_softc *sc = rd_cd.cd_devs[unit]; 1149 struct disklabel *lp = sc->sc_dkdev.dk_label; 1150 int error, flags; 1151 1152 switch (cmd) { 1153 case DIOCGDINFO: 1154 *(struct disklabel *)data = *lp; 1155 return (0); 1156 1157 case DIOCGPART: 1158 ((struct partinfo *)data)->disklab = lp; 1159 ((struct partinfo *)data)->part = 1160 &lp->d_partitions[rdpart(dev)]; 1161 return (0); 1162 1163 case DIOCWLABEL: 1164 if ((flag & FWRITE) == 0) 1165 return (EBADF); 1166 if (*(int *)data) 1167 sc->sc_flags |= RDF_WLABEL; 1168 else 1169 sc->sc_flags &= ~RDF_WLABEL; 1170 return (0); 1171 1172 case DIOCSDINFO: 1173 if ((flag & FWRITE) == 0) 1174 return (EBADF); 1175 return (setdisklabel(lp, (struct disklabel *)data, 1176 (sc->sc_flags & RDF_WLABEL) ? 0 1177 : sc->sc_dkdev.dk_openmask, 1178 (struct cpu_disklabel *)0)); 1179 1180 case DIOCWDINFO: 1181 if ((flag & FWRITE) == 0) 1182 return (EBADF); 1183 error = setdisklabel(lp, (struct disklabel *)data, 1184 (sc->sc_flags & RDF_WLABEL) ? 0 1185 : sc->sc_dkdev.dk_openmask, 1186 (struct cpu_disklabel *)0); 1187 if (error) 1188 return (error); 1189 flags = sc->sc_flags; 1190 sc->sc_flags = RDF_ALIVE | RDF_WLABEL; 1191 error = writedisklabel(rdlabdev(dev), rdstrategy, lp, 1192 (struct cpu_disklabel *)0); 1193 sc->sc_flags = flags; 1194 return (error); 1195 1196 case DIOCGDEFLABEL: 1197 rdgetdefaultlabel(sc, (struct disklabel *)data); 1198 return (0); 1199 } 1200 return(EINVAL); 1201} 1202 1203void 1204rdgetdefaultlabel(sc, lp) 1205 struct rd_softc *sc; 1206 struct disklabel *lp; 1207{ 1208 int type = sc->sc_type; 1209 1210 memset((caddr_t)lp, 0, sizeof(struct disklabel)); 1211 1212 lp->d_type = DTYPE_HPIB; 1213 lp->d_secsize = rdidentinfo[type].ri_nbpt; 1214 lp->d_ntracks = rdidentinfo[type].ri_ntpc; 1215 lp->d_nsectors = rdidentinfo[type].ri_nblocks; 1216 lp->d_ncylinders = rdidentinfo[type].ri_ncyl; 1217 lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors; 1218 1219 strncpy(lp->d_typename, rdidentinfo[type].ri_desc, 16); 1220 strncpy(lp->d_packname, "fictitious", 16); 1221 lp->d_secperunit = lp->d_ncylinders * lp->d_secpercyl; 1222 lp->d_rpm = 3000; 1223 lp->d_interleave = 1; 1224 lp->d_flags = 0; 1225 1226 lp->d_partitions[RAW_PART].p_offset = 0; 1227 lp->d_partitions[RAW_PART].p_size = 1228 lp->d_secperunit * (lp->d_secsize / DEV_BSIZE); 1229 lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED; 1230 lp->d_npartitions = RAW_PART + 1; 1231 1232 lp->d_magic = DISKMAGIC; 1233 lp->d_magic2 = DISKMAGIC; 1234 lp->d_checksum = dkcksum(lp); 1235} 1236 1237int 1238rdsize(dev) 1239 dev_t dev; 1240{ 1241 int unit = rdunit(dev); 1242 struct rd_softc *rs; 1243 int psize, didopen = 0; 1244 1245 if (unit >= rd_cd.cd_ndevs || 1246 (rs = rd_cd.cd_devs[unit]) == NULL || 1247 (rs->sc_flags & RDF_ALIVE) == 0) 1248 return (-1); 1249 1250 /* 1251 * We get called very early on (via swapconf) 1252 * without the device being open so we may need 1253 * to handle it here. 1254 */ 1255 if (rs->sc_dkdev.dk_openmask == 0) { 1256 if (rdopen(dev, FREAD|FWRITE, S_IFBLK, NULL)) 1257 return(-1); 1258 didopen = 1; 1259 } 1260 psize = rs->sc_dkdev.dk_label->d_partitions[rdpart(dev)].p_size * 1261 (rs->sc_dkdev.dk_label->d_secsize / DEV_BSIZE); 1262 if (didopen) 1263 (void) rdclose(dev, FREAD|FWRITE, S_IFBLK, NULL); 1264 return (psize); 1265} 1266 1267#ifdef DEBUG 1268void 1269rdprinterr(str, err, tab) 1270 char *str; 1271 short err; 1272 char **tab; 1273{ 1274 int i; 1275 int printed; 1276 1277 if (err == 0) 1278 return; 1279 printf(" %s error %d field:", str, err); 1280 printed = 0; 1281 for (i = 0; i < 16; i++) 1282 if (err & (0x8000 >> i)) 1283 printf("%s%s", printed++ ? " + " : " ", tab[i]); 1284 printf("\n"); 1285} 1286#endif 1287 1288static int rddoingadump; /* simple mutex */ 1289 1290/* 1291 * Non-interrupt driven, non-dma dump routine. 1292 */ 1293int 1294rddump(dev, blkno, va, size) 1295 dev_t dev; 1296 daddr_t blkno; 1297 caddr_t va; 1298 size_t size; 1299{ 1300 int sectorsize; /* size of a disk sector */ 1301 int nsects; /* number of sectors in partition */ 1302 int sectoff; /* sector offset of partition */ 1303 int totwrt; /* total number of sectors left to write */ 1304 int nwrt; /* current number of sectors to write */ 1305 int unit, part; 1306 int ctlr, slave; 1307 struct rd_softc *rs; 1308 struct disklabel *lp; 1309 char stat; 1310 1311 /* Check for recursive dump; if so, punt. */ 1312 if (rddoingadump) 1313 return (EFAULT); 1314 rddoingadump = 1; 1315 1316 /* Decompose unit and partition. */ 1317 unit = rdunit(dev); 1318 part = rdpart(dev); 1319 1320 /* Make sure dump device is ok. */ 1321 if (unit >= rd_cd.cd_ndevs || 1322 (rs = rd_cd.cd_devs[unit]) == NULL || 1323 (rs->sc_flags & RDF_ALIVE) == 0) 1324 return (ENXIO); 1325 1326 ctlr = rs->sc_dev.dv_parent->dv_unit; 1327 slave = rs->sc_slave; 1328 1329 /* 1330 * Convert to disk sectors. Request must be a multiple of size. 1331 */ 1332 lp = rs->sc_dkdev.dk_label; 1333 sectorsize = lp->d_secsize; 1334 if ((size % sectorsize) != 0) 1335 return (EFAULT); 1336 totwrt = size / sectorsize; 1337 blkno = dbtob(blkno) / sectorsize; /* blkno in DEV_BSIZE units */ 1338 1339 nsects = lp->d_partitions[part].p_size; 1340 sectoff = lp->d_partitions[part].p_offset; 1341 1342 /* Check transfer bounds against partition size. */ 1343 if ((blkno < 0) || (blkno + totwrt) > nsects) 1344 return (EINVAL); 1345 1346 /* Offset block number to start of partition. */ 1347 blkno += sectoff; 1348 1349 while (totwrt > 0) { 1350 nwrt = totwrt; /* XXX */ 1351#ifndef RD_DUMP_NOT_TRUSTED 1352 /* 1353 * Fill out and send HPIB command. 1354 */ 1355 rs->sc_ioc.c_unit = C_SUNIT(rs->sc_punit); 1356 rs->sc_ioc.c_volume = C_SVOL(0); 1357 rs->sc_ioc.c_saddr = C_SADDR; 1358 rs->sc_ioc.c_hiaddr = 0; 1359 rs->sc_ioc.c_addr = RDBTOS(blkno); 1360 rs->sc_ioc.c_nop2 = C_NOP; 1361 rs->sc_ioc.c_slen = C_SLEN; 1362 rs->sc_ioc.c_len = nwrt * sectorsize; 1363 rs->sc_ioc.c_cmd = C_WRITE; 1364 hpibsend(ctlr, slave, C_CMD, &rs->sc_ioc.c_unit, 1365 sizeof(rs->sc_ioc)-2); 1366 if (hpibswait(ctlr, slave)) 1367 return (EIO); 1368 1369 /* 1370 * Send the data. 1371 */ 1372 hpibsend(ctlr, slave, C_EXEC, va, nwrt * sectorsize); 1373 (void) hpibswait(ctlr, slave); 1374 hpibrecv(ctlr, slave, C_QSTAT, &stat, 1); 1375 if (stat) 1376 return (EIO); 1377#else /* RD_DUMP_NOT_TRUSTED */ 1378 /* Let's just talk about this first... */ 1379 printf("%s: dump addr %p, blk %d\n", sc->sc_dev.dv_xname, 1380 va, blkno); 1381 delay(500 * 1000); /* half a second */ 1382#endif /* RD_DUMP_NOT_TRUSTED */ 1383 1384 /* update block count */ 1385 totwrt -= nwrt; 1386 blkno += nwrt; 1387 va += sectorsize * nwrt; 1388 } 1389 rddoingadump = 0; 1390 return (0); 1391} 1392