hdfd_intr.s revision 1.4 1 1.4 leo /* $NetBSD: hdfd_intr.s,v 1.4 1997/01/01 21:12:57 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.4 leo .text
45 1.1 leo .globl _fddmaaddr
46 1.1 leo .globl _fdio_addr,_fddmalen
47 1.1 leo .globl _mfp_hdfd_nf, _mfp_hdfd_fifo
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.1 leo _mfp_hdfd_nf:
55 1.4 leo addql #1,nintr | add another interrupt
56 1.1 leo
57 1.1 leo moveml d0-d1/a0-a1,sp@- | Save scratch registers
58 1.1 leo movl _fdio_addr,a0 | Get base of fdc registers
59 1.1 leo movb a0@(fdsts),d0 | Get fdsts
60 1.1 leo btst #5,d0 | Dma active?
61 1.1 leo jeq hdfdc_norm | No, normal interrupt
62 1.1 leo tstl _fddmalen | Bytecount zero?
63 1.1 leo jeq hdfdc_norm | Yes -> normal interrupt
64 1.1 leo
65 1.1 leo movl _fddmaaddr, a1 | a1 = dmabuffer
66 1.1 leo btst #6,d0 | Read?
67 1.1 leo jeq hdfd_wrt_nf | No, write
68 1.1 leo hdfd_rd_nf:
69 1.1 leo movb a0@(fddata),a1@+ | Get a byte
70 1.1 leo 1:
71 1.1 leo subql #1, _fddmalen | decrement bytecount
72 1.1 leo movl a1,_fddmaaddr | update dma pointer
73 1.4 leo | addql #1,_cnt+V_INTR | chalk up another interrupt
74 1.1 leo moveml sp@+,d0-d1/a0-a1
75 1.1 leo rte
76 1.1 leo hdfd_wrt_nf:
77 1.1 leo 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.1 leo _mfp_hdfd_fifo:
84 1.4 leo addql #1,_intrcnt_user+88 | add another interrupt
85 1.1 leo
86 1.1 leo moveml d0-d1/a0-a1,sp@- | Save scratch registers
87 1.1 leo movl _fdio_addr,a0 | Get base of fdc registers
88 1.1 leo movb a0@(fdsts),d0 | Get fdsts
89 1.1 leo btst #5,d0 | Dma active?
90 1.1 leo jeq hdfdc_norm | No, normal interrupt
91 1.1 leo movl _fddmaaddr, a1 | a1 = dmabuffer
92 1.1 leo 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.1 leo tstl _fddmalen | Bytecount zero?
97 1.1 leo jeq hdfdc1 | Yes -> done
98 1.1 leo movb a0@(fddata),a1@+ | Get a byte
99 1.1 leo subql #1, _fddmalen | decrement bytecount
100 1.1 leo movb a0@(fdsts),d0 | Get fdsts
101 1.1 leo andb #0xa0,d0 | both NE7_NDM and NE7_RQM active?
102 1.1 leo 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.1 leo tstl _fddmalen | Bytecount zero?
108 1.1 leo jeq hdfdc1 | Yes -> done
109 1.1 leo movb a1@+,a0@(fddata) | Push a byte
110 1.1 leo subql #1, _fddmalen | decrement bytecount
111 1.1 leo jra hdfdc1
112 1.1 leo movb a0@(fdsts),d0 | Get fdsts
113 1.1 leo andb #0xa0,d0 | both NE7_NDM and NE7_RQM active?
114 1.1 leo 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.1 leo movl a1,_fddmaaddr | update buffer pointer
120 1.1 leo 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.1 leo addql #1,_cnt+V_INTR | chalk up another interrupt
129 1.1 leo 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.4 leo movl nintr,d0
140 1.4 leo clrl nintr
141 1.4 leo addl d0, _intrcnt_user+88 | add another interrupt
142 1.4 leo addl d0, _cnt+V_INTR | chalk up another interrupt
143 1.4 leo 0: jbsr _fdc_ctrl_intr | handle interrupt
144 1.1 leo moveml sp@+,d0-d1/a0-a1 | and saved registers
145 1.1 leo jra rei
146 1.4 leo
147 1.4 leo .data
148 1.4 leo nintr:
149 1.4 leo .long 0
150