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