Home | History | Annotate | Line # | Download | only in qbus
rl.c revision 1.40
      1  1.40      yamt /*	$NetBSD: rl.c,v 1.40 2009/01/13 13:35:53 yamt Exp $	*/
      2   1.1     ragge 
      3   1.1     ragge /*
      4   1.1     ragge  * Copyright (c) 2000 Ludd, University of Lule}, Sweden. All rights reserved.
      5   1.1     ragge  *
      6   1.1     ragge  * Redistribution and use in source and binary forms, with or without
      7   1.1     ragge  * modification, are permitted provided that the following conditions
      8   1.1     ragge  * are met:
      9   1.1     ragge  * 1. Redistributions of source code must retain the above copyright
     10   1.1     ragge  *    notice, this list of conditions and the following disclaimer.
     11   1.1     ragge  * 2. Redistributions in binary form must reproduce the above copyright
     12   1.1     ragge  *    notice, this list of conditions and the following disclaimer in the
     13   1.1     ragge  *    documentation and/or other materials provided with the distribution.
     14   1.1     ragge  * 3. All advertising materials mentioning features or use of this software
     15   1.1     ragge  *    must display the following acknowledgement:
     16  1.24    simonb  *      This product includes software developed at Ludd, University of
     17   1.1     ragge  *      Lule}, Sweden and its contributors.
     18   1.1     ragge  * 4. The name of the author may not be used to endorse or promote products
     19   1.1     ragge  *    derived from this software without specific prior written permission
     20   1.1     ragge  *
     21   1.1     ragge  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     22   1.1     ragge  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     23   1.1     ragge  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     24   1.1     ragge  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     25   1.1     ragge  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     26   1.1     ragge  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     27   1.1     ragge  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     28   1.1     ragge  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     29   1.1     ragge  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     30   1.1     ragge  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     31   1.1     ragge  */
     32   1.1     ragge 
     33   1.1     ragge /*
     34   1.1     ragge  * RL11/RLV11/RLV12 disk controller driver and
     35   1.1     ragge  * RL01/RL02 disk device driver.
     36   1.1     ragge  *
     37   1.1     ragge  * TODO:
     38   1.1     ragge  *	Handle disk errors more gracefully
     39   1.1     ragge  *	Do overlapping seeks on multiple drives
     40   1.1     ragge  *
     41   1.1     ragge  * Implementation comments:
     42  1.24    simonb  *
     43   1.1     ragge  */
     44  1.10     lukem 
     45  1.10     lukem #include <sys/cdefs.h>
     46  1.40      yamt __KERNEL_RCSID(0, "$NetBSD: rl.c,v 1.40 2009/01/13 13:35:53 yamt Exp $");
     47   1.1     ragge 
     48   1.1     ragge #include <sys/param.h>
     49   1.1     ragge #include <sys/device.h>
     50   1.1     ragge #include <sys/systm.h>
     51   1.1     ragge #include <sys/conf.h>
     52   1.1     ragge #include <sys/disk.h>
     53   1.1     ragge #include <sys/disklabel.h>
     54   1.1     ragge #include <sys/buf.h>
     55  1.23      yamt #include <sys/bufq.h>
     56   1.1     ragge #include <sys/stat.h>
     57   1.1     ragge #include <sys/dkio.h>
     58   1.1     ragge #include <sys/fcntl.h>
     59  1.17  jdolecek #include <sys/event.h>
     60   1.1     ragge 
     61   1.1     ragge #include <ufs/ufs/dinode.h>
     62   1.1     ragge #include <ufs/ffs/fs.h>
     63   1.1     ragge 
     64  1.37        ad #include <sys/bus.h>
     65   1.1     ragge 
     66   1.1     ragge #include <dev/qbus/ubavar.h>
     67   1.1     ragge #include <dev/qbus/rlreg.h>
     68  1.11     ragge #include <dev/qbus/rlvar.h>
     69   1.1     ragge 
     70   1.1     ragge #include "ioconf.h"
     71   1.1     ragge #include "locators.h"
     72   1.1     ragge 
     73  1.38      matt static	int rlcmatch(device_t, cfdata_t, void *);
     74  1.38      matt static	void rlcattach(device_t, device_t, void *);
     75   1.1     ragge static	int rlcprint(void *, const char *);
     76   1.1     ragge static	void rlcintr(void *);
     77  1.38      matt static	int rlmatch(device_t, cfdata_t, void *);
     78  1.38      matt static	void rlattach(device_t, device_t, void *);
     79   1.1     ragge static	void rlcstart(struct rlc_softc *, struct buf *);
     80   1.1     ragge static	void waitcrdy(struct rlc_softc *);
     81  1.38      matt static	void rlcreset(device_t);
     82   1.1     ragge 
     83  1.38      matt CFATTACH_DECL_NEW(rlc, sizeof(struct rlc_softc),
     84  1.16   thorpej     rlcmatch, rlcattach, NULL, NULL);
     85  1.15   thorpej 
     86  1.38      matt CFATTACH_DECL_NEW(rl, sizeof(struct rl_softc),
     87  1.16   thorpej     rlmatch, rlattach, NULL, NULL);
     88   1.1     ragge 
     89  1.38      matt static dev_type_open(rlopen);
     90  1.38      matt static dev_type_close(rlclose);
     91  1.38      matt static dev_type_read(rlread);
     92  1.38      matt static dev_type_write(rlwrite);
     93  1.38      matt static dev_type_ioctl(rlioctl);
     94  1.38      matt static dev_type_strategy(rlstrategy);
     95  1.38      matt static dev_type_dump(rldump);
     96  1.38      matt static dev_type_size(rlpsize);
     97  1.13   gehenna 
     98  1.13   gehenna const struct bdevsw rl_bdevsw = {
     99  1.38      matt 	rlopen, rlclose, rlstrategy, rlioctl, rldump, rlpsize, D_DISK
    100  1.13   gehenna };
    101  1.13   gehenna 
    102  1.13   gehenna const struct cdevsw rl_cdevsw = {
    103  1.13   gehenna 	rlopen, rlclose, rlread, rlwrite, rlioctl,
    104  1.17  jdolecek 	nostop, notty, nopoll, nommap, nokqfilter, D_DISK
    105  1.13   gehenna };
    106  1.13   gehenna 
    107   1.1     ragge #define	MAXRLXFER (RL_BPS * RL_SPT)
    108   1.1     ragge 
    109   1.1     ragge #define	RL_WREG(reg, val) \
    110   1.1     ragge 	bus_space_write_2(sc->sc_iot, sc->sc_ioh, (reg), (val))
    111   1.1     ragge #define RL_RREG(reg) \
    112   1.1     ragge 	bus_space_read_2(sc->sc_iot, sc->sc_ioh, (reg))
    113   1.1     ragge 
    114  1.38      matt static const char * const rlstates[] = {
    115  1.11     ragge 	"drive not loaded",
    116  1.11     ragge 	"drive spinning up",
    117  1.11     ragge 	"drive brushes out",
    118  1.11     ragge 	"drive loading heads",
    119  1.11     ragge 	"drive seeking",
    120  1.11     ragge 	"drive ready",
    121  1.11     ragge 	"drive unloading heads",
    122  1.11     ragge 	"drive spun down",
    123  1.11     ragge };
    124  1.11     ragge 
    125  1.38      matt static const struct dkdriver rldkdriver = {
    126  1.22   thorpej 	rlstrategy, minphys
    127  1.22   thorpej };
    128  1.22   thorpej 
    129  1.25     ragge static const char *
    130  1.11     ragge rlstate(struct rlc_softc *sc, int unit)
    131  1.11     ragge {
    132  1.11     ragge 	int i = 0;
    133  1.11     ragge 
    134  1.11     ragge 	do {
    135  1.11     ragge 		RL_WREG(RL_DA, RLDA_GS);
    136  1.11     ragge 		RL_WREG(RL_CS, RLCS_GS|(unit << RLCS_USHFT));
    137  1.11     ragge 		waitcrdy(sc);
    138  1.11     ragge 	} while (((RL_RREG(RL_CS) & RLCS_ERR) != 0) && i++ < 10);
    139  1.11     ragge 	if (i == 10)
    140  1.11     ragge 		return NULL;
    141  1.11     ragge 	i = RL_RREG(RL_MP) & RLMP_STATUS;
    142  1.11     ragge 	return rlstates[i];
    143  1.11     ragge }
    144  1.11     ragge 
    145   1.1     ragge void
    146   1.1     ragge waitcrdy(struct rlc_softc *sc)
    147   1.1     ragge {
    148   1.1     ragge 	int i;
    149   1.1     ragge 
    150   1.1     ragge 	for (i = 0; i < 1000; i++) {
    151   1.1     ragge 		DELAY(10000);
    152   1.1     ragge 		if (RL_RREG(RL_CS) & RLCS_CRDY)
    153   1.1     ragge 			return;
    154   1.1     ragge 	}
    155  1.38      matt 	aprint_error_dev(sc->sc_dev, "never got ready\n"); /* ?panic? */
    156   1.1     ragge }
    157   1.1     ragge 
    158   1.1     ragge int
    159   1.1     ragge rlcprint(void *aux, const char *name)
    160   1.1     ragge {
    161   1.1     ragge 	struct rlc_attach_args *ra = aux;
    162   1.1     ragge 
    163   1.1     ragge 	if (name)
    164  1.18   thorpej 		aprint_normal("RL0%d at %s",
    165  1.18   thorpej 		    ra->type & RLMP_DT ? '2' : '1', name);
    166  1.18   thorpej 	aprint_normal(" drive %d", ra->hwid);
    167   1.1     ragge 	return UNCONF;
    168   1.1     ragge }
    169   1.1     ragge 
    170   1.1     ragge /*
    171   1.1     ragge  * Force the controller to interrupt.
    172   1.1     ragge  */
    173   1.1     ragge int
    174  1.38      matt rlcmatch(device_t parent, cfdata_t cf, void *aux)
    175   1.1     ragge {
    176   1.1     ragge 	struct uba_attach_args *ua = aux;
    177   1.1     ragge 	struct rlc_softc ssc, *sc = &ssc;
    178   1.1     ragge 	int i;
    179   1.1     ragge 
    180   1.1     ragge 	sc->sc_iot = ua->ua_iot;
    181   1.1     ragge 	sc->sc_ioh = ua->ua_ioh;
    182   1.1     ragge 	/* Force interrupt by issuing a "Get Status" command */
    183   1.1     ragge 	RL_WREG(RL_DA, RLDA_GS);
    184   1.1     ragge 	RL_WREG(RL_CS, RLCS_GS|RLCS_IE);
    185   1.1     ragge 
    186   1.1     ragge 	for (i = 0; i < 100; i++) {
    187   1.1     ragge 		DELAY(100000);
    188   1.1     ragge 		if (RL_RREG(RL_CS) & RLCS_CRDY)
    189   1.1     ragge 			return 1;
    190   1.1     ragge 	}
    191   1.1     ragge 	return 0;
    192   1.1     ragge }
    193   1.1     ragge 
    194   1.1     ragge void
    195  1.38      matt rlcattach(device_t parent, device_t self, void *aux)
    196   1.1     ragge {
    197  1.30   thorpej 	struct rlc_softc *sc = device_private(self);
    198   1.1     ragge 	struct uba_attach_args *ua = aux;
    199   1.1     ragge 	struct rlc_attach_args ra;
    200   1.1     ragge 	int i, error;
    201   1.1     ragge 
    202  1.38      matt 	sc->sc_dev = self;
    203  1.38      matt 	sc->sc_uh = device_private(parent);
    204   1.1     ragge 	sc->sc_iot = ua->ua_iot;
    205   1.1     ragge 	sc->sc_ioh = ua->ua_ioh;
    206   1.1     ragge 	sc->sc_dmat = ua->ua_dmat;
    207   1.4      matt 	uba_intr_establish(ua->ua_icookie, ua->ua_cvec,
    208   1.4      matt 		rlcintr, sc, &sc->sc_intrcnt);
    209   1.5      matt 	evcnt_attach_dynamic(&sc->sc_intrcnt, EVCNT_TYPE_INTR, ua->ua_evcnt,
    210  1.38      matt 		device_xname(sc->sc_dev), "intr");
    211  1.11     ragge 	uba_reset_establish(rlcreset, self);
    212  1.11     ragge 
    213   1.1     ragge 	printf("\n");
    214   1.1     ragge 
    215   1.1     ragge 	/*
    216  1.24    simonb 	 * The RL11 can only have one transfer going at a time,
    217   1.1     ragge 	 * and max transfer size is one track, so only one dmamap
    218   1.1     ragge 	 * is needed.
    219   1.1     ragge 	 */
    220   1.1     ragge 	error = bus_dmamap_create(sc->sc_dmat, MAXRLXFER, 1, MAXRLXFER, 0,
    221   1.1     ragge 	    BUS_DMA_ALLOCNOW, &sc->sc_dmam);
    222   1.1     ragge 	if (error) {
    223  1.38      matt 		aprint_error(": Failed to allocate DMA map, error %d\n", error);
    224   1.1     ragge 		return;
    225   1.1     ragge 	}
    226  1.26      yamt 	bufq_alloc(&sc->sc_q, "disksort", BUFQ_SORT_CYLINDER);
    227   1.1     ragge 	for (i = 0; i < RL_MAXDPC; i++) {
    228   1.1     ragge 		waitcrdy(sc);
    229   1.1     ragge 		RL_WREG(RL_DA, RLDA_GS|RLDA_RST);
    230   1.1     ragge 		RL_WREG(RL_CS, RLCS_GS|(i << RLCS_USHFT));
    231   1.1     ragge 		waitcrdy(sc);
    232   1.1     ragge 		ra.type = RL_RREG(RL_MP);
    233   1.1     ragge 		ra.hwid = i;
    234   1.1     ragge 		if ((RL_RREG(RL_CS) & RLCS_ERR) == 0)
    235  1.38      matt 			config_found(sc->sc_dev, &ra, rlcprint);
    236   1.1     ragge 	}
    237   1.1     ragge }
    238   1.1     ragge 
    239   1.1     ragge int
    240  1.38      matt rlmatch(device_t parent, cfdata_t cf, void *aux)
    241   1.1     ragge {
    242   1.1     ragge 	struct rlc_attach_args *ra = aux;
    243   1.1     ragge 
    244   1.1     ragge 	if (cf->cf_loc[RLCCF_DRIVE] != RLCCF_DRIVE_DEFAULT &&
    245   1.1     ragge 	    cf->cf_loc[RLCCF_DRIVE] != ra->hwid)
    246   1.1     ragge 		return 0;
    247   1.1     ragge 	return 1;
    248   1.1     ragge }
    249   1.1     ragge 
    250   1.1     ragge void
    251  1.38      matt rlattach(device_t parent, device_t self, void *aux)
    252   1.1     ragge {
    253  1.30   thorpej 	struct rl_softc *rc = device_private(self);
    254   1.1     ragge 	struct rlc_attach_args *ra = aux;
    255   1.1     ragge 	struct disklabel *dl;
    256   1.1     ragge 
    257  1.38      matt 	rc->rc_dev = self;
    258  1.38      matt 	rc->rc_rlc = device_private(parent);
    259   1.1     ragge 	rc->rc_hwid = ra->hwid;
    260  1.38      matt 	disk_init(&rc->rc_disk, device_xname(rc->rc_dev), &rldkdriver);
    261   1.1     ragge 	disk_attach(&rc->rc_disk);
    262   1.1     ragge 	dl = rc->rc_disk.dk_label;
    263   1.1     ragge 	dl->d_npartitions = 3;
    264   1.1     ragge 	strcpy(dl->d_typename, "RL01");
    265   1.1     ragge 	if (ra->type & RLMP_DT)
    266   1.1     ragge 		dl->d_typename[3] = '2';
    267   1.1     ragge 	dl->d_secsize = DEV_BSIZE; /* XXX - wrong, but OK for now */
    268   1.1     ragge 	dl->d_nsectors = RL_SPT/2;
    269   1.1     ragge 	dl->d_ntracks = RL_SPD;
    270   1.1     ragge 	dl->d_ncylinders = ra->type & RLMP_DT ? RL_TPS02 : RL_TPS01;
    271   1.1     ragge 	dl->d_secpercyl = dl->d_nsectors * dl->d_ntracks;
    272   1.1     ragge 	dl->d_secperunit = dl->d_ncylinders * dl->d_secpercyl;
    273   1.1     ragge 	dl->d_partitions[0].p_size = dl->d_partitions[2].p_size =
    274   1.1     ragge 	    dl->d_secperunit;
    275   1.1     ragge 	dl->d_partitions[0].p_offset = dl->d_partitions[2].p_offset = 0;
    276   1.1     ragge 	dl->d_interleave = dl->d_headswitch = 1;
    277   1.1     ragge 	dl->d_bbsize = BBSIZE;
    278  1.19        he 	dl->d_sbsize = SBLOCKSIZE;
    279   1.1     ragge 	dl->d_rpm = 2400;
    280   1.1     ragge 	dl->d_type = DTYPE_DEC;
    281  1.38      matt 	printf(": %s, %s\n", dl->d_typename, rlstate(rc->rc_rlc, ra->hwid));
    282  1.22   thorpej 
    283  1.22   thorpej 	/*
    284  1.22   thorpej 	 * XXX We should try to discovery wedges here, but
    285  1.22   thorpej 	 * XXX that would mean loading up the pack and being
    286  1.22   thorpej 	 * XXX able to do I/O.  Should use config_defer() here.
    287  1.22   thorpej 	 */
    288   1.1     ragge }
    289   1.1     ragge 
    290   1.1     ragge int
    291  1.27  christos rlopen(dev_t dev, int flag, int fmt, struct lwp *l)
    292   1.1     ragge {
    293  1.38      matt 	struct rl_softc * const rc = device_lookup_private(&rl_cd, DISKUNIT(dev));
    294  1.38      matt 	struct rlc_softc *sc;
    295  1.38      matt 	int error, part, mask;
    296   1.1     ragge 	struct disklabel *dl;
    297  1.20       dsl 	const char *msg;
    298  1.11     ragge 
    299   1.1     ragge 	/*
    300   1.1     ragge 	 * Make sure this is a reasonable open request.
    301   1.1     ragge 	 */
    302  1.38      matt 	if (rc == NULL)
    303   1.1     ragge 		return ENXIO;
    304   1.1     ragge 
    305  1.38      matt 	sc = rc->rc_rlc;
    306  1.22   thorpej 	part = DISKPART(dev);
    307  1.22   thorpej 
    308  1.34        ad 	mutex_enter(&rc->rc_disk.dk_openlock);
    309  1.22   thorpej 
    310  1.22   thorpej 	/*
    311  1.22   thorpej 	 * If there are wedges, and this is not RAW_PART, then we
    312  1.22   thorpej 	 * need to fail.
    313  1.22   thorpej 	 */
    314  1.22   thorpej 	if (rc->rc_disk.dk_nwedges != 0 && part != RAW_PART) {
    315  1.22   thorpej 		error = EBUSY;
    316  1.22   thorpej 		goto bad1;
    317  1.22   thorpej 	}
    318  1.22   thorpej 
    319  1.11     ragge 	/* Check that the disk actually is useable */
    320  1.11     ragge 	msg = rlstate(sc, rc->rc_hwid);
    321  1.11     ragge 	if (msg == NULL || msg == rlstates[RLMP_UNLOAD] ||
    322  1.22   thorpej 	    msg == rlstates[RLMP_SPUNDOWN]) {
    323  1.22   thorpej 		error = ENXIO;
    324  1.22   thorpej 		goto bad1;
    325  1.22   thorpej 	}
    326   1.1     ragge 	/*
    327   1.1     ragge 	 * If this is the first open; read in where on the disk we are.
    328   1.1     ragge 	 */
    329   1.1     ragge 	dl = rc->rc_disk.dk_label;
    330   1.1     ragge 	if (rc->rc_state == DK_CLOSED) {
    331   1.1     ragge 		u_int16_t mp;
    332  1.13   gehenna 		int maj;
    333   1.1     ragge 		RL_WREG(RL_CS, RLCS_RHDR|(rc->rc_hwid << RLCS_USHFT));
    334   1.1     ragge 		waitcrdy(sc);
    335   1.1     ragge 		mp = RL_RREG(RL_MP);
    336   1.1     ragge 		rc->rc_head = ((mp & RLMP_HS) == RLMP_HS);
    337   1.1     ragge 		rc->rc_cyl = (mp >> 7) & 0777;
    338   1.1     ragge 		rc->rc_state = DK_OPEN;
    339   1.1     ragge 		/* Get disk label */
    340  1.13   gehenna 		maj = cdevsw_lookup_major(&rl_cdevsw);
    341  1.13   gehenna 		if ((msg = readdisklabel(MAKEDISKDEV(maj,
    342  1.38      matt 		    device_unit(rc->rc_dev), RAW_PART), rlstrategy, dl, NULL)))
    343  1.38      matt 			aprint_normal_dev(rc->rc_dev, "%s", msg);
    344  1.38      matt 		aprint_normal_dev(rc->rc_dev, "size %d sectors\n",
    345  1.38      matt 		    dl->d_secperunit);
    346   1.1     ragge 	}
    347  1.22   thorpej 	if (part >= dl->d_npartitions) {
    348  1.22   thorpej 		error = ENXIO;
    349  1.22   thorpej 		goto bad1;
    350  1.22   thorpej 	}
    351   1.1     ragge 
    352   1.1     ragge 	mask = 1 << part;
    353   1.1     ragge 	switch (fmt) {
    354   1.1     ragge 	case S_IFCHR:
    355   1.1     ragge 		rc->rc_disk.dk_copenmask |= mask;
    356   1.1     ragge 		break;
    357   1.1     ragge 	case S_IFBLK:
    358   1.1     ragge 		rc->rc_disk.dk_bopenmask |= mask;
    359   1.1     ragge 		break;
    360   1.1     ragge 	}
    361   1.1     ragge 	rc->rc_disk.dk_openmask |= mask;
    362  1.34        ad 	error = 0;
    363  1.22   thorpej  bad1:
    364  1.34        ad 	mutex_exit(&rc->rc_disk.dk_openlock);
    365  1.22   thorpej 	return (error);
    366   1.1     ragge }
    367   1.1     ragge 
    368   1.1     ragge int
    369  1.27  christos rlclose(dev_t dev, int flag, int fmt, struct lwp *l)
    370   1.1     ragge {
    371  1.34        ad 	int unit = DISKUNIT(dev);
    372  1.39  drochner 	struct rl_softc *rc = device_lookup_private(&rl_cd, unit);
    373   1.1     ragge 	int mask = (1 << DISKPART(dev));
    374   1.1     ragge 
    375  1.34        ad 	mutex_enter(&rc->rc_disk.dk_openlock);
    376  1.22   thorpej 
    377   1.1     ragge 	switch (fmt) {
    378   1.1     ragge 	case S_IFCHR:
    379   1.1     ragge 		rc->rc_disk.dk_copenmask &= ~mask;
    380   1.1     ragge 		break;
    381   1.1     ragge 	case S_IFBLK:
    382   1.1     ragge 		rc->rc_disk.dk_bopenmask &= ~mask;
    383   1.1     ragge 		break;
    384   1.1     ragge 	}
    385   1.1     ragge 	rc->rc_disk.dk_openmask =
    386   1.1     ragge 	    rc->rc_disk.dk_copenmask | rc->rc_disk.dk_bopenmask;
    387   1.1     ragge 
    388   1.1     ragge 	if (rc->rc_disk.dk_openmask == 0)
    389   1.1     ragge 		rc->rc_state = DK_CLOSED; /* May change pack */
    390  1.34        ad 	mutex_exit(&rc->rc_disk.dk_openlock);
    391   1.1     ragge 	return 0;
    392   1.1     ragge }
    393   1.1     ragge 
    394   1.1     ragge void
    395   1.1     ragge rlstrategy(struct buf *bp)
    396   1.1     ragge {
    397  1.38      matt 	struct rl_softc * const rc = device_lookup_private(&rl_cd, DISKUNIT(bp->b_dev));
    398   1.1     ragge 	struct disklabel *lp;
    399  1.38      matt 	int s;
    400  1.38      matt 
    401  1.38      matt 	if (rc == NULL || rc->rc_state != DK_OPEN) /* How did we end up here at all? */
    402   1.1     ragge 		panic("rlstrategy: state impossible");
    403   1.1     ragge 
    404   1.1     ragge 	lp = rc->rc_disk.dk_label;
    405  1.38      matt 	if (bounds_check_with_label(&rc->rc_disk, bp, 1) <= 0)
    406   1.1     ragge 		goto done;
    407   1.1     ragge 
    408   1.1     ragge 	if (bp->b_bcount == 0)
    409   1.1     ragge 		goto done;
    410   1.1     ragge 
    411   1.1     ragge 	bp->b_rawblkno =
    412   1.1     ragge 	    bp->b_blkno + lp->d_partitions[DISKPART(bp->b_dev)].p_offset;
    413   1.1     ragge 	bp->b_cylinder = bp->b_rawblkno / lp->d_secpercyl;
    414   1.1     ragge 
    415   1.8   thorpej 	s = splbio();
    416  1.40      yamt 	bufq_put(rc->rc_rlc->sc_q, bp);
    417  1.38      matt 	rlcstart(rc->rc_rlc, 0);
    418   1.1     ragge 	splx(s);
    419   1.1     ragge 	return;
    420   1.1     ragge 
    421   1.1     ragge done:	biodone(bp);
    422   1.1     ragge }
    423   1.1     ragge 
    424   1.1     ragge int
    425  1.31  christos rlioctl(dev_t dev, u_long cmd, void *addr, int flag, struct lwp *l)
    426   1.1     ragge {
    427  1.39  drochner 	struct rl_softc *rc = device_lookup_private(&rl_cd, DISKUNIT(dev));
    428   1.1     ragge 	struct disklabel *lp = rc->rc_disk.dk_label;
    429   1.1     ragge 	int err = 0;
    430   1.6      fvdl #ifdef __HAVE_OLD_DISKLABEL
    431   1.6      fvdl 	struct disklabel newlabel;
    432   1.6      fvdl #endif
    433   1.1     ragge 
    434   1.1     ragge 	switch (cmd) {
    435   1.1     ragge 	case DIOCGDINFO:
    436   1.1     ragge 		bcopy(lp, addr, sizeof (struct disklabel));
    437   1.1     ragge 		break;
    438   1.1     ragge 
    439   1.6      fvdl #ifdef __HAVE_OLD_DISKLABEL
    440   1.6      fvdl 	case ODIOCGDINFO:
    441   1.6      fvdl 		newlabel = *lp;
    442   1.6      fvdl 		if (newlabel.d_npartitions > OLDMAXPARTITIONS)
    443   1.7      fvdl 			return ENOTTY;
    444   1.6      fvdl 		bcopy(&newlabel, addr, sizeof (struct olddisklabel));
    445   1.6      fvdl 		break;
    446   1.6      fvdl #endif
    447   1.6      fvdl 
    448   1.1     ragge 	case DIOCGPART:
    449   1.1     ragge 		((struct partinfo *)addr)->disklab = lp;
    450   1.1     ragge 		((struct partinfo *)addr)->part =
    451   1.1     ragge 		    &lp->d_partitions[DISKPART(dev)];
    452   1.1     ragge 		break;
    453   1.1     ragge 
    454   1.1     ragge 	case DIOCSDINFO:
    455   1.1     ragge 	case DIOCWDINFO:
    456   1.6      fvdl #ifdef __HAVE_OLD_DISKLABEL
    457   1.6      fvdl 	case ODIOCWDINFO:
    458   1.6      fvdl 	case ODIOCSDINFO:
    459   1.6      fvdl #endif
    460   1.6      fvdl 	{
    461   1.6      fvdl 		struct disklabel *tp;
    462   1.6      fvdl 
    463   1.6      fvdl #ifdef __HAVE_OLD_DISKLABEL
    464   1.6      fvdl 		if (cmd == ODIOCSDINFO || cmd == ODIOCWDINFO) {
    465   1.6      fvdl 			memset(&newlabel, 0, sizeof newlabel);
    466   1.6      fvdl 			memcpy(&newlabel, addr, sizeof (struct olddisklabel));
    467   1.6      fvdl 			tp = &newlabel;
    468   1.6      fvdl 		} else
    469   1.6      fvdl #endif
    470   1.6      fvdl 		tp = (struct disklabel *)addr;
    471   1.6      fvdl 
    472   1.1     ragge 		if ((flag & FWRITE) == 0)
    473   1.1     ragge 			err = EBADF;
    474  1.22   thorpej 		else {
    475  1.34        ad 			mutex_enter(&rc->rc_disk.dk_openlock);
    476   1.6      fvdl 			err = ((
    477   1.6      fvdl #ifdef __HAVE_OLD_DISKLABEL
    478   1.6      fvdl 			       cmd == ODIOCSDINFO ||
    479   1.6      fvdl #endif
    480   1.6      fvdl 			       cmd == DIOCSDINFO) ?
    481   1.6      fvdl 			    setdisklabel(lp, tp, 0, 0) :
    482   1.1     ragge 			    writedisklabel(dev, rlstrategy, lp, 0));
    483  1.34        ad 			mutex_exit(&rc->rc_disk.dk_openlock);
    484  1.22   thorpej 		}
    485   1.1     ragge 		break;
    486   1.6      fvdl 	}
    487   1.1     ragge 
    488   1.1     ragge 	case DIOCWLABEL:
    489   1.1     ragge 		if ((flag & FWRITE) == 0)
    490   1.1     ragge 			err = EBADF;
    491   1.1     ragge 		break;
    492   1.1     ragge 
    493  1.38      matt 	case DIOCAWEDGE: {
    494  1.24    simonb 		struct dkwedge_info *dkw = (void *) addr;
    495  1.22   thorpej 
    496  1.22   thorpej 		if ((flag & FWRITE) == 0)
    497  1.22   thorpej 			return (EBADF);
    498  1.22   thorpej 
    499  1.22   thorpej 		/* If the ioctl happens here, the parent is us. */
    500  1.38      matt 		strcpy(dkw->dkw_parent, device_xname(rc->rc_dev));
    501  1.38      matt 		return dkwedge_add(dkw);
    502  1.38      matt 	}
    503  1.24    simonb 
    504  1.38      matt 	case DIOCDWEDGE: {
    505  1.24    simonb 		struct dkwedge_info *dkw = (void *) addr;
    506  1.22   thorpej 
    507  1.22   thorpej 		if ((flag & FWRITE) == 0)
    508  1.22   thorpej 			return (EBADF);
    509  1.22   thorpej 
    510  1.22   thorpej 		/* If the ioctl happens here, the parent is us. */
    511  1.38      matt 		strcpy(dkw->dkw_parent, device_xname(rc->rc_dev));
    512  1.38      matt 		return dkwedge_del(dkw);
    513  1.38      matt 	}
    514  1.24    simonb 
    515  1.38      matt 	case DIOCLWEDGES: {
    516  1.24    simonb 		struct dkwedge_list *dkwl = (void *) addr;
    517  1.22   thorpej 
    518  1.38      matt 		return dkwedge_list(&rc->rc_disk, dkwl, l);
    519  1.38      matt 	}
    520  1.22   thorpej 
    521   1.1     ragge 	default:
    522   1.1     ragge 		err = ENOTTY;
    523  1.38      matt 		break;
    524   1.1     ragge 	}
    525   1.1     ragge 	return err;
    526   1.1     ragge }
    527   1.1     ragge 
    528   1.1     ragge int
    529  1.38      matt rlpsize(dev_t dev)
    530   1.1     ragge {
    531  1.38      matt 	struct rl_softc * const rc = device_lookup_private(&rl_cd, DISKUNIT(dev));
    532   1.1     ragge 	struct disklabel *dl;
    533  1.38      matt 	int size;
    534   1.1     ragge 
    535  1.38      matt 	if (rc == NULL)
    536   1.1     ragge 		return -1;
    537   1.1     ragge 	dl = rc->rc_disk.dk_label;
    538   1.1     ragge 	size = dl->d_partitions[DISKPART(dev)].p_size *
    539   1.1     ragge 	    (dl->d_secsize / DEV_BSIZE);
    540   1.1     ragge 	return size;
    541   1.1     ragge }
    542   1.1     ragge 
    543   1.1     ragge int
    544  1.31  christos rldump(dev_t dev, daddr_t blkno, void *va, size_t size)
    545   1.1     ragge {
    546   1.1     ragge 	/* Not likely... */
    547   1.1     ragge 	return 0;
    548   1.1     ragge }
    549   1.1     ragge 
    550   1.1     ragge int
    551   1.1     ragge rlread(dev_t dev, struct uio *uio, int ioflag)
    552   1.1     ragge {
    553   1.1     ragge 	return (physio(rlstrategy, NULL, dev, B_READ, minphys, uio));
    554   1.1     ragge }
    555   1.1     ragge 
    556   1.1     ragge int
    557   1.1     ragge rlwrite(dev_t dev, struct uio *uio, int ioflag)
    558   1.1     ragge {
    559   1.1     ragge 	return (physio(rlstrategy, NULL, dev, B_WRITE, minphys, uio));
    560   1.1     ragge }
    561   1.1     ragge 
    562  1.38      matt static const char * const rlerr[] = {
    563   1.1     ragge 	"no",
    564   1.1     ragge 	"operation incomplete",
    565   1.1     ragge 	"read data CRC",
    566   1.1     ragge 	"header CRC",
    567   1.1     ragge 	"data late",
    568   1.1     ragge 	"header not found",
    569   1.1     ragge 	"",
    570   1.1     ragge 	"",
    571   1.9       wiz 	"non-existent memory",
    572   1.1     ragge 	"memory parity error",
    573   1.1     ragge 	"",
    574   1.1     ragge 	"",
    575   1.1     ragge 	"",
    576   1.1     ragge 	"",
    577   1.1     ragge 	"",
    578   1.1     ragge 	"",
    579   1.1     ragge };
    580   1.1     ragge 
    581   1.1     ragge void
    582   1.1     ragge rlcintr(void *arg)
    583   1.1     ragge {
    584   1.1     ragge 	struct rlc_softc *sc = arg;
    585   1.1     ragge 	struct buf *bp;
    586   1.1     ragge 	u_int16_t cs;
    587   1.1     ragge 
    588   1.1     ragge 	bp = sc->sc_active;
    589   1.1     ragge 	if (bp == 0) {
    590  1.38      matt 		aprint_error_dev(sc->sc_dev, "strange interrupt\n");
    591   1.1     ragge 		return;
    592   1.1     ragge 	}
    593   1.1     ragge 	bus_dmamap_unload(sc->sc_dmat, sc->sc_dmam);
    594   1.1     ragge 	sc->sc_active = 0;
    595   1.1     ragge 	cs = RL_RREG(RL_CS);
    596   1.1     ragge 	if (cs & RLCS_ERR) {
    597   1.1     ragge 		int error = (cs & RLCS_ERRMSK) >> 10;
    598   1.1     ragge 
    599  1.38      matt 		aprint_error_dev(sc->sc_dev, "%s\n", rlerr[error]);
    600   1.1     ragge 		bp->b_error = EIO;
    601   1.1     ragge 		bp->b_resid = bp->b_bcount;
    602   1.1     ragge 		sc->sc_bytecnt = 0;
    603   1.1     ragge 	}
    604   1.1     ragge 	if (sc->sc_bytecnt == 0) /* Finished transfer */
    605   1.1     ragge 		biodone(bp);
    606   1.1     ragge 	rlcstart(sc, sc->sc_bytecnt ? bp : 0);
    607   1.1     ragge }
    608   1.1     ragge 
    609   1.1     ragge /*
    610  1.24    simonb  * Start routine. First position the disk to the given position,
    611   1.1     ragge  * then start reading/writing. An optimization would be to be able
    612   1.1     ragge  * to handle overlapping seeks between disks.
    613   1.1     ragge  */
    614   1.1     ragge void
    615   1.1     ragge rlcstart(struct rlc_softc *sc, struct buf *ob)
    616   1.1     ragge {
    617   1.1     ragge 	struct disklabel *lp;
    618   1.1     ragge 	struct rl_softc *rc;
    619   1.1     ragge 	struct buf *bp;
    620   1.1     ragge 	int bn, cn, sn, tn, blks, err;
    621   1.1     ragge 
    622   1.1     ragge 	if (sc->sc_active)
    623   1.1     ragge 		return;	/* Already doing something */
    624   1.1     ragge 
    625   1.1     ragge 	if (ob == 0) {
    626  1.40      yamt 		bp = bufq_get(sc->sc_q);
    627   1.1     ragge 		if (bp == NULL)
    628   1.1     ragge 			return;	/* Nothing to do */
    629   1.3   thorpej 		sc->sc_bufaddr = bp->b_data;
    630   1.1     ragge 		sc->sc_diskblk = bp->b_rawblkno;
    631   1.1     ragge 		sc->sc_bytecnt = bp->b_bcount;
    632   1.1     ragge 		bp->b_resid = 0;
    633   1.1     ragge 	} else
    634   1.1     ragge 		bp = ob;
    635   1.1     ragge 	sc->sc_active = bp;
    636   1.1     ragge 
    637  1.39  drochner 	rc = device_lookup_private(&rl_cd, DISKUNIT(bp->b_dev));
    638   1.1     ragge 	bn = sc->sc_diskblk;
    639   1.1     ragge 	lp = rc->rc_disk.dk_label;
    640   1.1     ragge 	if (bn) {
    641   1.1     ragge 		cn = bn / lp->d_secpercyl;
    642   1.1     ragge 		sn = bn % lp->d_secpercyl;
    643   1.1     ragge 		tn = sn / lp->d_nsectors;
    644   1.1     ragge 		sn = sn % lp->d_nsectors;
    645   1.1     ragge 	} else
    646   1.1     ragge 		cn = sn = tn = 0;
    647   1.1     ragge 
    648   1.1     ragge 	/*
    649   1.1     ragge 	 * Check if we have to position disk first.
    650   1.1     ragge 	 */
    651   1.1     ragge 	if (rc->rc_cyl != cn || rc->rc_head != tn) {
    652   1.1     ragge 		u_int16_t da = RLDA_SEEK;
    653   1.1     ragge 		if (cn > rc->rc_cyl)
    654   1.1     ragge 			da |= ((cn - rc->rc_cyl) << RLDA_CYLSHFT) | RLDA_DIR;
    655   1.1     ragge 		else
    656   1.1     ragge 			da |= ((rc->rc_cyl - cn) << RLDA_CYLSHFT);
    657   1.1     ragge 		if (tn)
    658   1.1     ragge 			da |= RLDA_HSSEEK;
    659   1.1     ragge 		waitcrdy(sc);
    660   1.1     ragge 		RL_WREG(RL_DA, da);
    661   1.1     ragge 		RL_WREG(RL_CS, RLCS_SEEK | (rc->rc_hwid << RLCS_USHFT));
    662   1.1     ragge 		waitcrdy(sc);
    663   1.1     ragge 		rc->rc_cyl = cn;
    664   1.1     ragge 		rc->rc_head = tn;
    665   1.1     ragge 	}
    666   1.1     ragge 	RL_WREG(RL_DA, (cn << RLDA_CYLSHFT) | (tn ? RLDA_HSRW : 0) | (sn << 1));
    667   1.1     ragge 	blks = sc->sc_bytecnt/DEV_BSIZE;
    668   1.1     ragge 
    669   1.1     ragge 	if (sn + blks > RL_SPT/2)
    670   1.1     ragge 		blks = RL_SPT/2 - sn;
    671   1.1     ragge 	RL_WREG(RL_MP, -(blks*DEV_BSIZE)/2);
    672   1.1     ragge 	err = bus_dmamap_load(sc->sc_dmat, sc->sc_dmam, sc->sc_bufaddr,
    673  1.11     ragge 	    (blks*DEV_BSIZE), (bp->b_flags & B_PHYS ? bp->b_proc : 0),
    674  1.11     ragge 	    BUS_DMA_NOWAIT);
    675   1.1     ragge 	if (err)
    676   1.1     ragge 		panic("%s: bus_dmamap_load failed: %d",
    677  1.38      matt 		    device_xname(sc->sc_dev), err);
    678   1.1     ragge 	RL_WREG(RL_BA, (sc->sc_dmam->dm_segs[0].ds_addr & 0xffff));
    679   1.1     ragge 
    680   1.1     ragge 	/* Count up vars */
    681  1.33  christos 	sc->sc_bufaddr = (char *)sc->sc_bufaddr + (blks*DEV_BSIZE);
    682   1.1     ragge 	sc->sc_diskblk += blks;
    683   1.1     ragge 	sc->sc_bytecnt -= (blks*DEV_BSIZE);
    684   1.1     ragge 
    685   1.1     ragge 	if (bp->b_flags & B_READ)
    686   1.1     ragge 		RL_WREG(RL_CS, RLCS_IE|RLCS_RD|(rc->rc_hwid << RLCS_USHFT));
    687   1.1     ragge 	else
    688   1.1     ragge 		RL_WREG(RL_CS, RLCS_IE|RLCS_WD|(rc->rc_hwid << RLCS_USHFT));
    689   1.2     ragge }
    690   1.2     ragge 
    691  1.11     ragge /*
    692  1.11     ragge  * Called once per controller when an ubareset occurs.
    693  1.11     ragge  * Retracts all disks and restarts active transfers.
    694  1.11     ragge  */
    695   1.2     ragge void
    696  1.38      matt rlcreset(device_t dev)
    697   1.2     ragge {
    698  1.38      matt 	struct rlc_softc *sc = device_private(dev);
    699  1.11     ragge 	struct rl_softc *rc;
    700  1.11     ragge 	int i;
    701   1.2     ragge 	u_int16_t mp;
    702   1.2     ragge 
    703  1.11     ragge 	for (i = 0; i < rl_cd.cd_ndevs; i++) {
    704  1.38      matt 		if ((rc = device_lookup_private(&rl_cd, i)) == NULL)
    705  1.11     ragge 			continue;
    706  1.11     ragge 		if (rc->rc_state != DK_OPEN)
    707  1.11     ragge 			continue;
    708  1.38      matt 		if (rc->rc_rlc != sc)
    709  1.38      matt 			continue;
    710  1.11     ragge 
    711  1.11     ragge 		RL_WREG(RL_CS, RLCS_RHDR|(rc->rc_hwid << RLCS_USHFT));
    712  1.11     ragge 		waitcrdy(sc);
    713  1.11     ragge 		mp = RL_RREG(RL_MP);
    714  1.11     ragge 		rc->rc_head = ((mp & RLMP_HS) == RLMP_HS);
    715  1.11     ragge 		rc->rc_cyl = (mp >> 7) & 0777;
    716  1.11     ragge 	}
    717   1.2     ragge 	if (sc->sc_active == 0)
    718   1.2     ragge 		return;
    719   1.2     ragge 
    720  1.40      yamt 	bufq_put(sc->sc_q, sc->sc_active);
    721   1.2     ragge 	sc->sc_active = 0;
    722   1.2     ragge 	rlcstart(sc, 0);
    723   1.1     ragge }
    724