1
2
3
4
5
6#ifndef __ASM_SPARC_FLOPPY_H
7#define __ASM_SPARC_FLOPPY_H
8
9#include <linux/of.h>
10#include <linux/of_device.h>
11
12#include <asm/page.h>
13#include <asm/pgtable.h>
14#include <asm/system.h>
15#include <asm/idprom.h>
16#include <asm/machines.h>
17#include <asm/oplib.h>
18#include <asm/auxio.h>
19#include <asm/irq.h>
20
21
22#undef release_region
23#undef request_region
24#define release_region(X, Y) do { } while(0)
25#define request_region(X, Y, Z) (1)
26
27
28
29
30
31
32struct sun_flpy_controller {
33 volatile unsigned char status_82072;
34#define dcr_82072 status_82072
35#define status1_82077 status_82072
36
37 volatile unsigned char data_82072;
38#define status2_82077 data_82072
39
40 volatile unsigned char dor_82077;
41 volatile unsigned char tapectl_82077;
42
43 volatile unsigned char status_82077;
44#define drs_82077 status_82077
45
46 volatile unsigned char data_82077;
47 volatile unsigned char ___unused;
48 volatile unsigned char dir_82077;
49#define dcr_82077 dir_82077
50};
51
52
53static struct sun_flpy_controller *sun_fdc = NULL;
54extern volatile unsigned char *fdc_status;
55
56struct sun_floppy_ops {
57 unsigned char (*fd_inb)(int port);
58 void (*fd_outb)(unsigned char value, int port);
59};
60
61static struct sun_floppy_ops sun_fdops;
62
63#define fd_inb(port) sun_fdops.fd_inb(port)
64#define fd_outb(value,port) sun_fdops.fd_outb(value,port)
65#define fd_enable_dma() sun_fd_enable_dma()
66#define fd_disable_dma() sun_fd_disable_dma()
67#define fd_request_dma() (0)
68#define fd_free_dma()
69#define fd_clear_dma_ff()
70#define fd_set_dma_mode(mode) sun_fd_set_dma_mode(mode)
71#define fd_set_dma_addr(addr) sun_fd_set_dma_addr(addr)
72#define fd_set_dma_count(count) sun_fd_set_dma_count(count)
73#define fd_enable_irq()
74#define fd_disable_irq()
75#define fd_cacheflush(addr, size)
76#define fd_request_irq() sun_fd_request_irq()
77#define fd_free_irq()
78#if 0
79#define fd_dma_mem_alloc(size) ((unsigned long) vmalloc(size))
80#define fd_dma_mem_free(addr,size) (vfree((void *)(addr)))
81#endif
82
83
84#define get_dma_residue(x) (0)
85
86#define FLOPPY0_TYPE 4
87#define FLOPPY1_TYPE 0
88
89
90#undef HAVE_DISABLE_HLT
91
92
93
94
95
96#define FDC1 sun_floppy_init()
97
98#define N_FDC 1
99#define N_DRIVE 8
100
101
102#define CROSS_64KB(a,s) (0)
103
104
105static void sun_set_dor(unsigned char value, int fdc_82077)
106{
107 if (sparc_cpu_model == sun4c) {
108 unsigned int bits = 0;
109 if (value & 0x10)
110 bits |= AUXIO_FLPY_DSEL;
111 if ((value & 0x80) == 0)
112 bits |= AUXIO_FLPY_EJCT;
113 set_auxio(bits, (~bits) & (AUXIO_FLPY_DSEL|AUXIO_FLPY_EJCT));
114 }
115 if (fdc_82077) {
116 sun_fdc->dor_82077 = value;
117 }
118}
119
120static unsigned char sun_read_dir(void)
121{
122 if (sparc_cpu_model == sun4c)
123 return (get_auxio() & AUXIO_FLPY_DCHG) ? 0x80 : 0;
124 else
125 return sun_fdc->dir_82077;
126}
127
128static unsigned char sun_82072_fd_inb(int port)
129{
130 udelay(5);
131 switch(port & 7) {
132 default:
133 printk("floppy: Asked to read unknown port %d\n", port);
134 panic("floppy: Port bolixed.");
135 case 4:
136 return sun_fdc->status_82072 & ~STATUS_DMA;
137 case 5:
138 return sun_fdc->data_82072;
139 case 7:
140 return sun_read_dir();
141 }
142 panic("sun_82072_fd_inb: How did I get here?");
143}
144
145static void sun_82072_fd_outb(unsigned char value, int port)
146{
147 udelay(5);
148 switch(port & 7) {
149 default:
150 printk("floppy: Asked to write to unknown port %d\n", port);
151 panic("floppy: Port bolixed.");
152 case 2:
153 sun_set_dor(value, 0);
154 break;
155 case 5:
156 sun_fdc->data_82072 = value;
157 break;
158 case 7:
159 sun_fdc->dcr_82072 = value;
160 break;
161 case 4:
162 sun_fdc->status_82072 = value;
163 break;
164 }
165 return;
166}
167
168static unsigned char sun_82077_fd_inb(int port)
169{
170 udelay(5);
171 switch(port & 7) {
172 default:
173 printk("floppy: Asked to read unknown port %d\n", port);
174 panic("floppy: Port bolixed.");
175 case 0:
176 return sun_fdc->status1_82077;
177 case 1:
178 return sun_fdc->status2_82077;
179 case 2:
180 return sun_fdc->dor_82077;
181 case 3:
182 return sun_fdc->tapectl_82077;
183 case 4:
184 return sun_fdc->status_82077 & ~STATUS_DMA;
185 case 5:
186 return sun_fdc->data_82077;
187 case 7:
188 return sun_read_dir();
189 }
190 panic("sun_82077_fd_inb: How did I get here?");
191}
192
193static void sun_82077_fd_outb(unsigned char value, int port)
194{
195 udelay(5);
196 switch(port & 7) {
197 default:
198 printk("floppy: Asked to write to unknown port %d\n", port);
199 panic("floppy: Port bolixed.");
200 case 2:
201 sun_set_dor(value, 1);
202 break;
203 case 5:
204 sun_fdc->data_82077 = value;
205 break;
206 case 7:
207 sun_fdc->dcr_82077 = value;
208 break;
209 case 4:
210 sun_fdc->status_82077 = value;
211 break;
212 case 3:
213 sun_fdc->tapectl_82077 = value;
214 break;
215 }
216 return;
217}
218
219
220
221
222
223
224
225
226
227
228
229extern char *pdma_vaddr;
230extern unsigned long pdma_size;
231extern volatile int doing_pdma;
232
233
234extern char *pdma_base;
235extern unsigned long pdma_areasize;
236
237
238static inline void virtual_dma_init(void)
239{
240
241}
242
243static inline void sun_fd_disable_dma(void)
244{
245 doing_pdma = 0;
246 if (pdma_base) {
247 mmu_unlockarea(pdma_base, pdma_areasize);
248 pdma_base = NULL;
249 }
250}
251
252static inline void sun_fd_set_dma_mode(int mode)
253{
254 switch(mode) {
255 case DMA_MODE_READ:
256 doing_pdma = 1;
257 break;
258 case DMA_MODE_WRITE:
259 doing_pdma = 2;
260 break;
261 default:
262 printk("Unknown dma mode %d\n", mode);
263 panic("floppy: Giving up...");
264 }
265}
266
267static inline void sun_fd_set_dma_addr(char *buffer)
268{
269 pdma_vaddr = buffer;
270}
271
272static inline void sun_fd_set_dma_count(int length)
273{
274 pdma_size = length;
275}
276
277static inline void sun_fd_enable_dma(void)
278{
279 pdma_vaddr = mmu_lockarea(pdma_vaddr, pdma_size);
280 pdma_base = pdma_vaddr;
281 pdma_areasize = pdma_size;
282}
283
284extern int sparc_floppy_request_irq(unsigned int irq,
285 irq_handler_t irq_handler);
286
287static int sun_fd_request_irq(void)
288{
289 static int once = 0;
290
291 if (!once) {
292 once = 1;
293 return sparc_floppy_request_irq(FLOPPY_IRQ, floppy_interrupt);
294 } else {
295 return 0;
296 }
297}
298
299static struct linux_prom_registers fd_regs[2];
300
301static int sun_floppy_init(void)
302{
303 struct platform_device *op;
304 struct device_node *dp;
305 char state[128];
306 phandle tnode, fd_node;
307 int num_regs;
308 struct resource r;
309
310 use_virtual_dma = 1;
311
312
313
314
315 if((sparc_cpu_model != sun4c && sparc_cpu_model != sun4m) ||
316 ((idprom->id_machtype == (SM_SUN4C | SM_4C_SLC)) ||
317 (idprom->id_machtype == (SM_SUN4C | SM_4C_ELC)))) {
318
319 goto no_sun_fdc;
320 }
321
322 tnode = prom_getchild(prom_root_node);
323 fd_node = prom_searchsiblings(tnode, "obio");
324 if(fd_node != 0) {
325 tnode = prom_getchild(fd_node);
326 fd_node = prom_searchsiblings(tnode, "SUNW,fdtwo");
327 } else {
328 fd_node = prom_searchsiblings(tnode, "fd");
329 }
330 if(fd_node == 0) {
331 goto no_sun_fdc;
332 }
333
334
335 if(sparc_cpu_model == sun4m &&
336 prom_getproperty(fd_node, "status", state, sizeof(state)) != -1) {
337 if(!strcmp(state, "disabled")) {
338 goto no_sun_fdc;
339 }
340 }
341 num_regs = prom_getproperty(fd_node, "reg", (char *) fd_regs, sizeof(fd_regs));
342 num_regs = (num_regs / sizeof(fd_regs[0]));
343 prom_apply_obio_ranges(fd_regs, num_regs);
344 memset(&r, 0, sizeof(r));
345 r.flags = fd_regs[0].which_io;
346 r.start = fd_regs[0].phys_addr;
347 sun_fdc = (struct sun_flpy_controller *)
348 of_ioremap(&r, 0, fd_regs[0].reg_size, "floppy");
349
350
351
352
353 for_each_node_by_name(dp, "SUNW,fdtwo") {
354 op = of_find_device_by_node(dp);
355 if (op)
356 break;
357 }
358 if (!op) {
359 for_each_node_by_name(dp, "fd") {
360 op = of_find_device_by_node(dp);
361 if (op)
362 break;
363 }
364 }
365 if (!op)
366 goto no_sun_fdc;
367
368 FLOPPY_IRQ = op->archdata.irqs[0];
369
370
371 if(sun_fdc->status_82072 == 0xff) {
372 sun_fdc = NULL;
373 goto no_sun_fdc;
374 }
375
376 sun_fdops.fd_inb = sun_82077_fd_inb;
377 sun_fdops.fd_outb = sun_82077_fd_outb;
378 fdc_status = &sun_fdc->status_82077;
379
380 if (sun_fdc->dor_82077 == 0x80) {
381 sun_fdc->dor_82077 = 0x02;
382 if (sun_fdc->dor_82077 == 0x80) {
383 sun_fdops.fd_inb = sun_82072_fd_inb;
384 sun_fdops.fd_outb = sun_82072_fd_outb;
385 fdc_status = &sun_fdc->status_82072;
386 }
387 }
388
389
390 allowed_drive_mask = 0x01;
391 return (int) sun_fdc;
392
393no_sun_fdc:
394 return -1;
395}
396
397static int sparc_eject(void)
398{
399 set_dor(0x00, 0xff, 0x90);
400 udelay(500);
401 set_dor(0x00, 0x6f, 0x00);
402 udelay(500);
403 return 0;
404}
405
406#define fd_eject(drive) sparc_eject()
407
408#define EXTRA_FLOPPY_PARAMS
409
410static DEFINE_SPINLOCK(dma_spin_lock);
411
412#define claim_dma_lock() \
413({ unsigned long flags; \
414 spin_lock_irqsave(&dma_spin_lock, flags); \
415 flags; \
416})
417
418#define release_dma_lock(__flags) \
419 spin_unlock_irqrestore(&dma_spin_lock, __flags);
420
421#endif
422