Home | History | Annotate | Line # | Download | only in mca
ed_mca.c revision 1.7.4.5
      1  1.7.4.5  jdolecek /*	$NetBSD: ed_mca.c,v 1.7.4.5 2002/10/10 18:40:01 jdolecek Exp $	*/
      2      1.1  jdolecek 
      3      1.1  jdolecek /*
      4      1.1  jdolecek  * Copyright (c) 2001 The NetBSD Foundation, Inc.
      5      1.1  jdolecek  *
      6      1.1  jdolecek  * This code is derived from software contributed to The NetBSD Foundation
      7      1.1  jdolecek  * by Jaromir Dolecek.
      8      1.1  jdolecek  *
      9      1.1  jdolecek  * Redistribution and use in source and binary forms, with or without
     10      1.1  jdolecek  * modification, are permitted provided that the following conditions
     11      1.1  jdolecek  * are met:
     12      1.1  jdolecek  * 1. Redistributions of source code must retain the above copyright
     13      1.1  jdolecek  *    notice, this list of conditions and the following disclaimer.
     14      1.1  jdolecek  * 2. Redistributions in binary form must reproduce the above copyright
     15      1.1  jdolecek  *    notice, this list of conditions and the following disclaimer in the
     16      1.1  jdolecek  *    documentation and/or other materials provided with the distribution.
     17      1.1  jdolecek  * 3. All advertising materials mentioning features or use of this software
     18      1.1  jdolecek  *    must display the following acknowledgement:
     19      1.1  jdolecek  *        This product includes software developed by the NetBSD
     20      1.1  jdolecek  *        Foundation, Inc. and its contributors.
     21      1.1  jdolecek  * 4. The name of the author may not be used to endorse or promote products
     22      1.1  jdolecek  *    derived from this software without specific prior written permission.
     23      1.1  jdolecek  *
     24      1.1  jdolecek  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     25      1.1  jdolecek  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     26      1.1  jdolecek  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     27      1.1  jdolecek  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     28      1.1  jdolecek  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     29      1.1  jdolecek  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     30      1.1  jdolecek  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     31      1.1  jdolecek  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     32      1.1  jdolecek  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     33      1.1  jdolecek  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     34      1.1  jdolecek  */
     35      1.1  jdolecek 
     36      1.1  jdolecek /*
     37  1.7.4.2   thorpej  * Disk drive goo for MCA ESDI controller driver.
     38      1.1  jdolecek  */
     39      1.1  jdolecek 
     40  1.7.4.2   thorpej #include <sys/cdefs.h>
     41  1.7.4.5  jdolecek __KERNEL_RCSID(0, "$NetBSD: ed_mca.c,v 1.7.4.5 2002/10/10 18:40:01 jdolecek Exp $");
     42  1.7.4.2   thorpej 
     43      1.1  jdolecek #include "rnd.h"
     44  1.7.4.2   thorpej #include "locators.h"
     45      1.1  jdolecek 
     46      1.1  jdolecek #include <sys/param.h>
     47      1.1  jdolecek #include <sys/systm.h>
     48      1.1  jdolecek #include <sys/kernel.h>
     49      1.1  jdolecek #include <sys/conf.h>
     50      1.1  jdolecek #include <sys/file.h>
     51      1.1  jdolecek #include <sys/stat.h>
     52      1.1  jdolecek #include <sys/ioctl.h>
     53      1.1  jdolecek #include <sys/buf.h>
     54      1.1  jdolecek #include <sys/uio.h>
     55      1.1  jdolecek #include <sys/malloc.h>
     56      1.1  jdolecek #include <sys/device.h>
     57      1.1  jdolecek #include <sys/disklabel.h>
     58      1.1  jdolecek #include <sys/disk.h>
     59      1.1  jdolecek #include <sys/syslog.h>
     60      1.1  jdolecek #include <sys/proc.h>
     61      1.1  jdolecek #include <sys/vnode.h>
     62      1.1  jdolecek #if NRND > 0
     63      1.1  jdolecek #include <sys/rnd.h>
     64      1.1  jdolecek #endif
     65      1.1  jdolecek 
     66      1.1  jdolecek #include <machine/intr.h>
     67      1.1  jdolecek #include <machine/bus.h>
     68      1.1  jdolecek 
     69      1.4  jdolecek #include <dev/mca/mcavar.h>
     70      1.4  jdolecek 
     71      1.2  jdolecek #include <dev/mca/edcreg.h>
     72      1.1  jdolecek #include <dev/mca/edvar.h>
     73      1.2  jdolecek #include <dev/mca/edcvar.h>
     74      1.1  jdolecek 
     75      1.1  jdolecek /* #define WDCDEBUG */
     76      1.1  jdolecek 
     77      1.1  jdolecek #ifdef WDCDEBUG
     78      1.1  jdolecek #define WDCDEBUG_PRINT(args, level)  printf args
     79      1.1  jdolecek #else
     80      1.1  jdolecek #define WDCDEBUG_PRINT(args, level)
     81      1.1  jdolecek #endif
     82      1.1  jdolecek 
     83      1.1  jdolecek #define	EDLABELDEV(dev) (MAKEDISKDEV(major(dev), DISKUNIT(dev), RAW_PART))
     84      1.1  jdolecek 
     85      1.1  jdolecek static int     ed_mca_probe   __P((struct device *, struct cfdata *, void *));
     86      1.1  jdolecek static void    ed_mca_attach  __P((struct device *, struct device *, void *));
     87      1.1  jdolecek 
     88  1.7.4.5  jdolecek CFATTACH_DECL(ed_mca, sizeof(struct ed_softc),
     89  1.7.4.5  jdolecek     ed_mca_probe, ed_mca_attach, NULL, NULL);
     90      1.1  jdolecek 
     91      1.1  jdolecek extern struct cfdriver ed_cd;
     92      1.1  jdolecek 
     93  1.7.4.2   thorpej static int	ed_get_params __P((struct ed_softc *, int *));
     94      1.1  jdolecek static int	ed_lock	__P((struct ed_softc *));
     95      1.1  jdolecek static void	ed_unlock	__P((struct ed_softc *));
     96  1.7.4.2   thorpej static void	edgetdisklabel	__P((dev_t, struct ed_softc *));
     97      1.1  jdolecek static void	edgetdefaultlabel __P((struct ed_softc *, struct disklabel *));
     98  1.7.4.5  jdolecek 
     99  1.7.4.5  jdolecek dev_type_open(edmcaopen);
    100  1.7.4.5  jdolecek dev_type_close(edmcaclose);
    101  1.7.4.5  jdolecek dev_type_read(edmcaread);
    102  1.7.4.5  jdolecek dev_type_write(edmcawrite);
    103  1.7.4.5  jdolecek dev_type_ioctl(edmcaioctl);
    104  1.7.4.5  jdolecek dev_type_strategy(edmcastrategy);
    105  1.7.4.5  jdolecek dev_type_dump(edmcadump);
    106  1.7.4.5  jdolecek dev_type_size(edmcasize);
    107  1.7.4.5  jdolecek 
    108  1.7.4.5  jdolecek const struct bdevsw ed_bdevsw = {
    109  1.7.4.5  jdolecek 	edmcaopen, edmcaclose, edmcastrategy, edmcaioctl,
    110  1.7.4.5  jdolecek 	edmcadump, edmcasize, D_DISK
    111  1.7.4.5  jdolecek };
    112  1.7.4.5  jdolecek 
    113  1.7.4.5  jdolecek const struct cdevsw ed_cdevsw = {
    114  1.7.4.5  jdolecek 	edmcaopen, edmcaclose, edmcaread, edmcawrite, edmcaioctl,
    115  1.7.4.5  jdolecek 	nostop, notty, nopoll, nommap, nokqfilter, D_DISK
    116  1.7.4.5  jdolecek };
    117      1.1  jdolecek 
    118      1.1  jdolecek static struct dkdriver eddkdriver = { edmcastrategy };
    119      1.1  jdolecek 
    120      1.1  jdolecek /*
    121      1.1  jdolecek  * Just check if it's possible to identify the disk.
    122      1.1  jdolecek  */
    123      1.1  jdolecek static int
    124  1.7.4.2   thorpej ed_mca_probe(parent, cf, aux)
    125      1.1  jdolecek 	struct device *parent;
    126  1.7.4.2   thorpej 	struct cfdata *cf;
    127      1.1  jdolecek 	void *aux;
    128      1.1  jdolecek {
    129      1.1  jdolecek 	u_int16_t cmd_args[2];
    130      1.2  jdolecek 	struct edc_mca_softc *sc = (void *) parent;
    131  1.7.4.2   thorpej 	struct ed_attach_args *eda = (struct ed_attach_args *) aux;
    132      1.6  jdolecek 	int found = 1;
    133      1.1  jdolecek 
    134      1.1  jdolecek 	/*
    135  1.7.4.2   thorpej 	 * Check we match hardwired config.
    136  1.7.4.2   thorpej 	 */
    137  1.7.4.2   thorpej 	if (cf->edccf_unit != EDCCF_DRIVE_DEFAULT &&
    138  1.7.4.2   thorpej 	    cf->edccf_unit != eda->edc_drive)
    139  1.7.4.2   thorpej 		return (0);
    140  1.7.4.2   thorpej 
    141  1.7.4.2   thorpej 	/*
    142      1.1  jdolecek 	 * Get Device Configuration (09).
    143      1.1  jdolecek 	 */
    144      1.6  jdolecek 	cmd_args[0] = 14;	/* Options: 00s110, s: 0=Physical 1=Pseudo */
    145      1.1  jdolecek 	cmd_args[1] = 0;
    146  1.7.4.2   thorpej 	if (edc_run_cmd(sc, CMD_GET_DEV_CONF, eda->edc_drive, cmd_args, 2, 1))
    147      1.6  jdolecek 		found = 0;
    148      1.1  jdolecek 
    149      1.6  jdolecek 	return (found);
    150      1.1  jdolecek }
    151      1.1  jdolecek 
    152      1.1  jdolecek static void
    153      1.1  jdolecek ed_mca_attach(parent, self, aux)
    154      1.1  jdolecek 	struct device *parent, *self;
    155      1.1  jdolecek 	void *aux;
    156      1.1  jdolecek {
    157      1.1  jdolecek 	struct ed_softc *ed = (void *) self;
    158      1.2  jdolecek 	struct edc_mca_softc *sc = (void *) parent;
    159  1.7.4.2   thorpej 	struct ed_attach_args *eda = (struct ed_attach_args *) aux;
    160  1.7.4.2   thorpej 	char pbuf[8], lckname[10];
    161  1.7.4.2   thorpej 	int drv_flags;
    162      1.1  jdolecek 
    163      1.2  jdolecek 	ed->edc_softc = sc;
    164  1.7.4.2   thorpej 	ed->sc_devno  = eda->edc_drive;
    165  1.7.4.2   thorpej 	edc_add_disk(sc, ed);
    166      1.1  jdolecek 
    167  1.7.4.4  jdolecek 	bufq_alloc(&ed->sc_q, BUFQ_DISKSORT|BUFQ_SORT_RAWBLOCK);
    168  1.7.4.1   thorpej 	simple_lock_init(&ed->sc_q_lock);
    169  1.7.4.2   thorpej 	snprintf(lckname, sizeof(lckname), "%slck", ed->sc_dev.dv_xname);
    170  1.7.4.2   thorpej 	lockinit(&ed->sc_lock, PRIBIO | PCATCH, lckname, 0, 0);
    171      1.1  jdolecek 
    172  1.7.4.2   thorpej 	if (ed_get_params(ed, &drv_flags)) {
    173      1.1  jdolecek 		printf(": IDENTIFY failed, no disk found\n");
    174      1.1  jdolecek 		return;
    175      1.1  jdolecek 	}
    176      1.1  jdolecek 
    177      1.1  jdolecek 	format_bytes(pbuf, sizeof(pbuf),
    178      1.1  jdolecek 		(u_int64_t) ed->sc_capacity * DEV_BSIZE);
    179      1.1  jdolecek 	printf(": %s, %u cyl, %u head, %u sec, 512 bytes/sect x %u sectors\n",
    180      1.1  jdolecek 		pbuf,
    181      1.1  jdolecek 		ed->cyl, ed->heads, ed->sectors,
    182      1.1  jdolecek 		ed->sc_capacity);
    183      1.1  jdolecek 
    184      1.6  jdolecek 	printf("%s: %u spares/cyl, %s, %s, %s, %s, %s\n",
    185      1.1  jdolecek 		ed->sc_dev.dv_xname, ed->spares,
    186  1.7.4.2   thorpej 		(drv_flags & (1 << 0)) ? "NoRetries" : "Retries",
    187  1.7.4.2   thorpej 		(drv_flags & (1 << 1)) ? "Removable" : "Fixed",
    188  1.7.4.2   thorpej 		(drv_flags & (1 << 2)) ? "SkewedFormat" : "NoSkew",
    189  1.7.4.2   thorpej 		(drv_flags & (1 << 3)) ? "ZeroDefect" : "Defects",
    190  1.7.4.2   thorpej 		(drv_flags & (1 << 4)) ? "InvalidSecondary" : "SecondaryOK"
    191      1.1  jdolecek 		);
    192  1.7.4.1   thorpej 
    193      1.1  jdolecek 	/*
    194      1.1  jdolecek 	 * Initialize and attach the disk structure.
    195      1.1  jdolecek 	 */
    196      1.1  jdolecek 	ed->sc_dk.dk_driver = &eddkdriver;
    197      1.1  jdolecek 	ed->sc_dk.dk_name = ed->sc_dev.dv_xname;
    198      1.1  jdolecek 	disk_attach(&ed->sc_dk);
    199      1.1  jdolecek #if NRND > 0
    200      1.1  jdolecek 	rnd_attach_source(&ed->rnd_source, ed->sc_dev.dv_xname,
    201      1.1  jdolecek 			  RND_TYPE_DISK, 0);
    202      1.1  jdolecek #endif
    203      1.1  jdolecek 
    204      1.6  jdolecek 	ed->sc_flags |= EDF_INIT;
    205      1.1  jdolecek }
    206      1.1  jdolecek 
    207      1.1  jdolecek /*
    208      1.1  jdolecek  * Read/write routine for a buffer.  Validates the arguments and schedules the
    209      1.1  jdolecek  * transfer.  Does not wait for the transfer to complete.
    210      1.1  jdolecek  */
    211      1.1  jdolecek void
    212      1.1  jdolecek edmcastrategy(bp)
    213      1.1  jdolecek 	struct buf *bp;
    214      1.1  jdolecek {
    215  1.7.4.2   thorpej 	struct ed_softc *ed = device_lookup(&ed_cd, DISKUNIT(bp->b_dev));
    216  1.7.4.2   thorpej 	struct disklabel *lp = ed->sc_dk.dk_label;
    217      1.1  jdolecek 	daddr_t blkno;
    218      1.1  jdolecek 
    219  1.7.4.2   thorpej 	WDCDEBUG_PRINT(("edmcastrategy (%s)\n", ed->sc_dev.dv_xname),
    220      1.1  jdolecek 	    DEBUG_XFERS);
    221  1.7.4.1   thorpej 
    222      1.1  jdolecek 	/* Valid request?  */
    223      1.1  jdolecek 	if (bp->b_blkno < 0 ||
    224      1.1  jdolecek 	    (bp->b_bcount % lp->d_secsize) != 0 ||
    225      1.1  jdolecek 	    (bp->b_bcount / lp->d_secsize) >= (1 << NBBY)) {
    226      1.1  jdolecek 		bp->b_error = EINVAL;
    227      1.1  jdolecek 		goto bad;
    228      1.1  jdolecek 	}
    229  1.7.4.1   thorpej 
    230      1.1  jdolecek 	/* If device invalidated (e.g. media change, door open), error. */
    231  1.7.4.2   thorpej 	if ((ed->sc_flags & WDF_LOADED) == 0) {
    232      1.1  jdolecek 		bp->b_error = EIO;
    233      1.1  jdolecek 		goto bad;
    234      1.1  jdolecek 	}
    235      1.1  jdolecek 
    236      1.1  jdolecek 	/* If it's a null transfer, return immediately. */
    237      1.1  jdolecek 	if (bp->b_bcount == 0)
    238      1.1  jdolecek 		goto done;
    239      1.1  jdolecek 
    240      1.1  jdolecek 	/*
    241      1.1  jdolecek 	 * Do bounds checking, adjust transfer. if error, process.
    242      1.1  jdolecek 	 * If end of partition, just return.
    243      1.1  jdolecek 	 */
    244      1.1  jdolecek 	if (DISKPART(bp->b_dev) != RAW_PART &&
    245  1.7.4.2   thorpej 	    bounds_check_with_label(bp, ed->sc_dk.dk_label,
    246  1.7.4.2   thorpej 	    (ed->sc_flags & (WDF_WLABEL|WDF_LABELLING)) != 0) <= 0)
    247      1.1  jdolecek 		goto done;
    248      1.1  jdolecek 
    249      1.1  jdolecek 	/*
    250      1.1  jdolecek 	 * Now convert the block number to absolute and put it in
    251      1.1  jdolecek 	 * terms of the device's logical block size.
    252      1.1  jdolecek 	 */
    253      1.1  jdolecek 	if (lp->d_secsize >= DEV_BSIZE)
    254      1.1  jdolecek 		blkno = bp->b_blkno / (lp->d_secsize / DEV_BSIZE);
    255      1.1  jdolecek 	else
    256      1.1  jdolecek 		blkno = bp->b_blkno * (DEV_BSIZE / lp->d_secsize);
    257      1.1  jdolecek 
    258      1.1  jdolecek 	if (DISKPART(bp->b_dev) != RAW_PART)
    259      1.1  jdolecek 		blkno += lp->d_partitions[DISKPART(bp->b_dev)].p_offset;
    260      1.1  jdolecek 
    261      1.1  jdolecek 	bp->b_rawblkno = blkno;
    262      1.1  jdolecek 
    263      1.1  jdolecek 	/* Queue transfer on drive, activate drive and controller if idle. */
    264  1.7.4.2   thorpej 	simple_lock(&ed->sc_q_lock);
    265  1.7.4.4  jdolecek 	BUFQ_PUT(&ed->sc_q, bp);
    266  1.7.4.2   thorpej 	simple_unlock(&ed->sc_q_lock);
    267      1.1  jdolecek 
    268      1.1  jdolecek 	/* Ring the worker thread */
    269  1.7.4.2   thorpej 	wakeup_one(ed->edc_softc);
    270      1.1  jdolecek 
    271      1.1  jdolecek 	return;
    272      1.1  jdolecek bad:
    273      1.1  jdolecek 	bp->b_flags |= B_ERROR;
    274      1.1  jdolecek done:
    275      1.1  jdolecek 	/* Toss transfer; we're done early. */
    276      1.1  jdolecek 	bp->b_resid = bp->b_bcount;
    277      1.1  jdolecek 	biodone(bp);
    278      1.1  jdolecek }
    279      1.1  jdolecek 
    280      1.1  jdolecek int
    281      1.1  jdolecek edmcaread(dev, uio, flags)
    282      1.1  jdolecek 	dev_t dev;
    283      1.1  jdolecek 	struct uio *uio;
    284      1.1  jdolecek 	int flags;
    285      1.1  jdolecek {
    286      1.1  jdolecek 	WDCDEBUG_PRINT(("edread\n"), DEBUG_XFERS);
    287      1.1  jdolecek 	return (physio(edmcastrategy, NULL, dev, B_READ, minphys, uio));
    288      1.1  jdolecek }
    289      1.1  jdolecek 
    290      1.1  jdolecek int
    291      1.1  jdolecek edmcawrite(dev, uio, flags)
    292      1.1  jdolecek 	dev_t dev;
    293      1.1  jdolecek 	struct uio *uio;
    294      1.1  jdolecek 	int flags;
    295      1.1  jdolecek {
    296      1.1  jdolecek 	WDCDEBUG_PRINT(("edwrite\n"), DEBUG_XFERS);
    297      1.1  jdolecek 	return (physio(edmcastrategy, NULL, dev, B_WRITE, minphys, uio));
    298      1.1  jdolecek }
    299      1.1  jdolecek 
    300      1.1  jdolecek /*
    301      1.1  jdolecek  * Wait interruptibly for an exclusive lock.
    302      1.1  jdolecek  */
    303      1.1  jdolecek static int
    304      1.3  jdolecek ed_lock(ed)
    305      1.3  jdolecek 	struct ed_softc *ed;
    306      1.1  jdolecek {
    307      1.1  jdolecek 	int error;
    308      1.1  jdolecek 	int s;
    309      1.1  jdolecek 
    310      1.1  jdolecek 	WDCDEBUG_PRINT(("ed_lock\n"), DEBUG_FUNCS);
    311      1.1  jdolecek 
    312      1.1  jdolecek 	s = splbio();
    313      1.3  jdolecek 	error = lockmgr(&ed->sc_lock, LK_EXCLUSIVE, NULL);
    314      1.3  jdolecek 	splx(s);
    315      1.1  jdolecek 
    316      1.3  jdolecek 	return (error);
    317      1.1  jdolecek }
    318      1.1  jdolecek 
    319      1.1  jdolecek /*
    320      1.1  jdolecek  * Unlock and wake up any waiters.
    321      1.1  jdolecek  */
    322      1.1  jdolecek static void
    323      1.3  jdolecek ed_unlock(ed)
    324      1.3  jdolecek 	struct ed_softc *ed;
    325      1.1  jdolecek {
    326      1.1  jdolecek 	WDCDEBUG_PRINT(("ed_unlock\n"), DEBUG_FUNCS);
    327      1.1  jdolecek 
    328      1.3  jdolecek 	(void) lockmgr(&ed->sc_lock, LK_RELEASE, NULL);
    329      1.1  jdolecek }
    330      1.1  jdolecek 
    331      1.1  jdolecek int
    332      1.1  jdolecek edmcaopen(dev, flag, fmt, p)
    333      1.1  jdolecek 	dev_t dev;
    334      1.1  jdolecek 	int flag, fmt;
    335      1.1  jdolecek 	struct proc *p;
    336      1.1  jdolecek {
    337      1.1  jdolecek 	struct ed_softc *wd;
    338      1.1  jdolecek 	int part, error;
    339      1.1  jdolecek 
    340      1.1  jdolecek 	WDCDEBUG_PRINT(("edopen\n"), DEBUG_FUNCS);
    341      1.1  jdolecek 	wd = device_lookup(&ed_cd, DISKUNIT(dev));
    342      1.6  jdolecek 	if (wd == NULL || (wd->sc_flags & EDF_INIT) == 0)
    343      1.1  jdolecek 		return (ENXIO);
    344      1.1  jdolecek 
    345      1.1  jdolecek 	if ((error = ed_lock(wd)) != 0)
    346      1.1  jdolecek 		goto bad4;
    347      1.1  jdolecek 
    348      1.1  jdolecek 	if (wd->sc_dk.dk_openmask != 0) {
    349      1.1  jdolecek 		/*
    350      1.1  jdolecek 		 * If any partition is open, but the disk has been invalidated,
    351      1.1  jdolecek 		 * disallow further opens.
    352      1.1  jdolecek 		 */
    353      1.1  jdolecek 		if ((wd->sc_flags & WDF_LOADED) == 0) {
    354      1.1  jdolecek 			error = EIO;
    355      1.1  jdolecek 			goto bad3;
    356      1.1  jdolecek 		}
    357      1.1  jdolecek 	} else {
    358      1.1  jdolecek 		if ((wd->sc_flags & WDF_LOADED) == 0) {
    359  1.7.4.2   thorpej 			int s;
    360  1.7.4.2   thorpej 
    361      1.1  jdolecek 			wd->sc_flags |= WDF_LOADED;
    362      1.1  jdolecek 
    363      1.1  jdolecek 			/* Load the physical device parameters. */
    364  1.7.4.2   thorpej 			s = splbio();
    365  1.7.4.2   thorpej 			ed_get_params(wd, NULL);
    366  1.7.4.2   thorpej 			splx(s);
    367      1.1  jdolecek 
    368      1.1  jdolecek 			/* Load the partition info if not already loaded. */
    369  1.7.4.2   thorpej 			edgetdisklabel(dev, wd);
    370      1.1  jdolecek 		}
    371      1.1  jdolecek 	}
    372      1.1  jdolecek 
    373      1.1  jdolecek 	part = DISKPART(dev);
    374      1.1  jdolecek 
    375      1.1  jdolecek 	/* Check that the partition exists. */
    376      1.1  jdolecek 	if (part != RAW_PART &&
    377      1.1  jdolecek 	    (part >= wd->sc_dk.dk_label->d_npartitions ||
    378      1.1  jdolecek 	     wd->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
    379      1.1  jdolecek 		error = ENXIO;
    380      1.1  jdolecek 		goto bad;
    381      1.1  jdolecek 	}
    382  1.7.4.1   thorpej 
    383      1.1  jdolecek 	/* Insure only one open at a time. */
    384      1.1  jdolecek 	switch (fmt) {
    385      1.1  jdolecek 	case S_IFCHR:
    386      1.1  jdolecek 		wd->sc_dk.dk_copenmask |= (1 << part);
    387      1.1  jdolecek 		break;
    388      1.1  jdolecek 	case S_IFBLK:
    389      1.1  jdolecek 		wd->sc_dk.dk_bopenmask |= (1 << part);
    390      1.1  jdolecek 		break;
    391      1.1  jdolecek 	}
    392      1.1  jdolecek 	wd->sc_dk.dk_openmask =
    393      1.1  jdolecek 	    wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
    394      1.1  jdolecek 
    395      1.1  jdolecek 	ed_unlock(wd);
    396      1.1  jdolecek 	return 0;
    397      1.1  jdolecek 
    398      1.1  jdolecek bad:
    399      1.1  jdolecek 	if (wd->sc_dk.dk_openmask == 0) {
    400      1.1  jdolecek 	}
    401      1.1  jdolecek 
    402      1.1  jdolecek bad3:
    403      1.1  jdolecek 	ed_unlock(wd);
    404      1.1  jdolecek bad4:
    405      1.1  jdolecek 	return (error);
    406      1.1  jdolecek }
    407      1.1  jdolecek 
    408      1.1  jdolecek int
    409      1.1  jdolecek edmcaclose(dev, flag, fmt, p)
    410      1.1  jdolecek 	dev_t dev;
    411      1.1  jdolecek 	int flag, fmt;
    412      1.1  jdolecek 	struct proc *p;
    413      1.1  jdolecek {
    414      1.1  jdolecek 	struct ed_softc *wd = device_lookup(&ed_cd, DISKUNIT(dev));
    415      1.1  jdolecek 	int part = DISKPART(dev);
    416      1.1  jdolecek 	int error;
    417  1.7.4.1   thorpej 
    418      1.1  jdolecek 	WDCDEBUG_PRINT(("edmcaclose\n"), DEBUG_FUNCS);
    419      1.1  jdolecek 	if ((error = ed_lock(wd)) != 0)
    420      1.1  jdolecek 		return error;
    421      1.1  jdolecek 
    422      1.1  jdolecek 	switch (fmt) {
    423      1.1  jdolecek 	case S_IFCHR:
    424      1.1  jdolecek 		wd->sc_dk.dk_copenmask &= ~(1 << part);
    425      1.1  jdolecek 		break;
    426      1.1  jdolecek 	case S_IFBLK:
    427      1.1  jdolecek 		wd->sc_dk.dk_bopenmask &= ~(1 << part);
    428      1.1  jdolecek 		break;
    429      1.1  jdolecek 	}
    430      1.1  jdolecek 	wd->sc_dk.dk_openmask =
    431      1.1  jdolecek 	    wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
    432      1.1  jdolecek 
    433      1.1  jdolecek 	if (wd->sc_dk.dk_openmask == 0) {
    434      1.1  jdolecek #if 0
    435      1.1  jdolecek 		wd_flushcache(wd, AT_WAIT);
    436      1.1  jdolecek #endif
    437      1.1  jdolecek 		/* XXXX Must wait for I/O to complete! */
    438      1.1  jdolecek 
    439      1.1  jdolecek 		if (! (wd->sc_flags & WDF_KLABEL))
    440      1.1  jdolecek 			wd->sc_flags &= ~WDF_LOADED;
    441      1.1  jdolecek 	}
    442      1.1  jdolecek 
    443      1.1  jdolecek 	ed_unlock(wd);
    444      1.1  jdolecek 
    445      1.1  jdolecek 	return 0;
    446      1.1  jdolecek }
    447      1.1  jdolecek 
    448      1.1  jdolecek static void
    449  1.7.4.2   thorpej edgetdefaultlabel(ed, lp)
    450  1.7.4.2   thorpej 	struct ed_softc *ed;
    451      1.1  jdolecek 	struct disklabel *lp;
    452      1.1  jdolecek {
    453      1.1  jdolecek 	WDCDEBUG_PRINT(("edgetdefaultlabel\n"), DEBUG_FUNCS);
    454      1.1  jdolecek 	memset(lp, 0, sizeof(struct disklabel));
    455      1.1  jdolecek 
    456      1.1  jdolecek 	lp->d_secsize = DEV_BSIZE;
    457  1.7.4.2   thorpej 	lp->d_ntracks = ed->heads;
    458  1.7.4.2   thorpej 	lp->d_nsectors = ed->sectors;
    459  1.7.4.2   thorpej 	lp->d_ncylinders = ed->cyl;
    460      1.1  jdolecek 	lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
    461      1.1  jdolecek 
    462      1.1  jdolecek 	lp->d_type = DTYPE_ESDI;
    463      1.1  jdolecek 
    464      1.1  jdolecek 	strncpy(lp->d_typename, "ESDI", 16);
    465      1.1  jdolecek 	strncpy(lp->d_packname, "fictitious", 16);
    466  1.7.4.2   thorpej 	lp->d_secperunit = ed->sc_capacity;
    467      1.1  jdolecek 	lp->d_rpm = 3600;
    468      1.1  jdolecek 	lp->d_interleave = 1;
    469      1.1  jdolecek 	lp->d_flags = 0;
    470      1.1  jdolecek 
    471      1.1  jdolecek 	lp->d_partitions[RAW_PART].p_offset = 0;
    472      1.1  jdolecek 	lp->d_partitions[RAW_PART].p_size =
    473      1.1  jdolecek 	lp->d_secperunit * (lp->d_secsize / DEV_BSIZE);
    474      1.1  jdolecek 	lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
    475      1.1  jdolecek 	lp->d_npartitions = RAW_PART + 1;
    476      1.1  jdolecek 
    477      1.1  jdolecek 	lp->d_magic = DISKMAGIC;
    478      1.1  jdolecek 	lp->d_magic2 = DISKMAGIC;
    479      1.1  jdolecek 	lp->d_checksum = dkcksum(lp);
    480      1.1  jdolecek }
    481      1.1  jdolecek 
    482      1.1  jdolecek /*
    483      1.1  jdolecek  * Fabricate a default disk label, and try to read the correct one.
    484      1.1  jdolecek  */
    485      1.1  jdolecek static void
    486  1.7.4.2   thorpej edgetdisklabel(dev, ed)
    487  1.7.4.2   thorpej 	dev_t dev;
    488  1.7.4.2   thorpej 	struct ed_softc *ed;
    489      1.1  jdolecek {
    490  1.7.4.2   thorpej 	struct disklabel *lp = ed->sc_dk.dk_label;
    491      1.1  jdolecek 	char *errstring;
    492      1.1  jdolecek 
    493      1.1  jdolecek 	WDCDEBUG_PRINT(("edgetdisklabel\n"), DEBUG_FUNCS);
    494      1.1  jdolecek 
    495  1.7.4.2   thorpej 	memset(ed->sc_dk.dk_cpulabel, 0, sizeof(struct cpu_disklabel));
    496      1.1  jdolecek 
    497  1.7.4.2   thorpej 	edgetdefaultlabel(ed, lp);
    498      1.1  jdolecek 
    499  1.7.4.2   thorpej 	errstring = readdisklabel(
    500  1.7.4.2   thorpej 	    EDLABELDEV(dev), edmcastrategy, lp, ed->sc_dk.dk_cpulabel);
    501      1.1  jdolecek 	if (errstring) {
    502      1.1  jdolecek 		/*
    503      1.1  jdolecek 		 * This probably happened because the drive's default
    504      1.1  jdolecek 		 * geometry doesn't match the DOS geometry.  We
    505      1.1  jdolecek 		 * assume the DOS geometry is now in the label and try
    506      1.1  jdolecek 		 * again.  XXX This is a kluge.
    507      1.1  jdolecek 		 */
    508      1.1  jdolecek #if 0
    509      1.1  jdolecek 		if (wd->drvp->state > RECAL)
    510      1.1  jdolecek 			wd->drvp->drive_flags |= DRIVE_RESET;
    511      1.1  jdolecek #endif
    512  1.7.4.2   thorpej 		errstring = readdisklabel(EDLABELDEV(dev),
    513  1.7.4.2   thorpej 			edmcastrategy, lp, ed->sc_dk.dk_cpulabel);
    514      1.1  jdolecek 	}
    515      1.1  jdolecek 	if (errstring) {
    516  1.7.4.2   thorpej 		printf("%s: %s\n", ed->sc_dev.dv_xname, errstring);
    517      1.1  jdolecek 		return;
    518      1.1  jdolecek 	}
    519      1.1  jdolecek }
    520      1.1  jdolecek 
    521      1.1  jdolecek int
    522      1.1  jdolecek edmcaioctl(dev, xfer, addr, flag, p)
    523      1.1  jdolecek 	dev_t dev;
    524      1.1  jdolecek 	u_long xfer;
    525      1.1  jdolecek 	caddr_t addr;
    526      1.1  jdolecek 	int flag;
    527      1.1  jdolecek 	struct proc *p;
    528      1.1  jdolecek {
    529  1.7.4.2   thorpej 	struct ed_softc *ed = device_lookup(&ed_cd, DISKUNIT(dev));
    530      1.1  jdolecek 	int error;
    531      1.1  jdolecek 
    532      1.3  jdolecek 	WDCDEBUG_PRINT(("edioctl\n"), DEBUG_FUNCS);
    533      1.1  jdolecek 
    534  1.7.4.2   thorpej 	if ((ed->sc_flags & WDF_LOADED) == 0)
    535      1.1  jdolecek 		return EIO;
    536      1.1  jdolecek 
    537      1.1  jdolecek 	switch (xfer) {
    538      1.1  jdolecek 	case DIOCGDINFO:
    539  1.7.4.2   thorpej 		*(struct disklabel *)addr = *(ed->sc_dk.dk_label);
    540      1.1  jdolecek 		return 0;
    541      1.1  jdolecek 
    542      1.1  jdolecek 	case DIOCGPART:
    543  1.7.4.2   thorpej 		((struct partinfo *)addr)->disklab = ed->sc_dk.dk_label;
    544      1.1  jdolecek 		((struct partinfo *)addr)->part =
    545  1.7.4.2   thorpej 		    &ed->sc_dk.dk_label->d_partitions[DISKPART(dev)];
    546      1.1  jdolecek 		return 0;
    547  1.7.4.1   thorpej 
    548      1.1  jdolecek 	case DIOCWDINFO:
    549      1.1  jdolecek 	case DIOCSDINFO:
    550      1.1  jdolecek 	{
    551      1.1  jdolecek 		struct disklabel *lp;
    552      1.1  jdolecek 
    553      1.1  jdolecek 		lp = (struct disklabel *)addr;
    554      1.1  jdolecek 
    555      1.1  jdolecek 		if ((flag & FWRITE) == 0)
    556      1.1  jdolecek 			return EBADF;
    557      1.1  jdolecek 
    558  1.7.4.2   thorpej 		if ((error = ed_lock(ed)) != 0)
    559      1.1  jdolecek 			return error;
    560  1.7.4.2   thorpej 		ed->sc_flags |= WDF_LABELLING;
    561      1.1  jdolecek 
    562  1.7.4.2   thorpej 		error = setdisklabel(ed->sc_dk.dk_label,
    563      1.1  jdolecek 		    lp, /*wd->sc_dk.dk_openmask : */0,
    564  1.7.4.2   thorpej 		    ed->sc_dk.dk_cpulabel);
    565      1.1  jdolecek 		if (error == 0) {
    566      1.1  jdolecek #if 0
    567      1.1  jdolecek 			if (wd->drvp->state > RECAL)
    568      1.1  jdolecek 				wd->drvp->drive_flags |= DRIVE_RESET;
    569      1.1  jdolecek #endif
    570  1.7.4.2   thorpej 			if (xfer == DIOCWDINFO)
    571      1.1  jdolecek 				error = writedisklabel(EDLABELDEV(dev),
    572  1.7.4.2   thorpej 				    edmcastrategy, ed->sc_dk.dk_label,
    573  1.7.4.2   thorpej 				    ed->sc_dk.dk_cpulabel);
    574      1.1  jdolecek 		}
    575      1.1  jdolecek 
    576  1.7.4.2   thorpej 		ed->sc_flags &= ~WDF_LABELLING;
    577  1.7.4.2   thorpej 		ed_unlock(ed);
    578  1.7.4.2   thorpej 		return (error);
    579      1.1  jdolecek 	}
    580      1.1  jdolecek 
    581      1.1  jdolecek 	case DIOCKLABEL:
    582      1.1  jdolecek 		if (*(int *)addr)
    583  1.7.4.2   thorpej 			ed->sc_flags |= WDF_KLABEL;
    584      1.1  jdolecek 		else
    585  1.7.4.2   thorpej 			ed->sc_flags &= ~WDF_KLABEL;
    586      1.1  jdolecek 		return 0;
    587  1.7.4.1   thorpej 
    588      1.1  jdolecek 	case DIOCWLABEL:
    589      1.1  jdolecek 		if ((flag & FWRITE) == 0)
    590      1.1  jdolecek 			return EBADF;
    591      1.1  jdolecek 		if (*(int *)addr)
    592  1.7.4.2   thorpej 			ed->sc_flags |= WDF_WLABEL;
    593      1.1  jdolecek 		else
    594  1.7.4.2   thorpej 			ed->sc_flags &= ~WDF_WLABEL;
    595      1.1  jdolecek 		return 0;
    596      1.1  jdolecek 
    597      1.1  jdolecek 	case DIOCGDEFLABEL:
    598  1.7.4.2   thorpej 		edgetdefaultlabel(ed, (struct disklabel *)addr);
    599      1.1  jdolecek 		return 0;
    600      1.1  jdolecek 
    601  1.7.4.2   thorpej #if 0
    602      1.1  jdolecek 	case DIOCWFORMAT:
    603      1.1  jdolecek 		if ((flag & FWRITE) == 0)
    604      1.1  jdolecek 			return EBADF;
    605      1.1  jdolecek 		{
    606      1.1  jdolecek 		register struct format_op *fop;
    607      1.1  jdolecek 		struct iovec aiov;
    608      1.1  jdolecek 		struct uio auio;
    609  1.7.4.1   thorpej 
    610      1.1  jdolecek 		fop = (struct format_op *)addr;
    611      1.1  jdolecek 		aiov.iov_base = fop->df_buf;
    612      1.1  jdolecek 		aiov.iov_len = fop->df_count;
    613      1.1  jdolecek 		auio.uio_iov = &aiov;
    614      1.1  jdolecek 		auio.uio_iovcnt = 1;
    615      1.1  jdolecek 		auio.uio_resid = fop->df_count;
    616      1.1  jdolecek 		auio.uio_segflg = 0;
    617      1.1  jdolecek 		auio.uio_offset =
    618      1.1  jdolecek 			fop->df_startblk * wd->sc_dk.dk_label->d_secsize;
    619      1.1  jdolecek 		auio.uio_procp = p;
    620      1.1  jdolecek 		error = physio(wdformat, NULL, dev, B_WRITE, minphys,
    621      1.1  jdolecek 		    &auio);
    622      1.1  jdolecek 		fop->df_count -= auio.uio_resid;
    623      1.1  jdolecek 		fop->df_reg[0] = wdc->sc_status;
    624      1.1  jdolecek 		fop->df_reg[1] = wdc->sc_error;
    625      1.1  jdolecek 		return error;
    626      1.1  jdolecek 		}
    627      1.1  jdolecek #endif
    628      1.1  jdolecek 
    629      1.1  jdolecek 	default:
    630      1.1  jdolecek 		return ENOTTY;
    631      1.1  jdolecek 	}
    632      1.1  jdolecek 
    633      1.1  jdolecek #ifdef DIAGNOSTIC
    634      1.3  jdolecek 	panic("edioctl: impossible");
    635      1.1  jdolecek #endif
    636      1.1  jdolecek }
    637      1.1  jdolecek 
    638      1.1  jdolecek int
    639      1.1  jdolecek edmcasize(dev)
    640      1.1  jdolecek 	dev_t dev;
    641      1.1  jdolecek {
    642      1.1  jdolecek 	struct ed_softc *wd;
    643      1.1  jdolecek 	int part, omask;
    644      1.1  jdolecek 	int size;
    645      1.1  jdolecek 
    646      1.1  jdolecek 	WDCDEBUG_PRINT(("edsize\n"), DEBUG_FUNCS);
    647      1.1  jdolecek 
    648      1.1  jdolecek 	wd = device_lookup(&ed_cd, DISKUNIT(dev));
    649      1.1  jdolecek 	if (wd == NULL)
    650      1.1  jdolecek 		return (-1);
    651      1.1  jdolecek 
    652      1.1  jdolecek 	part = DISKPART(dev);
    653      1.1  jdolecek 	omask = wd->sc_dk.dk_openmask & (1 << part);
    654      1.1  jdolecek 
    655      1.1  jdolecek 	if (omask == 0 && edmcaopen(dev, 0, S_IFBLK, NULL) != 0)
    656      1.1  jdolecek 		return (-1);
    657      1.1  jdolecek 	if (wd->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
    658      1.1  jdolecek 		size = -1;
    659      1.1  jdolecek 	else
    660      1.1  jdolecek 		size = wd->sc_dk.dk_label->d_partitions[part].p_size *
    661      1.1  jdolecek 		    (wd->sc_dk.dk_label->d_secsize / DEV_BSIZE);
    662      1.1  jdolecek 	if (omask == 0 && edmcaclose(dev, 0, S_IFBLK, NULL) != 0)
    663      1.1  jdolecek 		return (-1);
    664      1.1  jdolecek 	return (size);
    665      1.1  jdolecek }
    666      1.1  jdolecek 
    667      1.1  jdolecek /* #define WD_DUMP_NOT_TRUSTED if you just want to watch */
    668      1.6  jdolecek static int eddoingadump = 0;
    669      1.6  jdolecek static int eddumprecalibrated = 0;
    670      1.6  jdolecek static int eddumpmulti = 1;
    671      1.1  jdolecek 
    672      1.1  jdolecek /*
    673      1.1  jdolecek  * Dump core after a system crash.
    674      1.1  jdolecek  */
    675      1.1  jdolecek int
    676      1.1  jdolecek edmcadump(dev, blkno, va, size)
    677      1.1  jdolecek 	dev_t dev;
    678      1.1  jdolecek 	daddr_t blkno;
    679      1.1  jdolecek 	caddr_t va;
    680      1.1  jdolecek 	size_t size;
    681      1.1  jdolecek {
    682      1.6  jdolecek 	struct ed_softc *ed;	/* disk unit to do the I/O */
    683      1.1  jdolecek 	struct disklabel *lp;   /* disk's disklabel */
    684      1.7  jdolecek 	int part;
    685      1.1  jdolecek 	int nblks;	/* total number of sectors left to write */
    686  1.7.4.2   thorpej 	int error;
    687      1.1  jdolecek 
    688      1.1  jdolecek 	/* Check if recursive dump; if so, punt. */
    689      1.6  jdolecek 	if (eddoingadump)
    690      1.1  jdolecek 		return EFAULT;
    691      1.6  jdolecek 	eddoingadump = 1;
    692      1.1  jdolecek 
    693      1.6  jdolecek 	ed = device_lookup(&ed_cd, DISKUNIT(dev));
    694      1.6  jdolecek 	if (ed == NULL)
    695      1.1  jdolecek 		return (ENXIO);
    696      1.1  jdolecek 
    697      1.1  jdolecek 	part = DISKPART(dev);
    698      1.1  jdolecek 
    699      1.1  jdolecek 	/* Make sure it was initialized. */
    700      1.6  jdolecek 	if ((ed->sc_flags & EDF_INIT) == 0)
    701      1.1  jdolecek 		return ENXIO;
    702      1.1  jdolecek 
    703      1.1  jdolecek 	/* Convert to disk sectors.  Request must be a multiple of size. */
    704      1.6  jdolecek 	lp = ed->sc_dk.dk_label;
    705      1.1  jdolecek 	if ((size % lp->d_secsize) != 0)
    706      1.1  jdolecek 		return EFAULT;
    707      1.1  jdolecek 	nblks = size / lp->d_secsize;
    708      1.1  jdolecek 	blkno = blkno / (lp->d_secsize / DEV_BSIZE);
    709      1.1  jdolecek 
    710      1.1  jdolecek 	/* Check transfer bounds against partition size. */
    711      1.1  jdolecek 	if ((blkno < 0) || ((blkno + nblks) > lp->d_partitions[part].p_size))
    712  1.7.4.1   thorpej 		return EINVAL;
    713      1.1  jdolecek 
    714      1.1  jdolecek 	/* Offset block number to start of partition. */
    715      1.1  jdolecek 	blkno += lp->d_partitions[part].p_offset;
    716      1.1  jdolecek 
    717      1.1  jdolecek 	/* Recalibrate, if first dump transfer. */
    718      1.6  jdolecek 	if (eddumprecalibrated == 0) {
    719      1.6  jdolecek 		eddumprecalibrated = 1;
    720      1.6  jdolecek 		eddumpmulti = 8;
    721      1.1  jdolecek #if 0
    722      1.1  jdolecek 		wd->drvp->state = RESET;
    723      1.1  jdolecek #endif
    724      1.1  jdolecek 	}
    725  1.7.4.1   thorpej 
    726      1.1  jdolecek 	while (nblks > 0) {
    727  1.7.4.2   thorpej 		error = edc_bio(ed->edc_softc, ed, va, blkno,
    728  1.7.4.2   thorpej 			min(nblks, eddumpmulti) * lp->d_secsize, 0, 1);
    729  1.7.4.2   thorpej 		if (error)
    730  1.7.4.2   thorpej 			return (error);
    731      1.1  jdolecek 
    732      1.1  jdolecek 		/* update block count */
    733      1.6  jdolecek 		nblks -= min(nblks, eddumpmulti);
    734      1.6  jdolecek 		blkno += min(nblks, eddumpmulti);
    735      1.6  jdolecek 		va += min(nblks, eddumpmulti) * lp->d_secsize;
    736      1.1  jdolecek 	}
    737      1.1  jdolecek 
    738      1.6  jdolecek 	eddoingadump = 0;
    739      1.6  jdolecek 	return (0);
    740      1.1  jdolecek }
    741      1.1  jdolecek 
    742      1.1  jdolecek static int
    743  1.7.4.2   thorpej ed_get_params(ed, drv_flags)
    744      1.1  jdolecek 	struct ed_softc *ed;
    745  1.7.4.2   thorpej 	int *drv_flags;
    746      1.1  jdolecek {
    747      1.1  jdolecek 	u_int16_t cmd_args[2];
    748      1.1  jdolecek 
    749      1.1  jdolecek 	/*
    750      1.1  jdolecek 	 * Get Device Configuration (09).
    751      1.1  jdolecek 	 */
    752      1.5  jdolecek 	cmd_args[0] = 14;	/* Options: 00s110, s: 0=Physical 1=Pseudo */
    753      1.1  jdolecek 	cmd_args[1] = 0;
    754      1.6  jdolecek 	if (edc_run_cmd(ed->edc_softc, CMD_GET_DEV_CONF, ed->sc_devno,
    755  1.7.4.2   thorpej 	    cmd_args, 2, 1))
    756      1.1  jdolecek 		return (1);
    757      1.1  jdolecek 
    758  1.7.4.2   thorpej 	ed->spares = ed->sense_data[1] >> 8;
    759  1.7.4.2   thorpej 	if (drv_flags)
    760  1.7.4.2   thorpej 		*drv_flags = ed->sense_data[1] & 0x1f;
    761  1.7.4.2   thorpej 	ed->rba = ed->sense_data[2] | (ed->sense_data[3] << 16);
    762      1.1  jdolecek 	/* Instead of using:
    763  1.7.4.2   thorpej 		ed->cyl = ed->sense_data[4];
    764  1.7.4.2   thorpej 		ed->heads = ed->sense_data[5] & 0xff;
    765  1.7.4.2   thorpej 		ed->sectors = ed->sense_data[5] >> 8;
    766      1.1  jdolecek 	 * we fabricate the numbers from RBA count, so that
    767      1.1  jdolecek 	 * number of sectors is 32 and heads 64. This seems
    768      1.1  jdolecek 	 * to be necessary for integrated ESDI controller.
    769      1.1  jdolecek 	 */
    770      1.1  jdolecek 	ed->sectors = 32;
    771      1.1  jdolecek 	ed->heads = 64;
    772      1.1  jdolecek 	ed->cyl = ed->rba / (ed->heads * ed->sectors);
    773      1.1  jdolecek 	ed->sc_capacity = ed->rba;
    774      1.1  jdolecek 
    775      1.1  jdolecek 	return (0);
    776      1.1  jdolecek }
    777