Home | History | Annotate | Line # | Download | only in obio
esp.c revision 1.40.2.2
      1  1.40.2.2     yamt /*	$NetBSD: esp.c,v 1.40.2.2 2007/09/03 14:27:29 yamt Exp $	*/
      2       1.1   briggs 
      3       1.1   briggs /*
      4      1.10   briggs  * Copyright (c) 1997 Jason R. Thorpe.
      5      1.10   briggs  * All rights reserved.
      6       1.1   briggs  *
      7       1.1   briggs  * Redistribution and use in source and binary forms, with or without
      8       1.1   briggs  * modification, are permitted provided that the following conditions
      9       1.1   briggs  * are met:
     10       1.1   briggs  * 1. Redistributions of source code must retain the above copyright
     11       1.1   briggs  *    notice, this list of conditions and the following disclaimer.
     12       1.1   briggs  * 2. Redistributions in binary form must reproduce the above copyright
     13       1.1   briggs  *    notice, this list of conditions and the following disclaimer in the
     14       1.1   briggs  *    documentation and/or other materials provided with the distribution.
     15       1.1   briggs  * 3. All advertising materials mentioning features or use of this software
     16       1.1   briggs  *    must display the following acknowledgement:
     17      1.10   briggs  *	This product includes software developed for the NetBSD Project
     18      1.10   briggs  *	by Jason R. Thorpe.
     19       1.1   briggs  * 4. The name of the author may not be used to endorse or promote products
     20       1.1   briggs  *    derived from this software without specific prior written permission.
     21       1.1   briggs  *
     22       1.1   briggs  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23       1.1   briggs  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24       1.1   briggs  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25       1.1   briggs  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26       1.1   briggs  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     27       1.1   briggs  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     28       1.1   briggs  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     29       1.1   briggs  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     30       1.1   briggs  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     31       1.1   briggs  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32       1.1   briggs  */
     33       1.1   briggs 
     34       1.1   briggs /*
     35       1.1   briggs  * Copyright (c) 1994 Peter Galbavy
     36       1.1   briggs  * All rights reserved.
     37       1.1   briggs  *
     38       1.1   briggs  * Redistribution and use in source and binary forms, with or without
     39       1.1   briggs  * modification, are permitted provided that the following conditions
     40       1.1   briggs  * are met:
     41       1.1   briggs  * 1. Redistributions of source code must retain the above copyright
     42       1.1   briggs  *    notice, this list of conditions and the following disclaimer.
     43       1.1   briggs  * 2. Redistributions in binary form must reproduce the above copyright
     44       1.1   briggs  *    notice, this list of conditions and the following disclaimer in the
     45       1.1   briggs  *    documentation and/or other materials provided with the distribution.
     46       1.1   briggs  * 3. All advertising materials mentioning features or use of this software
     47       1.1   briggs  *    must display the following acknowledgement:
     48       1.1   briggs  *	This product includes software developed by Peter Galbavy
     49       1.1   briggs  * 4. The name of the author may not be used to endorse or promote products
     50       1.1   briggs  *    derived from this software without specific prior written permission.
     51       1.1   briggs  *
     52       1.1   briggs  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     53       1.1   briggs  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     54       1.1   briggs  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     55       1.1   briggs  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     56       1.1   briggs  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     57       1.1   briggs  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     58       1.1   briggs  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     59       1.1   briggs  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     60       1.1   briggs  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     61       1.1   briggs  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     62       1.1   briggs  * POSSIBILITY OF SUCH DAMAGE.
     63       1.1   briggs  */
     64       1.1   briggs 
     65       1.1   briggs /*
     66       1.1   briggs  * Based on aic6360 by Jarle Greipsland
     67       1.1   briggs  *
     68       1.1   briggs  * Acknowledgements: Many of the algorithms used in this driver are
     69       1.1   briggs  * inspired by the work of Julian Elischer (julian (at) tfs.com) and
     70       1.1   briggs  * Charles Hannum (mycroft (at) duality.gnu.ai.mit.edu).  Thanks a million!
     71      1.10   briggs  */
     72      1.10   briggs 
     73      1.10   briggs /*
     74      1.10   briggs  * Initial m68k mac support from Allen Briggs <briggs (at) macbsd.com>
     75      1.10   briggs  * (basically consisting of the match, a bit of the attach, and the
     76      1.10   briggs  *  "DMA" glue functions).
     77       1.1   briggs  */
     78      1.35    lukem 
     79      1.35    lukem #include <sys/cdefs.h>
     80  1.40.2.2     yamt __KERNEL_RCSID(0, "$NetBSD: esp.c,v 1.40.2.2 2007/09/03 14:27:29 yamt Exp $");
     81       1.1   briggs 
     82       1.1   briggs #include <sys/types.h>
     83       1.1   briggs #include <sys/param.h>
     84       1.1   briggs #include <sys/systm.h>
     85       1.1   briggs #include <sys/kernel.h>
     86       1.1   briggs #include <sys/errno.h>
     87       1.1   briggs #include <sys/ioctl.h>
     88       1.1   briggs #include <sys/device.h>
     89       1.1   briggs #include <sys/buf.h>
     90       1.1   briggs #include <sys/proc.h>
     91       1.1   briggs #include <sys/user.h>
     92       1.1   briggs #include <sys/queue.h>
     93       1.1   briggs 
     94      1.11   bouyer #include <dev/scsipi/scsi_all.h>
     95      1.11   bouyer #include <dev/scsipi/scsipi_all.h>
     96      1.11   bouyer #include <dev/scsipi/scsiconf.h>
     97      1.11   bouyer #include <dev/scsipi/scsi_message.h>
     98       1.1   briggs 
     99       1.1   briggs #include <machine/cpu.h>
    100      1.12   briggs #include <machine/bus.h>
    101       1.1   briggs #include <machine/param.h>
    102       1.1   briggs 
    103       1.7   briggs #include <dev/ic/ncr53c9xreg.h>
    104       1.7   briggs #include <dev/ic/ncr53c9xvar.h>
    105       1.7   briggs 
    106       1.1   briggs #include <machine/viareg.h>
    107       1.1   briggs 
    108      1.15   scottr #include <mac68k/obio/espvar.h>
    109      1.15   scottr #include <mac68k/obio/obiovar.h>
    110       1.3   briggs 
    111      1.36      chs void	espattach(struct device *, struct device *, void *);
    112      1.36      chs int	espmatch(struct device *, struct cfdata *, void *);
    113       1.1   briggs 
    114       1.1   briggs /* Linkup to the rest of the kernel */
    115      1.34  thorpej CFATTACH_DECL(esp, sizeof(struct esp_softc),
    116      1.34  thorpej     espmatch, espattach, NULL, NULL);
    117       1.1   briggs 
    118       1.7   briggs /*
    119       1.7   briggs  * Functions and the switch for the MI code.
    120       1.7   briggs  */
    121      1.36      chs u_char	esp_read_reg(struct ncr53c9x_softc *, int);
    122      1.36      chs void	esp_write_reg(struct ncr53c9x_softc *, int, u_char);
    123      1.36      chs int	esp_dma_isintr(struct ncr53c9x_softc *);
    124      1.36      chs void	esp_dma_reset(struct ncr53c9x_softc *);
    125      1.36      chs int	esp_dma_intr(struct ncr53c9x_softc *);
    126  1.40.2.2     yamt int	esp_dma_setup(struct ncr53c9x_softc *, void **, size_t *, int,
    127      1.36      chs 	    size_t *);
    128      1.36      chs void	esp_dma_go(struct ncr53c9x_softc *);
    129      1.36      chs void	esp_dma_stop(struct ncr53c9x_softc *);
    130      1.36      chs int	esp_dma_isactive(struct ncr53c9x_softc *);
    131      1.36      chs void	esp_quick_write_reg(struct ncr53c9x_softc *, int, u_char);
    132      1.36      chs int	esp_quick_dma_intr(struct ncr53c9x_softc *);
    133  1.40.2.2     yamt int	esp_quick_dma_setup(struct ncr53c9x_softc *, void **, size_t *, int,
    134      1.36      chs 	     size_t *);
    135      1.36      chs void	esp_quick_dma_go(struct ncr53c9x_softc *);
    136      1.36      chs 
    137      1.36      chs void	esp_intr(void *);
    138      1.36      chs void	esp_dualbus_intr(void *);
    139      1.36      chs static struct esp_softc		*esp0, *esp1;
    140      1.36      chs 
    141  1.40.2.1     yamt static inline int esp_dafb_have_dreq(struct esp_softc *);
    142  1.40.2.1     yamt static inline int esp_iosb_have_dreq(struct esp_softc *);
    143      1.36      chs int (*esp_have_dreq)(struct esp_softc *);
    144       1.7   briggs 
    145       1.7   briggs struct ncr53c9x_glue esp_glue = {
    146       1.7   briggs 	esp_read_reg,
    147       1.7   briggs 	esp_write_reg,
    148       1.7   briggs 	esp_dma_isintr,
    149       1.7   briggs 	esp_dma_reset,
    150       1.7   briggs 	esp_dma_intr,
    151       1.7   briggs 	esp_dma_setup,
    152       1.7   briggs 	esp_dma_go,
    153       1.7   briggs 	esp_dma_stop,
    154       1.7   briggs 	esp_dma_isactive,
    155       1.7   briggs 	NULL,			/* gl_clear_latched_intr */
    156       1.7   briggs };
    157       1.7   briggs 
    158       1.1   briggs int
    159      1.37      chs espmatch(struct device *parent, struct cfdata *cf, void *aux)
    160       1.1   briggs {
    161      1.38      chs 	struct obio_attach_args *oa = (struct obio_attach_args *)aux;
    162      1.12   briggs 
    163      1.38      chs 	if (oa->oa_addr == 0 && mac68k_machine.scsi96) {
    164      1.38      chs 		return 1;
    165      1.12   briggs 	}
    166      1.38      chs 	if (oa->oa_addr == 1 && mac68k_machine.scsi96_2) {
    167      1.38      chs 		return 1;
    168      1.12   briggs 	}
    169      1.38      chs 	return 0;
    170       1.1   briggs }
    171       1.1   briggs 
    172       1.1   briggs /*
    173       1.1   briggs  * Attach this instance, and then all the sub-devices
    174       1.1   briggs  */
    175       1.1   briggs void
    176      1.37      chs espattach(struct device *parent, struct device *self, void *aux)
    177       1.1   briggs {
    178      1.12   briggs 	struct obio_attach_args *oa = (struct obio_attach_args *)aux;
    179      1.20   scottr 	extern vaddr_t		SCSIBase;
    180      1.12   briggs 	struct esp_softc	*esc = (void *)self;
    181      1.12   briggs 	struct ncr53c9x_softc	*sc = &esc->sc_ncr53c9x;
    182      1.12   briggs 	int			quick = 0;
    183      1.12   briggs 	unsigned long		reg_offset;
    184      1.12   briggs 
    185      1.12   briggs 	reg_offset = SCSIBase - IOBase;
    186      1.12   briggs 	esc->sc_tag = oa->oa_tag;
    187      1.37      chs 
    188      1.12   briggs 	/*
    189      1.12   briggs 	 * For Wombat, Primus and Optimus motherboards, DREQ is
    190      1.12   briggs 	 * visible on bit 0 of the IOSB's emulated VIA2 vIFR (and
    191      1.12   briggs 	 * the scsi registers are offset 0x1000 bytes from IOBase).
    192      1.12   briggs 	 *
    193      1.12   briggs 	 * For the Q700/900/950 it's at f9800024 for bus 0 and
    194      1.12   briggs 	 * f9800028 for bus 1 (900/950).  For these machines, that is also
    195      1.12   briggs 	 * a (12-bit) configuration register for DAFB's control of the
    196      1.12   briggs 	 * pseudo-DMA timing.  The default value is 0x1d1.
    197      1.12   briggs 	 */
    198      1.12   briggs 	esp_have_dreq = esp_dafb_have_dreq;
    199      1.39      chs 	if (oa->oa_addr == 0) {
    200      1.12   briggs 		if (reg_offset == 0x10000) {
    201      1.12   briggs 			quick = 1;
    202      1.12   briggs 			esp_have_dreq = esp_iosb_have_dreq;
    203      1.12   briggs 		} else if (reg_offset == 0x18000) {
    204      1.12   briggs 			quick = 0;
    205      1.12   briggs 		} else {
    206      1.12   briggs 			if (bus_space_map(esc->sc_tag, 0xf9800024,
    207      1.12   briggs 					  4, 0, &esc->sc_bsh)) {
    208      1.12   briggs 				printf("failed to map 4 at 0xf9800024.\n");
    209      1.12   briggs 			} else {
    210      1.12   briggs 				quick = 1;
    211      1.12   briggs 				bus_space_write_4(esc->sc_tag,
    212      1.12   briggs 						  esc->sc_bsh, 0, 0x1d1);
    213      1.12   briggs 			}
    214      1.12   briggs 		}
    215      1.12   briggs 	} else {
    216      1.12   briggs 		if (bus_space_map(esc->sc_tag, 0xf9800028,
    217      1.12   briggs 				  4, 0, &esc->sc_bsh)) {
    218      1.12   briggs 			printf("failed to map 4 at 0xf9800028.\n");
    219      1.12   briggs 		} else {
    220      1.12   briggs 			quick = 1;
    221      1.12   briggs 			bus_space_write_4(esc->sc_tag, esc->sc_bsh, 0, 0x1d1);
    222      1.12   briggs 		}
    223      1.12   briggs 	}
    224      1.12   briggs 	if (quick) {
    225      1.12   briggs 		esp_glue.gl_write_reg = esp_quick_write_reg;
    226      1.12   briggs 		esp_glue.gl_dma_intr = esp_quick_dma_intr;
    227      1.12   briggs 		esp_glue.gl_dma_setup = esp_quick_dma_setup;
    228      1.12   briggs 		esp_glue.gl_dma_go = esp_quick_dma_go;
    229      1.12   briggs 	}
    230       1.1   briggs 
    231       1.1   briggs 	/*
    232       1.7   briggs 	 * Set up the glue for MI code early; we use some of it here.
    233       1.1   briggs 	 */
    234       1.7   briggs 	sc->sc_glue = &esp_glue;
    235       1.1   briggs 
    236       1.1   briggs 	/*
    237       1.7   briggs 	 * Save the regs
    238       1.1   briggs 	 */
    239      1.39      chs 	if (oa->oa_addr == 0) {
    240      1.16   briggs 		esp0 = esc;
    241       1.2   briggs 
    242       1.7   briggs 		esc->sc_reg = (volatile u_char *) SCSIBase;
    243      1.23   briggs 		via2_register_irq(VIA2_SCSIIRQ, esp_intr, esc);
    244       1.7   briggs 		esc->irq_mask = V2IF_SCSIIRQ;
    245       1.2   briggs 		if (reg_offset == 0x10000) {
    246      1.26   briggs 			/* From the Q650 developer's note */
    247       1.2   briggs 			sc->sc_freq = 16500000;
    248       1.2   briggs 		} else {
    249       1.2   briggs 			sc->sc_freq = 25000000;
    250       1.2   briggs 		}
    251      1.12   briggs 
    252      1.12   briggs 		if (esp_glue.gl_dma_go == esp_quick_dma_go) {
    253      1.12   briggs 			printf(" (quick)");
    254      1.12   briggs 		}
    255       1.1   briggs 	} else {
    256      1.16   briggs 		esp1 = esc;
    257      1.16   briggs 
    258       1.7   briggs 		esc->sc_reg = (volatile u_char *) SCSIBase + 0x402;
    259      1.23   briggs 		via2_register_irq(VIA2_SCSIIRQ, esp_dualbus_intr, NULL);
    260      1.16   briggs 		esc->irq_mask = 0;
    261       1.2   briggs 		sc->sc_freq = 25000000;
    262      1.12   briggs 
    263      1.12   briggs 		if (esp_glue.gl_dma_go == esp_quick_dma_go) {
    264      1.12   briggs 			printf(" (quick)");
    265      1.12   briggs 		}
    266       1.1   briggs 	}
    267       1.7   briggs 
    268       1.7   briggs 	printf(": address %p", esc->sc_reg);
    269       1.1   briggs 
    270       1.1   briggs 	sc->sc_id = 7;
    271       1.1   briggs 
    272  1.40.2.1     yamt 	/* gimme MHz */
    273       1.1   briggs 	sc->sc_freq /= 1000000;
    274       1.1   briggs 
    275       1.1   briggs 	/*
    276       1.1   briggs 	 * It is necessary to try to load the 2nd config register here,
    277       1.1   briggs 	 * to find out what rev the esp chip is, else the esp_reset
    278       1.1   briggs 	 * will not set up the defaults correctly.
    279       1.1   briggs 	 */
    280      1.13   briggs 	sc->sc_cfg1 = sc->sc_id; /* | NCRCFG1_PARENB; */
    281       1.7   briggs 	sc->sc_cfg2 = NCRCFG2_SCSI2;
    282       1.3   briggs 	sc->sc_cfg3 = 0;
    283       1.7   briggs 	sc->sc_rev = NCR_VARIANT_NCR53C96;
    284       1.1   briggs 
    285       1.1   briggs 	/*
    286       1.1   briggs 	 * This is the value used to start sync negotiations
    287       1.7   briggs 	 * Note that the NCR register "SYNCTP" is programmed
    288       1.1   briggs 	 * in "clocks per byte", and has a minimum value of 4.
    289       1.1   briggs 	 * The SCSI period used in negotiation is one-fourth
    290       1.1   briggs 	 * of the time (in nanoseconds) needed to transfer one byte.
    291       1.1   briggs 	 * Since the chip's clock is given in MHz, we have the following
    292       1.1   briggs 	 * formula: 4 * period = (1000 / freq) * 4
    293       1.1   briggs 	 */
    294       1.1   briggs 	sc->sc_minsync = 1000 / sc->sc_freq;
    295       1.1   briggs 
    296      1.26   briggs 	/* We need this to fit into the TCR... */
    297      1.26   briggs 	sc->sc_maxxfer = 64 * 1024;
    298      1.26   briggs 
    299  1.40.2.2     yamt         switch (current_mac_model->machineid) {
    300  1.40.2.2     yamt         case MACH_MACQ630:
    301  1.40.2.2     yamt 		/* XXX on LC630 64k xfer causes timeout error */
    302  1.40.2.2     yamt 		sc->sc_maxxfer = 63 * 1024;
    303  1.40.2.2     yamt 		break;
    304  1.40.2.2     yamt 	}
    305  1.40.2.2     yamt 
    306      1.26   briggs 	if (!quick) {
    307      1.26   briggs 		sc->sc_minsync = 0;	/* No synchronous xfers w/o DMA */
    308      1.26   briggs 		sc->sc_maxxfer = 8 * 1024;
    309      1.26   briggs 	}
    310       1.1   briggs 
    311       1.1   briggs 	/*
    312       1.7   briggs 	 * Configure interrupts.
    313       1.1   briggs 	 */
    314      1.16   briggs 	if (esc->irq_mask) {
    315      1.16   briggs 		via2_reg(vPCR) = 0x22;
    316      1.16   briggs 		via2_reg(vIFR) = esc->irq_mask;
    317      1.16   briggs 		via2_reg(vIER) = 0x80 | esc->irq_mask;
    318      1.16   briggs 	}
    319      1.24  thorpej 
    320      1.24  thorpej 	/*
    321      1.24  thorpej 	 * Now try to attach all the sub-devices
    322      1.24  thorpej 	 */
    323      1.29   bouyer 	sc->sc_adapter.adapt_minphys = minphys;
    324      1.29   bouyer 	sc->sc_adapter.adapt_request = ncr53c9x_scsipi_request;
    325      1.29   bouyer 	ncr53c9x_attach(sc);
    326       1.1   briggs }
    327       1.1   briggs 
    328       1.1   briggs /*
    329       1.7   briggs  * Glue functions.
    330       1.1   briggs  */
    331       1.1   briggs 
    332       1.7   briggs u_char
    333      1.37      chs esp_read_reg(struct ncr53c9x_softc *sc, int reg)
    334       1.1   briggs {
    335       1.7   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    336       1.1   briggs 
    337      1.23   briggs 	return esc->sc_reg[reg * 16];
    338       1.1   briggs }
    339       1.1   briggs 
    340       1.1   briggs void
    341      1.37      chs esp_write_reg(struct ncr53c9x_softc *sc, int reg, u_char val)
    342       1.1   briggs {
    343       1.7   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    344      1.21   briggs 	u_char	v = val;
    345       1.1   briggs 
    346       1.7   briggs 	if (reg == NCR_CMD && v == (NCRCMD_TRANS|NCRCMD_DMA)) {
    347       1.7   briggs 		v = NCRCMD_TRANS;
    348       1.1   briggs 	}
    349       1.7   briggs 	esc->sc_reg[reg * 16] = v;
    350       1.1   briggs }
    351       1.1   briggs 
    352      1.12   briggs void
    353      1.37      chs esp_dma_stop(struct ncr53c9x_softc *sc)
    354      1.12   briggs {
    355      1.12   briggs }
    356      1.12   briggs 
    357      1.12   briggs int
    358      1.37      chs esp_dma_isactive(struct ncr53c9x_softc *sc)
    359      1.12   briggs {
    360      1.12   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    361      1.12   briggs 
    362      1.12   briggs 	return esc->sc_active;
    363      1.12   briggs }
    364      1.12   briggs 
    365       1.7   briggs int
    366      1.37      chs esp_dma_isintr(struct ncr53c9x_softc *sc)
    367       1.1   briggs {
    368       1.7   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    369       1.1   briggs 
    370       1.7   briggs 	return esc->sc_reg[NCR_STAT * 16] & 0x80;
    371       1.1   briggs }
    372       1.1   briggs 
    373       1.1   briggs void
    374      1.37      chs esp_dma_reset(struct ncr53c9x_softc *sc)
    375       1.1   briggs {
    376       1.7   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    377       1.1   briggs 
    378       1.7   briggs 	esc->sc_active = 0;
    379       1.7   briggs 	esc->sc_tc = 0;
    380       1.1   briggs }
    381       1.1   briggs 
    382       1.7   briggs int
    383      1.37      chs esp_dma_intr(struct ncr53c9x_softc *sc)
    384       1.1   briggs {
    385      1.22   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    386       1.7   briggs 	volatile u_char *cmdreg, *intrreg, *statreg, *fiforeg;
    387      1.22   briggs 	u_char	*p;
    388      1.22   briggs 	u_int	espphase, espstat, espintr;
    389      1.22   briggs 	int	cnt, s;
    390       1.1   briggs 
    391       1.7   briggs 	if (esc->sc_active == 0) {
    392       1.7   briggs 		printf("dma_intr--inactive DMA\n");
    393       1.7   briggs 		return -1;
    394       1.1   briggs 	}
    395       1.1   briggs 
    396       1.7   briggs 	if ((sc->sc_espintr & NCRINTR_BS) == 0) {
    397       1.7   briggs 		esc->sc_active = 0;
    398       1.7   briggs 		return 0;
    399       1.1   briggs 	}
    400       1.1   briggs 
    401      1.30   briggs 	cnt = *esc->sc_dmalen;
    402      1.30   briggs 	if (*esc->sc_dmalen == 0) {
    403       1.7   briggs 		printf("data interrupt, but no count left.");
    404       1.1   briggs 	}
    405       1.1   briggs 
    406       1.7   briggs 	p = *esc->sc_dmaaddr;
    407       1.7   briggs 	espphase = sc->sc_phase;
    408       1.7   briggs 	espstat = (u_int) sc->sc_espstat;
    409       1.7   briggs 	espintr = (u_int) sc->sc_espintr;
    410       1.7   briggs 	cmdreg = esc->sc_reg + NCR_CMD * 16;
    411       1.7   briggs 	fiforeg = esc->sc_reg + NCR_FIFO * 16;
    412       1.7   briggs 	statreg = esc->sc_reg + NCR_STAT * 16;
    413       1.7   briggs 	intrreg = esc->sc_reg + NCR_INTR * 16;
    414       1.7   briggs 	do {
    415       1.7   briggs 		if (esc->sc_datain) {
    416       1.7   briggs 			*p++ = *fiforeg;
    417       1.7   briggs 			cnt--;
    418       1.7   briggs 			if (espphase == DATA_IN_PHASE) {
    419       1.7   briggs 				*cmdreg = NCRCMD_TRANS;
    420       1.7   briggs 			} else {
    421       1.7   briggs 				esc->sc_active = 0;
    422       1.7   briggs 			}
    423       1.7   briggs 	 	} else {
    424       1.7   briggs 			if (   (espphase == DATA_OUT_PHASE)
    425       1.7   briggs 			    || (espphase == MESSAGE_OUT_PHASE)) {
    426       1.7   briggs 				*fiforeg = *p++;
    427       1.7   briggs 				cnt--;
    428       1.7   briggs 				*cmdreg = NCRCMD_TRANS;
    429       1.7   briggs 			} else {
    430       1.7   briggs 				esc->sc_active = 0;
    431       1.7   briggs 			}
    432       1.1   briggs 		}
    433       1.1   briggs 
    434       1.7   briggs 		if (esc->sc_active) {
    435       1.7   briggs 			while (!(*statreg & 0x80));
    436      1.22   briggs 			s = splhigh();
    437       1.7   briggs 			espstat = *statreg;
    438       1.7   briggs 			espintr = *intrreg;
    439       1.7   briggs 			espphase = (espintr & NCRINTR_DIS)
    440       1.7   briggs 				    ? /* Disconnected */ BUSFREE_PHASE
    441       1.7   briggs 				    : espstat & PHASE_MASK;
    442      1.22   briggs 			splx(s);
    443       1.1   briggs 		}
    444       1.7   briggs 	} while (esc->sc_active && (espintr & NCRINTR_BS));
    445       1.7   briggs 	sc->sc_phase = espphase;
    446       1.7   briggs 	sc->sc_espstat = (u_char) espstat;
    447       1.7   briggs 	sc->sc_espintr = (u_char) espintr;
    448       1.7   briggs 	*esc->sc_dmaaddr = p;
    449      1.30   briggs 	*esc->sc_dmalen = cnt;
    450       1.1   briggs 
    451      1.30   briggs 	if (*esc->sc_dmalen == 0) {
    452       1.7   briggs 		esc->sc_tc = NCRSTAT_TC;
    453       1.1   briggs 	}
    454       1.7   briggs 	sc->sc_espstat |= esc->sc_tc;
    455       1.7   briggs 	return 0;
    456       1.1   briggs }
    457       1.1   briggs 
    458       1.1   briggs int
    459  1.40.2.2     yamt esp_dma_setup(struct ncr53c9x_softc *sc, void **addr, size_t *len, int datain,
    460      1.37      chs     size_t *dmasize)
    461       1.1   briggs {
    462       1.7   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    463       1.1   briggs 
    464  1.40.2.2     yamt 	esc->sc_dmaaddr = (char **)addr;
    465      1.12   briggs 	esc->sc_dmalen = len;
    466       1.7   briggs 	esc->sc_datain = datain;
    467       1.7   briggs 	esc->sc_dmasize = *dmasize;
    468       1.7   briggs 	esc->sc_tc = 0;
    469       1.1   briggs 
    470       1.7   briggs 	return 0;
    471       1.1   briggs }
    472       1.1   briggs 
    473       1.1   briggs void
    474      1.37      chs esp_dma_go(struct ncr53c9x_softc *sc)
    475       1.1   briggs {
    476       1.7   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    477       1.1   briggs 
    478       1.7   briggs 	if (esc->sc_datain == 0) {
    479       1.7   briggs 		esc->sc_reg[NCR_FIFO * 16] = **esc->sc_dmaaddr;
    480      1.12   briggs 		(*esc->sc_dmalen)--;
    481       1.7   briggs 		(*esc->sc_dmaaddr)++;
    482       1.1   briggs 	}
    483       1.7   briggs 	esc->sc_active = 1;
    484       1.1   briggs }
    485       1.1   briggs 
    486       1.1   briggs void
    487      1.37      chs esp_quick_write_reg(struct ncr53c9x_softc *sc, int reg, u_char val)
    488       1.1   briggs {
    489      1.12   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    490      1.12   briggs 
    491      1.23   briggs 	esc->sc_reg[reg * 16] = val;
    492       1.1   briggs }
    493       1.1   briggs 
    494      1.26   briggs #if DEBUG
    495      1.26   briggs int mac68k_esp_debug=0;
    496      1.26   briggs #endif
    497      1.26   briggs 
    498       1.1   briggs int
    499      1.37      chs esp_quick_dma_intr(struct ncr53c9x_softc *sc)
    500      1.12   briggs {
    501      1.12   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    502      1.12   briggs 	int trans=0, resid=0;
    503      1.12   briggs 
    504      1.12   briggs 	if (esc->sc_active == 0)
    505      1.32   provos 		panic("dma_intr--inactive DMA");
    506      1.12   briggs 
    507      1.12   briggs 	esc->sc_active = 0;
    508      1.12   briggs 
    509      1.12   briggs 	if (esc->sc_dmasize == 0) {
    510      1.12   briggs 		int	res;
    511      1.12   briggs 
    512      1.26   briggs 		res = NCR_READ_REG(sc, NCR_TCL);
    513      1.26   briggs 		res += NCR_READ_REG(sc, NCR_TCM) << 8;
    514      1.28   briggs 		/* This can happen in the case of a TRPAD operation */
    515      1.28   briggs 		/* Pretend that it was complete */
    516      1.28   briggs 		sc->sc_espstat |= NCRSTAT_TC;
    517      1.28   briggs #if DEBUG
    518      1.28   briggs 		if (mac68k_esp_debug) {
    519      1.28   briggs 			printf("dmaintr: DMA xfer of zero xferred %d\n",
    520      1.28   briggs 			    65536 - res);
    521      1.28   briggs 		}
    522      1.28   briggs #endif
    523      1.12   briggs 		return 0;
    524      1.12   briggs 	}
    525      1.12   briggs 
    526      1.12   briggs 	if ((sc->sc_espstat & NCRSTAT_TC) == 0) {
    527      1.28   briggs 		if (esc->sc_datain == 0) {
    528      1.28   briggs 			resid = NCR_READ_REG(sc, NCR_FFLAG) & 0x1f;
    529      1.28   briggs #if DEBUG
    530      1.28   briggs 			if (mac68k_esp_debug) {
    531      1.28   briggs 				printf("Write FIFO residual %d bytes\n", resid);
    532      1.28   briggs 			}
    533      1.28   briggs #endif
    534      1.28   briggs 		}
    535      1.12   briggs 		resid += NCR_READ_REG(sc, NCR_TCL);
    536      1.12   briggs 		resid += NCR_READ_REG(sc, NCR_TCM) << 8;
    537      1.12   briggs 		if (resid == 0)
    538      1.12   briggs 			resid = 65536;
    539      1.12   briggs 	}
    540      1.12   briggs 
    541      1.12   briggs 	trans = esc->sc_dmasize - resid;
    542      1.12   briggs 	if (trans < 0) {
    543      1.12   briggs 		printf("dmaintr: trans < 0????");
    544      1.26   briggs 		trans = *esc->sc_dmalen;
    545      1.12   briggs 	}
    546      1.12   briggs 
    547      1.12   briggs 	NCR_DMA(("dmaintr: trans %d, resid %d.\n", trans, resid));
    548      1.26   briggs #if DEBUG
    549      1.26   briggs 	if (mac68k_esp_debug) {
    550      1.26   briggs 		printf("eqd_intr: trans %d, resid %d.\n", trans, resid);
    551      1.26   briggs 	}
    552      1.26   briggs #endif
    553      1.12   briggs 	*esc->sc_dmaaddr += trans;
    554      1.12   briggs 	*esc->sc_dmalen -= trans;
    555      1.12   briggs 
    556      1.12   briggs 	return 0;
    557      1.12   briggs }
    558      1.12   briggs 
    559      1.12   briggs int
    560  1.40.2.2     yamt esp_quick_dma_setup(struct ncr53c9x_softc *sc, void **addr, size_t *len,
    561      1.37      chs     int datain, size_t *dmasize)
    562      1.12   briggs {
    563      1.12   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    564      1.12   briggs 
    565  1.40.2.2     yamt 	esc->sc_dmaaddr = (char **)addr;
    566      1.12   briggs 	esc->sc_dmalen = len;
    567      1.12   briggs 
    568      1.26   briggs 	if (*len & 1) {
    569      1.13   briggs 		esc->sc_pad = 1;
    570      1.13   briggs 	} else {
    571      1.13   briggs 		esc->sc_pad = 0;
    572      1.13   briggs 	}
    573      1.12   briggs 
    574      1.12   briggs 	esc->sc_datain = datain;
    575      1.12   briggs 	esc->sc_dmasize = *dmasize;
    576      1.12   briggs 
    577      1.26   briggs #if DIAGNOSTIC
    578      1.26   briggs 	if (esc->sc_dmasize == 0) {
    579      1.28   briggs 		/* This can happen in the case of a TRPAD operation */
    580      1.26   briggs 	}
    581      1.26   briggs #endif
    582      1.26   briggs #if DEBUG
    583      1.26   briggs 	if (mac68k_esp_debug) {
    584      1.26   briggs 	printf("eqd_setup: addr %lx, len %lx, in? %d, dmasize %lx\n",
    585      1.26   briggs 	    (long) *addr, (long) *len, datain, (long) esc->sc_dmasize);
    586      1.26   briggs 	}
    587      1.26   briggs #endif
    588      1.26   briggs 
    589      1.12   briggs 	return 0;
    590      1.12   briggs }
    591      1.12   briggs 
    592  1.40.2.1     yamt static inline int
    593      1.37      chs esp_dafb_have_dreq(struct esp_softc *esc)
    594      1.12   briggs {
    595      1.26   briggs 	return (*(volatile u_int32_t *)(esc->sc_bsh.base) & 0x200);
    596      1.12   briggs }
    597      1.12   briggs 
    598  1.40.2.1     yamt static inline int
    599      1.37      chs esp_iosb_have_dreq(struct esp_softc *esc)
    600      1.12   briggs {
    601      1.12   briggs 	return (via2_reg(vIFR) & V2IF_SCSIDRQ);
    602      1.12   briggs }
    603      1.12   briggs 
    604      1.26   briggs static volatile int espspl=-1;
    605      1.12   briggs 
    606      1.26   briggs /*
    607      1.26   briggs  * Apple "DMA" is weird.
    608      1.26   briggs  *
    609      1.26   briggs  * Basically, the CPU acts like the DMA controller.  The DREQ/ off the
    610      1.26   briggs  * chip goes to a register that we've mapped at attach time (on the
    611      1.26   briggs  * IOSB or DAFB, depending on the machine).  Apple also provides some
    612      1.26   briggs  * space for which the memory controller handshakes data to/from the
    613      1.26   briggs  * NCR chip with the DACK/ line.  This space appears to be mapped over
    614      1.26   briggs  * and over, every 4 bytes, but only the lower 16 bits are valid (but
    615      1.26   briggs  * reading the upper 16 bits will handshake DACK/ just fine, so if you
    616      1.26   briggs  * read *u_int16_t++ = *u_int16_t++ in a loop, you'll get
    617      1.26   briggs  * <databyte><databyte>0xff0xff<databyte><databyte>0xff0xff...
    618      1.26   briggs  *
    619      1.26   briggs  * When you're attempting to read or write memory to this DACK/ed space,
    620      1.26   briggs  * and the NCR is not ready for some timeout period, the system will
    621      1.26   briggs  * generate a bus error.  This might be for one of several reasons:
    622      1.26   briggs  *
    623      1.26   briggs  *	1) (on write) The FIFO is full and is not draining.
    624      1.26   briggs  *	2) (on read) The FIFO is empty and is not filling.
    625      1.26   briggs  *	3) An interrupt condition has occurred.
    626      1.26   briggs  *	4) Anything else?
    627      1.26   briggs  *
    628      1.26   briggs  * So if a bus error occurs, we first turn off the nofault bus error handler,
    629      1.26   briggs  * then we check for an interrupt (which would render the first two
    630      1.26   briggs  * possibilities moot).  If there's no interrupt, check for a DREQ/.  If we
    631      1.26   briggs  * have that, then attempt to resume stuffing (or unstuffing) the FIFO.  If
    632      1.26   briggs  * neither condition holds, pause briefly and check again.
    633      1.26   briggs  *
    634      1.26   briggs  * NOTE!!!  In order to make allowances for the hardware structure of
    635      1.26   briggs  *          the mac, spl values in here are hardcoded!!!!!!!!!
    636      1.26   briggs  *          This is done to allow serial interrupts to get in during
    637      1.26   briggs  *          scsi transfers.  This is ugly.
    638      1.26   briggs  */
    639      1.12   briggs void
    640      1.37      chs esp_quick_dma_go(struct ncr53c9x_softc *sc)
    641       1.1   briggs {
    642       1.7   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    643      1.26   briggs 	extern long mac68k_a2_fromfault;
    644      1.12   briggs 	extern int *nofault;
    645      1.12   briggs 	label_t faultbuf;
    646      1.12   briggs 	u_int16_t volatile *pdma;
    647      1.26   briggs 	u_int16_t *addr;
    648      1.26   briggs 	int		len, res;
    649      1.26   briggs 	u_short		cnt32, cnt2;
    650      1.12   briggs 	u_char volatile *statreg;
    651      1.12   briggs 
    652      1.12   briggs 	esc->sc_active = 1;
    653      1.12   briggs 
    654      1.26   briggs 	espspl = splhigh();
    655      1.26   briggs 
    656      1.26   briggs 	addr = (u_int16_t *) *esc->sc_dmaaddr;
    657      1.26   briggs 	len  = esc->sc_dmasize;
    658      1.12   briggs 
    659      1.12   briggs restart_dmago:
    660      1.26   briggs #if DEBUG
    661      1.26   briggs 	if (mac68k_esp_debug) {
    662      1.26   briggs 		printf("eqdg: a %lx, l %lx, in? %d ... ",
    663      1.26   briggs 		    (long) addr, (long) len, esc->sc_datain);
    664      1.26   briggs 	}
    665      1.26   briggs #endif
    666      1.12   briggs 	nofault = (int *) &faultbuf;
    667      1.12   briggs 	if (setjmp((label_t *) nofault)) {
    668      1.12   briggs 		int	i=0;
    669      1.12   briggs 
    670      1.12   briggs 		nofault = (int *) 0;
    671      1.26   briggs #if DEBUG
    672      1.26   briggs 		if (mac68k_esp_debug) {
    673      1.26   briggs 			printf("be\n");
    674      1.26   briggs 		}
    675      1.26   briggs #endif
    676      1.26   briggs 		/*
    677      1.26   briggs 		 * Bus error...
    678      1.26   briggs 		 * So, we first check for an interrupt.  If we have
    679      1.26   briggs 		 * one, go handle it.  Next we check for DREQ/.  If
    680      1.26   briggs 		 * we have it, then we restart the transfer.  If
    681      1.26   briggs 		 * neither, then loop until we get one or the other.
    682      1.26   briggs 		 */
    683      1.12   briggs 		statreg = esc->sc_reg + NCR_STAT * 16;
    684      1.12   briggs 		for (;;) {
    685      1.26   briggs 			spl2();		/* Give serial a chance... */
    686      1.26   briggs 			splhigh();	/* That's enough... */
    687      1.26   briggs 
    688      1.12   briggs 			if (*statreg & 0x80) {
    689      1.12   briggs 				goto gotintr;
    690      1.12   briggs 			}
    691      1.12   briggs 
    692      1.12   briggs 			if (esp_have_dreq(esc)) {
    693      1.26   briggs 				/*
    694      1.28   briggs 				 * Get the remaining length from the address
    695      1.26   briggs 				 * differential.
    696      1.26   briggs 				 */
    697      1.26   briggs 				addr = (u_int16_t *) mac68k_a2_fromfault;
    698      1.26   briggs 				len = esc->sc_dmasize -
    699      1.26   briggs 				    ((long) addr - (long) *esc->sc_dmaaddr);
    700      1.26   briggs 
    701      1.26   briggs 				if (esc->sc_datain == 0) {
    702      1.26   briggs 					/*
    703      1.26   briggs 					 * Let the FIFO drain before we read
    704      1.26   briggs 					 * the transfer count.
    705      1.26   briggs 					 * Do we need to do this?
    706      1.26   briggs 					 * Can we do this?
    707      1.26   briggs 					 */
    708      1.26   briggs 					while (NCR_READ_REG(sc, NCR_FFLAG)
    709      1.26   briggs 					    & 0x1f);
    710      1.26   briggs 					/*
    711      1.26   briggs 					 * Get the length from the transfer
    712      1.26   briggs 					 * counters.
    713      1.26   briggs 					 */
    714      1.26   briggs 					res = NCR_READ_REG(sc, NCR_TCL);
    715      1.26   briggs 					res += NCR_READ_REG(sc, NCR_TCM) << 8;
    716      1.26   briggs 					/*
    717      1.26   briggs 					 * If they don't agree,
    718      1.26   briggs 					 * adjust accordingly.
    719      1.26   briggs 					 */
    720      1.26   briggs 					while (res > len) {
    721      1.26   briggs 						len+=2; addr--;
    722      1.26   briggs 					}
    723      1.26   briggs 					if (res != len) {
    724      1.32   provos 						panic("esp_quick_dma_go: res %d != len %d",
    725      1.26   briggs 							res, len);
    726      1.26   briggs 					}
    727      1.26   briggs 				}
    728      1.12   briggs 				break;
    729      1.12   briggs 			}
    730      1.12   briggs 
    731      1.12   briggs 			DELAY(1);
    732      1.26   briggs 			if (i++ > 1000000)
    733      1.26   briggs 				panic("esp_dma_go: Bus error, but no condition!  Argh!");
    734      1.12   briggs 		}
    735      1.12   briggs 		goto restart_dmago;
    736      1.12   briggs 	}
    737      1.12   briggs 
    738      1.26   briggs 	len &= ~1;
    739      1.26   briggs 
    740      1.12   briggs 	statreg = esc->sc_reg + NCR_STAT * 16;
    741      1.40      jmc 	pdma = (volatile u_int16_t *) (esc->sc_reg + 0x100);
    742       1.1   briggs 
    743      1.26   briggs 	/*
    744      1.26   briggs 	 * These loops are unrolled into assembly for two reasons:
    745      1.26   briggs 	 * 1) We can make sure that they are as efficient as possible, and
    746      1.26   briggs 	 * 2) (more importantly) we need the address that we are reading
    747      1.26   briggs 	 *    from or writing to to be in a2.
    748      1.26   briggs 	 */
    749      1.26   briggs 	cnt32 = len / 32;
    750      1.26   briggs 	cnt2 = (len % 32) / 2;
    751      1.12   briggs 	if (esc->sc_datain == 0) {
    752      1.26   briggs 		/* while (cnt32--) { 16 instances of *pdma = *addr++; } */
    753      1.26   briggs 		/* while (cnt2--) { *pdma = *addr++; } */
    754  1.40.2.1     yamt 		__asm volatile (
    755      1.31  thorpej 			"	movl %1, %%a2	\n"
    756      1.31  thorpej 			"	movl %2, %%a3	\n"
    757      1.31  thorpej 			"	movw %3, %%d2	\n"
    758      1.31  thorpej 			"	cmpw #0, %%d2	\n"
    759      1.31  thorpej 			"	beq  2f		\n"
    760      1.31  thorpej 			"	subql #1, %%d2	\n"
    761      1.31  thorpej 			"1:	movw %%a2@+,%%a3@; movw %%a2@+,%%a3@	\n"
    762      1.31  thorpej 			"	movw %%a2@+,%%a3@; movw %%a2@+,%%a3@	\n"
    763      1.31  thorpej 			"	movw %%a2@+,%%a3@; movw %%a2@+,%%a3@	\n"
    764      1.31  thorpej 			"	movw %%a2@+,%%a3@; movw %%a2@+,%%a3@	\n"
    765      1.31  thorpej 			"	movw %%a2@+,%%a3@; movw %%a2@+,%%a3@	\n"
    766      1.31  thorpej 			"	movw %%a2@+,%%a3@; movw %%a2@+,%%a3@	\n"
    767      1.31  thorpej 			"	movw %%a2@+,%%a3@; movw %%a2@+,%%a3@	\n"
    768      1.31  thorpej 			"	movw %%a2@+,%%a3@; movw %%a2@+,%%a3@	\n"
    769      1.31  thorpej 			"	movw #8704,%%sr	\n"
    770      1.31  thorpej 			"	movw #9728,%%sr	\n"
    771      1.31  thorpej 			"	dbra %%d2, 1b	\n"
    772      1.31  thorpej 			"2:	movw %4, %%d2	\n"
    773      1.31  thorpej 			"	cmpw #0, %%d2	\n"
    774      1.31  thorpej 			"	beq  4f		\n"
    775      1.31  thorpej 			"	subql #1, %%d2	\n"
    776      1.31  thorpej 			"3:	movw %%a2@+,%%a3@ \n"
    777      1.31  thorpej 			"	dbra %%d2, 3b	\n"
    778      1.31  thorpej 			"4:	movl %%a2, %0"
    779      1.26   briggs 			: "=g" (addr)
    780      1.26   briggs 			: "0" (addr), "g" (pdma), "g" (cnt32), "g" (cnt2)
    781      1.26   briggs 			: "a2", "a3", "d2");
    782      1.13   briggs 		if (esc->sc_pad) {
    783      1.40      jmc 			volatile unsigned char	*c;
    784      1.40      jmc 			c = (volatile unsigned char *) addr;
    785      1.26   briggs 			/* Wait for DREQ */
    786      1.26   briggs 			while (!esp_have_dreq(esc)) {
    787      1.26   briggs 				if (*statreg & 0x80) {
    788      1.26   briggs 					nofault = (int *) 0;
    789      1.26   briggs 					goto gotintr;
    790      1.26   briggs 				}
    791      1.26   briggs 			}
    792      1.40      jmc 			*(volatile unsigned char *)pdma = *c;
    793      1.13   briggs 		}
    794      1.12   briggs 	} else {
    795      1.26   briggs 		/* while (cnt32--) { 16 instances of *addr++ = *pdma; } */
    796      1.26   briggs 		/* while (cnt2--) { *addr++ = *pdma; } */
    797  1.40.2.1     yamt 		__asm volatile (
    798      1.31  thorpej 			"	movl %1, %%a2	\n"
    799      1.31  thorpej 			"	movl %2, %%a3	\n"
    800      1.31  thorpej 			"	movw %3, %%d2	\n"
    801      1.31  thorpej 			"	cmpw #0, %%d2	\n"
    802      1.31  thorpej 			"	beq  6f		\n"
    803      1.31  thorpej 			"	subql #1, %%d2	\n"
    804      1.31  thorpej 			"5:	movw %%a3@,%%a2@+; movw %%a3@,%%a2@+	\n"
    805      1.31  thorpej 			"	movw %%a3@,%%a2@+; movw %%a3@,%%a2@+	\n"
    806      1.31  thorpej 			"	movw %%a3@,%%a2@+; movw %%a3@,%%a2@+	\n"
    807      1.31  thorpej 			"	movw %%a3@,%%a2@+; movw %%a3@,%%a2@+	\n"
    808      1.31  thorpej 			"	movw %%a3@,%%a2@+; movw %%a3@,%%a2@+	\n"
    809      1.31  thorpej 			"	movw %%a3@,%%a2@+; movw %%a3@,%%a2@+	\n"
    810      1.31  thorpej 			"	movw %%a3@,%%a2@+; movw %%a3@,%%a2@+	\n"
    811      1.31  thorpej 			"	movw %%a3@,%%a2@+; movw %%a3@,%%a2@+	\n"
    812      1.31  thorpej 			"	movw #8704,%%sr	\n"
    813      1.31  thorpej 			"	movw #9728,%%sr	\n"
    814      1.31  thorpej 			"	dbra %%d2, 5b	\n"
    815      1.31  thorpej 			"6:	movw %4, %%d2	\n"
    816      1.31  thorpej 			"	cmpw #0, %%d2	\n"
    817      1.31  thorpej 			"	beq  8f		\n"
    818      1.31  thorpej 			"	subql #1, %%d2	\n"
    819      1.31  thorpej 			"7:	movw %%a3@,%%a2@+ \n"
    820      1.31  thorpej 			"	dbra %%d2, 7b	\n"
    821      1.31  thorpej 			"8:	movl %%a2, %0"
    822      1.26   briggs 			: "=g" (addr)
    823      1.26   briggs 			: "0" (addr), "g" (pdma), "g" (cnt32), "g" (cnt2)
    824      1.26   briggs 			: "a2", "a3", "d2");
    825      1.13   briggs 		if (esc->sc_pad) {
    826      1.40      jmc 			volatile unsigned char	*c;
    827      1.40      jmc 			c = (volatile unsigned char *) addr;
    828      1.26   briggs 			/* Wait for DREQ */
    829      1.26   briggs 			while (!esp_have_dreq(esc)) {
    830      1.26   briggs 				if (*statreg & 0x80) {
    831      1.26   briggs 					nofault = (int *) 0;
    832      1.26   briggs 					goto gotintr;
    833      1.26   briggs 				}
    834      1.26   briggs 			}
    835      1.40      jmc 			*c = *(volatile unsigned char *)pdma;
    836      1.12   briggs 		}
    837      1.12   briggs 	}
    838      1.12   briggs 
    839      1.12   briggs 	nofault = (int *) 0;
    840      1.12   briggs 
    841      1.26   briggs 	/*
    842      1.26   briggs 	 * If we have not received an interrupt yet, we should shortly,
    843      1.26   briggs 	 * and we can't prevent it, so return and wait for it.
    844      1.26   briggs 	 */
    845      1.12   briggs 	if ((*statreg & 0x80) == 0) {
    846      1.26   briggs #if DEBUG
    847      1.26   briggs 		if (mac68k_esp_debug) {
    848      1.26   briggs 			printf("g.\n");
    849      1.26   briggs 		}
    850      1.26   briggs #endif
    851      1.12   briggs 		if (espspl != -1) splx(espspl); espspl = -1;
    852      1.12   briggs 		return;
    853      1.12   briggs 	}
    854      1.12   briggs 
    855      1.12   briggs gotintr:
    856      1.26   briggs #if DEBUG
    857      1.26   briggs 	if (mac68k_esp_debug) {
    858      1.26   briggs 		printf("g!\n");
    859      1.26   briggs 	}
    860      1.26   briggs #endif
    861      1.12   briggs 	ncr53c9x_intr(sc);
    862      1.12   briggs 	if (espspl != -1) splx(espspl); espspl = -1;
    863      1.16   briggs }
    864      1.16   briggs 
    865      1.23   briggs void
    866      1.37      chs esp_intr(void *sc)
    867      1.23   briggs {
    868      1.23   briggs 	struct esp_softc *esc = (struct esp_softc *)sc;
    869      1.23   briggs 
    870      1.26   briggs 	if (esc->sc_reg[NCR_STAT * 16] & 0x80) {
    871      1.26   briggs 		ncr53c9x_intr((struct ncr53c9x_softc *) esp0);
    872      1.26   briggs 	}
    873      1.23   briggs }
    874      1.23   briggs 
    875      1.23   briggs void
    876      1.37      chs esp_dualbus_intr(void *sc)
    877      1.16   briggs {
    878      1.26   briggs 	if (esp0 && (esp0->sc_reg[NCR_STAT * 16] & 0x80)) {
    879      1.26   briggs 		ncr53c9x_intr((struct ncr53c9x_softc *) esp0);
    880      1.26   briggs 	}
    881      1.22   briggs 
    882      1.26   briggs 	if (esp1 && (esp1->sc_reg[NCR_STAT * 16] & 0x80)) {
    883      1.26   briggs 		ncr53c9x_intr((struct ncr53c9x_softc *) esp1);
    884      1.26   briggs 	}
    885       1.1   briggs }
    886