1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
|
/* SPDX-License-Identifier: GPL-2.0 */
/* sun3xflop.h: Sun3/80 specific parts of the floppy driver.
*
* Derived partially from asm-sparc/floppy.h, which is:
* Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
*
* Sun3x version 2/4/2000 Sam Creasey (sammy@sammy.net)
*/
#ifndef __ASM_SUN3X_FLOPPY_H
#define __ASM_SUN3X_FLOPPY_H
#include <linux/pgtable.h>
#include <asm/page.h>
#include <asm/irq.h>
#include <asm/sun3x.h>
/* default interrupt vector */
#define SUN3X_FDC_IRQ 0x40
/* some constants */
#define FCR_TC 0x1
#define FCR_EJECT 0x2
#define FCR_MTRON 0x4
#define FCR_DSEL1 0x8
#define FCR_DSEL0 0x10
/* We don't need no stinkin' I/O port allocation crap. */
#undef release_region
#undef request_region
#define release_region(X, Y) do { } while(0)
#define request_region(X, Y, Z) (1)
struct sun3xflop_private {
volatile unsigned char *status_r;
volatile unsigned char *data_r;
volatile unsigned char *fcr_r;
volatile unsigned char *fvr_r;
unsigned char fcr;
} sun3x_fdc;
/* Super paranoid... */
#undef HAVE_DISABLE_HLT
/* Routines unique to each controller type on a Sun. */
static unsigned char sun3x_82072_fd_inb(int port)
{
static int once = 0;
// udelay(5);
switch(port & 7) {
default:
pr_crit("floppy: Asked to read unknown port %d\n", port);
panic("floppy: Port bolixed.");
case 4: /* FD_STATUS */
return (*sun3x_fdc.status_r) & ~STATUS_DMA;
case 5: /* FD_DATA */
return (*sun3x_fdc.data_r);
case 7: /* FD_DIR */
/* ugly hack, I can't find a way to actually detect the disk */
if(!once) {
once = 1;
return 0x80;
}
return 0;
};
panic("sun_82072_fd_inb: How did I get here?");
}
static void sun3x_82072_fd_outb(unsigned char value, int port)
{
// udelay(5);
switch(port & 7) {
default:
pr_crit("floppy: Asked to write to unknown port %d\n", port);
panic("floppy: Port bolixed.");
case 2: /* FD_DOR */
/* Oh geese, 82072 on the Sun has no DOR register,
* so we make do with taunting the FCR.
*
* ASSUMPTIONS: There will only ever be one floppy
* drive attached to a Sun controller
* and it will be at drive zero.
*/
{
unsigned char fcr = sun3x_fdc.fcr;
if(value & 0x10) {
fcr |= (FCR_DSEL0 | FCR_MTRON);
} else
fcr &= ~(FCR_DSEL0 | FCR_MTRON);
if(fcr != sun3x_fdc.fcr) {
*(sun3x_fdc.fcr_r) = fcr;
sun3x_fdc.fcr = fcr;
}
}
break;
case 5: /* FD_DATA */
*(sun3x_fdc.data_r) = value;
break;
case 7: /* FD_DCR */
*(sun3x_fdc.status_r) = value;
break;
case 4: /* FD_STATUS */
*(sun3x_fdc.status_r) = value;
break;
}
return;
}
asmlinkage irqreturn_t sun3xflop_hardint(int irq, void *dev_id)
{
register unsigned char st;
#undef TRACE_FLPY_INT
#define NO_FLOPPY_ASSEMBLER
#ifdef TRACE_FLPY_INT
static int calls=0;
static int bytes=0;
static int dma_wait=0;
#endif
if(!doing_pdma) {
floppy_interrupt(irq, dev_id);
return IRQ_HANDLED;
}
// pr_info("doing pdma\n");// st %x\n", sun_fdc->status_82072);
#ifdef TRACE_FLPY_INT
if(!calls)
bytes = virtual_dma_count;
#endif
{
register int lcount;
register char *lptr;
for(lcount=virtual_dma_count, lptr=virtual_dma_addr;
lcount; lcount--, lptr++) {
/* st=fd_inb(virtual_dma_port+4) & 0x80 ; */
st = *(sun3x_fdc.status_r);
/* if(st != 0xa0) */
/* break; */
if((st & 0x80) == 0) {
virtual_dma_count = lcount;
virtual_dma_addr = lptr;
return IRQ_HANDLED;
}
if((st & 0x20) == 0)
break;
if(virtual_dma_mode)
/* fd_outb(*lptr, virtual_dma_port+5); */
*(sun3x_fdc.data_r) = *lptr;
else
/* *lptr = fd_inb(virtual_dma_port+5); */
*lptr = *(sun3x_fdc.data_r);
}
virtual_dma_count = lcount;
virtual_dma_addr = lptr;
/* st = fd_inb(virtual_dma_port+4); */
st = *(sun3x_fdc.status_r);
}
#ifdef TRACE_FLPY_INT
calls++;
#endif
// pr_info("st=%02x\n", st);
if(st == 0x20)
return IRQ_HANDLED;
if(!(st & 0x20)) {
virtual_dma_residue += virtual_dma_count;
virtual_dma_count=0;
doing_pdma = 0;
#ifdef TRACE_FLPY_INT
pr_info("count=%x, residue=%x calls=%d bytes=%x dma_wait=%d\n",
virtual_dma_count, virtual_dma_residue, calls, bytes,
dma_wait);
calls = 0;
dma_wait=0;
#endif
floppy_interrupt(irq, dev_id);
return IRQ_HANDLED;
}
#ifdef TRACE_FLPY_INT
if(!virtual_dma_count)
dma_wait++;
#endif
return IRQ_HANDLED;
}
static int sun3xflop_request_irq(void)
{
static int once = 0;
int error;
if(!once) {
once = 1;
error = request_irq(FLOPPY_IRQ, sun3xflop_hardint,
0, "floppy", NULL);
return ((error == 0) ? 0 : -1);
} else return 0;
}
static void __init floppy_set_flags(int *ints,int param, int param2);
static int sun3xflop_init(void)
{
if(FLOPPY_IRQ < 0x40)
FLOPPY_IRQ = SUN3X_FDC_IRQ;
sun3x_fdc.status_r = (volatile unsigned char *)SUN3X_FDC;
sun3x_fdc.data_r = (volatile unsigned char *)(SUN3X_FDC+1);
sun3x_fdc.fcr_r = (volatile unsigned char *)SUN3X_FDC_FCR;
sun3x_fdc.fvr_r = (volatile unsigned char *)SUN3X_FDC_FVR;
sun3x_fdc.fcr = 0;
/* Last minute sanity check... */
if(*sun3x_fdc.status_r == 0xff) {
return -1;
}
*sun3x_fdc.fvr_r = FLOPPY_IRQ;
*sun3x_fdc.fcr_r = FCR_TC;
udelay(10);
*sun3x_fdc.fcr_r = 0;
/* Success... */
floppy_set_flags(NULL, 1, FD_BROKEN_DCL); // I don't know how to detect this.
allowed_drive_mask = 0x01;
return (int) SUN3X_FDC;
}
/* I'm not precisely sure this eject routine works */
static int sun3x_eject(void)
{
if(MACH_IS_SUN3X) {
sun3x_fdc.fcr |= (FCR_DSEL0 | FCR_EJECT);
*(sun3x_fdc.fcr_r) = sun3x_fdc.fcr;
udelay(10);
sun3x_fdc.fcr &= ~(FCR_DSEL0 | FCR_EJECT);
*(sun3x_fdc.fcr_r) = sun3x_fdc.fcr;
}
return 0;
}
#define fd_eject(drive) sun3x_eject()
#endif /* !(__ASM_SUN3X_FLOPPY_H) */
|
