Home | History | Annotate | Line # | Download | only in dev
hdfd_intr.s revision 1.2
      1  1.2  leo /*	$NetBSD: hdfd_intr.s,v 1.2 1996/12/14 13:47:13 leo Exp $
      2  1.1  leo 
      3  1.1  leo /*
      4  1.1  leo  * Copyright (c) 1996 Leo Weppelman.
      5  1.1  leo  * All rights reserved.
      6  1.1  leo  *
      7  1.1  leo  * This code is derived from software contributed to Berkeley by
      8  1.1  leo  * the Systems Programming Group of the University of Utah Computer
      9  1.1  leo  * Science Department.
     10  1.1  leo  *
     11  1.1  leo  * Redistribution and use in source and binary forms, with or without
     12  1.1  leo  * modification, are permitted provided that the following conditions
     13  1.1  leo  * are met:
     14  1.1  leo  * 1. Redistributions of source code must retain the above copyright
     15  1.1  leo  *    notice, this list of conditions and the following disclaimer.
     16  1.1  leo  * 2. Redistributions in binary form must reproduce the above copyright
     17  1.1  leo  *    notice, this list of conditions and the following disclaimer in the
     18  1.1  leo  *    documentation and/or other materials provided with the distribution.
     19  1.1  leo  * 3. All advertising materials mentioning features or use of this software
     20  1.1  leo  *    must display the following acknowledgement:
     21  1.1  leo  *	This product includes software developed by Leo Weppelman.
     22  1.1  leo  * 4. Neither the name of the University nor the names of its contributors
     23  1.1  leo  *    may be used to endorse or promote products derived from this software
     24  1.1  leo  *    without specific prior written permission.
     25  1.1  leo  *
     26  1.1  leo  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     27  1.1  leo  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     28  1.1  leo  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     29  1.1  leo  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     30  1.1  leo  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     31  1.1  leo  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     32  1.1  leo  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     33  1.1  leo  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     34  1.1  leo  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     35  1.1  leo  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     36  1.1  leo  * SUCH DAMAGE.
     37  1.1  leo  *
     38  1.1  leo  */
     39  1.1  leo 
     40  1.1  leo #include "assym.h"
     41  1.2  leo #define ASSEMBLER /* XXX */
     42  1.1  leo #include <atari/dev/hdfdreg.h>
     43  1.1  leo 
     44  1.1  leo 	.globl	_fddmaaddr
     45  1.1  leo 	.globl	_fdio_addr,_fddmalen
     46  1.1  leo 	.globl	_mfp_hdfd_nf, _mfp_hdfd_fifo
     47  1.1  leo 
     48  1.1  leo /*
     49  1.1  leo  * Entry point when there is no fifo. Handles the read/write
     50  1.1  leo  * interrupts a bit faster because it *knows* that there is only
     51  1.1  leo  * one character waiting.
     52  1.1  leo  */
     53  1.1  leo _mfp_hdfd_nf:
     54  1.1  leo 	addql	#1,_intrcnt+12		|  XXX: add another fdc/acsi interrupt
     55  1.1  leo 
     56  1.1  leo 	moveml	d0-d1/a0-a1,sp@-	|  Save scratch registers
     57  1.1  leo 	movl	_fdio_addr,a0		|  Get base of fdc registers
     58  1.1  leo 	movb	a0@(fdsts),d0		|  Get fdsts
     59  1.1  leo 	btst	#5,d0			|  Dma active?
     60  1.1  leo 	jeq	hdfdc_norm		|  No, normal interrupt
     61  1.1  leo 	tstl	_fddmalen		|  Bytecount zero?
     62  1.1  leo 	jeq	hdfdc_norm		|  Yes -> normal interrupt
     63  1.1  leo 
     64  1.1  leo 	movl	_fddmaaddr, a1		|  a1 = dmabuffer
     65  1.1  leo 	btst	#6,d0			|  Read?
     66  1.1  leo 	jeq	hdfd_wrt_nf		|  No, write
     67  1.1  leo hdfd_rd_nf:
     68  1.1  leo 	movb	a0@(fddata),a1@+	|  Get a byte
     69  1.1  leo 1:
     70  1.1  leo 	subql	#1, _fddmalen		|  decrement bytecount
     71  1.1  leo 	movl	a1,_fddmaaddr		|  update dma pointer
     72  1.1  leo 	addql	#1,_cnt+V_INTR		|  chalk up another interrupt
     73  1.1  leo 	moveml	sp@+,d0-d1/a0-a1
     74  1.1  leo 	rte
     75  1.1  leo hdfd_wrt_nf:
     76  1.1  leo 	movb	a1@+,a0@(fddata)	|  Push a byte
     77  1.1  leo 	jra	1b			|  And get out...
     78  1.1  leo 
     79  1.1  leo /*
     80  1.1  leo  * Systems *with* fifo's enter here.
     81  1.1  leo  */
     82  1.1  leo _mfp_hdfd_fifo:
     83  1.1  leo 	addql	#1,_intrcnt+12		|  XXX: add another fdc/acsi interrupt
     84  1.1  leo 
     85  1.1  leo 	moveml	d0-d1/a0-a1,sp@-	|  Save scratch registers
     86  1.1  leo 	movl	_fdio_addr,a0		|  Get base of fdc registers
     87  1.1  leo 	movb	a0@(fdsts),d0		|  Get fdsts
     88  1.1  leo 	btst	#5,d0			|  Dma active?
     89  1.1  leo 	jeq	hdfdc_norm		|  No, normal interrupt
     90  1.1  leo 	movl	_fddmaaddr, a1		|  a1 = dmabuffer
     91  1.1  leo 	btst	#6,d0			|  Read?
     92  1.1  leo 	jeq	hdfd_wrt		|  No, write
     93  1.1  leo 
     94  1.1  leo hdfd_rd:
     95  1.1  leo 	tstl	_fddmalen		|  Bytecount zero?
     96  1.1  leo 	jeq	hdfdc1			|  Yes -> done
     97  1.1  leo 	movb	a0@(fddata),a1@+	|  Get a byte
     98  1.1  leo 	subql	#1, _fddmalen		|  decrement bytecount
     99  1.1  leo 	movb	a0@(fdsts),d0		|  Get fdsts
    100  1.1  leo 	andb	#0xa0,d0		|  both NE7_NDM and NE7_RQM active?
    101  1.1  leo 	cmpb	#0xa0,d0
    102  1.1  leo 	jne	hdfdc1			|  No, end of this batch
    103  1.1  leo 	jra	hdfd_rd
    104  1.1  leo 
    105  1.1  leo hdfd_wrt:
    106  1.1  leo 	tstl	_fddmalen		|  Bytecount zero?
    107  1.1  leo 	jeq	hdfdc1			|  Yes -> done
    108  1.1  leo 	movb	a1@+,a0@(fddata)	|  Push a byte
    109  1.1  leo 	subql	#1, _fddmalen		|  decrement bytecount
    110  1.1  leo 	jra	hdfdc1
    111  1.1  leo 	movb	a0@(fdsts),d0		|  Get fdsts
    112  1.1  leo 	andb	#0xa0,d0		|  both NE7_NDM and NE7_RQM active?
    113  1.1  leo 	cmpb	#0xa0,d0
    114  1.1  leo 	jne	hdfdc1			|  No, end of this batch
    115  1.1  leo 	jra	hdfd_wrt
    116  1.1  leo 
    117  1.1  leo hdfdc1:
    118  1.1  leo 	movl	a1,_fddmaaddr		|  update buffer pointer
    119  1.1  leo 	btst	#5,d0			|  Dma still active?
    120  1.1  leo 	jeq	hdfdc_norm		|  No -> take normal interrupt
    121  1.1  leo 
    122  1.1  leo 	/*
    123  1.1  leo 	 * Exit for read/write interrupts. Calling 'rei' this often
    124  1.1  leo 	 * seems wrong....
    125  1.1  leo 	 */
    126  1.1  leo hdfdc_xit:
    127  1.1  leo 	addql	#1,_cnt+V_INTR		|  chalk up another interrupt
    128  1.1  leo 	moveml	sp@+,d0-d1/a0-a1
    129  1.1  leo 	rte
    130  1.1  leo 
    131  1.1  leo 	/*
    132  1.1  leo 	 * No (more) data transfer interrupts. Do the normal
    133  1.1  leo 	 * stuff.
    134  1.1  leo 	 */
    135  1.1  leo hdfdc_norm:
    136  1.1  leo 	lea	sp@(16),a0		|  push pointer to trap-frame
    137  1.1  leo 	movl	a0,sp@-
    138  1.1  leo 	jbsr	_fdc_ctrl_intr		|  handle interrupt
    139  1.1  leo 	addql	#4,sp			|  pop trap-frame pointer
    140  1.1  leo 	moveml	sp@+,d0-d1/a0-a1	|    and saved registers
    141  1.1  leo 	addql	#1,_cnt+V_INTR		|  chalk up another interrupt
    142  1.1  leo 	jra	rei
    143