Home | History | Annotate | Line # | Download | only in dev
hdfd_intr.s revision 1.7
      1  1.7  thomas /*	$NetBSD: hdfd_intr.s,v 1.7 2001/09/08 11:15:35 thomas 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.5     leo #include <machine/asm.h>
     42  1.2     leo #define ASSEMBLER /* XXX */
     43  1.1     leo #include <atari/dev/hdfdreg.h>
     44  1.1     leo 
     45  1.4     leo 	.text
     46  1.7  thomas 	.globl	_C_LABEL(fddmaaddr)
     47  1.7  thomas 	.globl	_C_LABEL(fdio_addr),_C_LABEL(fddmalen)
     48  1.1     leo 
     49  1.1     leo /*
     50  1.1     leo  * Entry point when there is no fifo. Handles the read/write
     51  1.1     leo  * interrupts a bit faster because it *knows* that there is only
     52  1.1     leo  * one character waiting.
     53  1.1     leo  */
     54  1.7  thomas ENTRY_NOPROFILE(mfp_hdfd_nf)
     55  1.4     leo 	addql	#1,nintr		|  add another interrupt
     56  1.1     leo 
     57  1.7  thomas 	moveml	%d0-%d1/%a0-%a1,%sp@-	|  Save scratch registers
     58  1.7  thomas 	movl	_C_LABEL(fdio_addr),%a0	|  Get base of fdc registers
     59  1.7  thomas 	movb	%a0@(fdsts),%d0		|  Get fdsts
     60  1.7  thomas 	btst	#5,%d0			|  Dma active?
     61  1.1     leo 	jeq	hdfdc_norm		|  No, normal interrupt
     62  1.7  thomas 	tstl	_C_LABEL(fddmalen)	|  Bytecount zero?
     63  1.1     leo 	jeq	hdfdc_norm		|  Yes -> normal interrupt
     64  1.1     leo 
     65  1.7  thomas 	movl	_C_LABEL(fddmaaddr),%a1	|  a1 = dmabuffer
     66  1.7  thomas 	btst	#6,%d0			|  Read?
     67  1.1     leo 	jeq	hdfd_wrt_nf		|  No, write
     68  1.1     leo hdfd_rd_nf:
     69  1.7  thomas 	movb	%a0@(fddata),%a1@+	|  Get a byte
     70  1.1     leo 1:
     71  1.7  thomas 	subql	#1, _C_LABEL(fddmalen)	|  decrement bytecount
     72  1.7  thomas 	movl	%a1,_C_LABEL(fddmaaddr)	|  update dma pointer
     73  1.4     leo |	addql	#1,_cnt+V_INTR		|  chalk up another interrupt
     74  1.7  thomas 	moveml	%sp@+,%d0-%d1/%a0-%a1
     75  1.1     leo 	rte
     76  1.1     leo hdfd_wrt_nf:
     77  1.7  thomas 	movb	%a1@+,%a0@(fddata)	|  Push a byte
     78  1.1     leo 	jra	1b			|  And get out...
     79  1.1     leo 
     80  1.1     leo /*
     81  1.1     leo  * Systems *with* fifo's enter here.
     82  1.1     leo  */
     83  1.7  thomas ENTRY_NOPROFILE(mfp_hdfd_fifo)
     84  1.7  thomas 	addql	#1,_C_LABEL(intrcnt_user)+88	|  add another interrupt
     85  1.1     leo 
     86  1.7  thomas 	moveml	%d0-%d1/%a0-%a1,%sp@-	|  Save scratch registers
     87  1.7  thomas 	movl	_C_LABEL(fdio_addr),%a0	|  Get base of fdc registers
     88  1.7  thomas 	movb	%a0@(fdsts),%d0		|  Get fdsts
     89  1.7  thomas 	btst	#5,%d0			|  Dma active?
     90  1.1     leo 	jeq	hdfdc_norm		|  No, normal interrupt
     91  1.7  thomas 	movl	_C_LABEL(fddmaaddr),%a1	|  a1 = dmabuffer
     92  1.7  thomas 	btst	#6,%d0			|  Read?
     93  1.1     leo 	jeq	hdfd_wrt		|  No, write
     94  1.1     leo 
     95  1.1     leo hdfd_rd:
     96  1.7  thomas 	tstl	_C_LABEL(fddmalen)	|  Bytecount zero?
     97  1.1     leo 	jeq	hdfdc1			|  Yes -> done
     98  1.7  thomas 	movb	%a0@(fddata),%a1@+	|  Get a byte
     99  1.7  thomas 	subql	#1, _C_LABEL(fddmalen)	|  decrement bytecount
    100  1.7  thomas 	movb	%a0@(fdsts),%d0		|  Get fdsts
    101  1.7  thomas 	andb	#0xa0,%d0		|  both NE7_NDM and NE7_RQM active?
    102  1.7  thomas 	cmpb	#0xa0,%d0
    103  1.1     leo 	jne	hdfdc1			|  No, end of this batch
    104  1.1     leo 	jra	hdfd_rd
    105  1.1     leo 
    106  1.1     leo hdfd_wrt:
    107  1.7  thomas 	tstl	_C_LABEL(fddmalen)	|  Bytecount zero?
    108  1.1     leo 	jeq	hdfdc1			|  Yes -> done
    109  1.7  thomas 	movb	%a1@+,%a0@(fddata)	|  Push a byte
    110  1.7  thomas 	subql	#1, _C_LABEL(fddmalen)	|  decrement bytecount
    111  1.1     leo 	jra	hdfdc1
    112  1.7  thomas 	movb	%a0@(fdsts),%d0		|  Get fdsts
    113  1.7  thomas 	andb	#0xa0,%d0		|  both NE7_NDM and NE7_RQM active?
    114  1.7  thomas 	cmpb	#0xa0,%d0
    115  1.1     leo 	jne	hdfdc1			|  No, end of this batch
    116  1.1     leo 	jra	hdfd_wrt
    117  1.1     leo 
    118  1.1     leo hdfdc1:
    119  1.7  thomas 	movl	%a1,_C_LABEL(fddmaaddr)	|  update buffer pointer
    120  1.7  thomas 	btst	#5,%d0			|  Dma still active?
    121  1.1     leo 	jeq	hdfdc_norm		|  No -> take normal interrupt
    122  1.1     leo 
    123  1.1     leo 	/*
    124  1.1     leo 	 * Exit for read/write interrupts. Calling 'rei' this often
    125  1.1     leo 	 * seems wrong....
    126  1.1     leo 	 */
    127  1.1     leo hdfdc_xit:
    128  1.5     leo 	addql	#1,_C_LABEL(uvmexp)+UVMEXP_INTRS
    129  1.7  thomas 	moveml	%sp@+,%d0-%d1/%a0-%a1
    130  1.1     leo 	rte
    131  1.1     leo 
    132  1.1     leo 	/*
    133  1.1     leo 	 * No (more) data transfer interrupts. Do the normal
    134  1.1     leo 	 * stuff.
    135  1.1     leo 	 */
    136  1.1     leo hdfdc_norm:
    137  1.4     leo 	tstl	nintr
    138  1.4     leo 	jeq	0f
    139  1.7  thomas 	movl	nintr,%d0
    140  1.4     leo 	clrl	nintr
    141  1.7  thomas 	addl	%d0, _C_LABEL(intrcnt_user)+88	|  add another interrupt
    142  1.7  thomas 	addl	%d0,_C_LABEL(uvmexp)+UVMEXP_INTRS
    143  1.7  thomas 0:	jbsr	_C_LABEL(fdc_ctrl_intr)		|  handle interrupt
    144  1.7  thomas 	moveml	%sp@+,%d0-%d1/%a0-%a1	|    and saved registers
    145  1.7  thomas 	jra	_ASM_LABEL(rei)
    146  1.4     leo 
    147  1.4     leo 	.data
    148  1.4     leo nintr:
    149  1.4     leo 	.long	0
    150