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