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