projects/linux·blob master · refs

212 lines · 5.0 KiB

1/*
2 * Architecture specific parts of the Floppy driver
3 *
4 * This file is subject to the terms and conditions of the GNU General Public
5 * License. See the file "COPYING" in the main directory of this archive
6 * for more details.
7 *
8 * Copyright (C) 1995
9 */
10#ifndef __ASM_POWERPC_FLOPPY_H
11#define __ASM_POWERPC_FLOPPY_H
12#ifdef __KERNEL__
13
14#include <asm/machdep.h>
15
16#define fd_inb(base, reg) inb_p((base) + (reg))
17#define fd_outb(value, base, reg) outb_p(value, (base) + (reg))
18
19#define fd_enable_dma() enable_dma(FLOPPY_DMA)
20#define fd_disable_dma() fd_ops->_disable_dma(FLOPPY_DMA)
21#define fd_free_dma() fd_ops->_free_dma(FLOPPY_DMA)
22#define fd_clear_dma_ff() clear_dma_ff(FLOPPY_DMA)
23#define fd_set_dma_mode(mode) set_dma_mode(FLOPPY_DMA, mode)
24#define fd_set_dma_count(count) set_dma_count(FLOPPY_DMA, count)
25#define fd_get_dma_residue() fd_ops->_get_dma_residue(FLOPPY_DMA)
26#define fd_enable_irq() enable_irq(FLOPPY_IRQ)
27#define fd_disable_irq() disable_irq(FLOPPY_IRQ)
28#define fd_free_irq() free_irq(FLOPPY_IRQ, NULL);
29
30#include <linux/pci.h>
31#include <asm/ppc-pci.h> /* for isa_bridge_pcidev */
32
33#define fd_dma_setup(addr,size,mode,io) fd_ops->_dma_setup(addr,size,mode,io)
34
35static int fd_request_dma(void);
36
37struct fd_dma_ops {
38 void (*_disable_dma)(unsigned int dmanr);
39 void (*_free_dma)(unsigned int dmanr);
40 int (*_get_dma_residue)(unsigned int dummy);
41 int (*_dma_setup)(char *addr, unsigned long size, int mode, int io);
42};
43
44static int virtual_dma_count;
45static int virtual_dma_residue;
46static char *virtual_dma_addr;
47static int virtual_dma_mode;
48static int doing_vdma;
49static struct fd_dma_ops *fd_ops;
50
51static irqreturn_t floppy_hardint(int irq, void *dev_id)
52{
53 unsigned char st;
54 int lcount;
55 char *lptr;
56
57 if (!doing_vdma)
58 return floppy_interrupt(irq, dev_id);
59
60
61 st = 1;
62 for (lcount=virtual_dma_count, lptr=virtual_dma_addr;
63 lcount; lcount--, lptr++) {
64 st = inb(virtual_dma_port + FD_STATUS);
65 st &= STATUS_DMA | STATUS_READY;
66 if (st != (STATUS_DMA | STATUS_READY))
67 break;
68 if (virtual_dma_mode)
69 outb_p(*lptr, virtual_dma_port + FD_DATA);
70 else
71 *lptr = inb_p(virtual_dma_port + FD_DATA);
72 }
73 virtual_dma_count = lcount;
74 virtual_dma_addr = lptr;
75 st = inb(virtual_dma_port + FD_STATUS);
76
77 if (st == STATUS_DMA)
78 return IRQ_HANDLED;
79 if (!(st & STATUS_DMA)) {
80 virtual_dma_residue += virtual_dma_count;
81 virtual_dma_count=0;
82 doing_vdma = 0;
83 floppy_interrupt(irq, dev_id);
84 return IRQ_HANDLED;
85 }
86 return IRQ_HANDLED;
87}
88
89static void vdma_disable_dma(unsigned int dummy)
90{
91 doing_vdma = 0;
92 virtual_dma_residue += virtual_dma_count;
93 virtual_dma_count=0;
94}
95
96static void vdma_nop(unsigned int dummy)
97{
98}
99
100
101static int vdma_get_dma_residue(unsigned int dummy)
102{
103 return virtual_dma_count + virtual_dma_residue;
104}
105
106
107static int fd_request_irq(void)
108{
109 if (can_use_virtual_dma)
110 return request_irq(FLOPPY_IRQ, floppy_hardint,
111 0, "floppy", NULL);
112 else
113 return request_irq(FLOPPY_IRQ, floppy_interrupt,
114 0, "floppy", NULL);
115}
116
117static int vdma_dma_setup(char *addr, unsigned long size, int mode, int io)
118{
119 doing_vdma = 1;
120 virtual_dma_port = io;
121 virtual_dma_mode = (mode == DMA_MODE_WRITE);
122 virtual_dma_addr = addr;
123 virtual_dma_count = size;
124 virtual_dma_residue = 0;
125 return 0;
126}
127
128static int hard_dma_setup(char *addr, unsigned long size, int mode, int io)
129{
130 static unsigned long prev_size;
131 static dma_addr_t bus_addr = 0;
132 static char *prev_addr;
133 static int prev_dir;
134 int dir;
135
136 doing_vdma = 0;
137 dir = (mode == DMA_MODE_READ) ? DMA_FROM_DEVICE : DMA_TO_DEVICE;
138
139 if (bus_addr
140 && (addr != prev_addr || size != prev_size || dir != prev_dir)) {
141 /* different from last time -- unmap prev */
142 dma_unmap_single(&isa_bridge_pcidev->dev, bus_addr, prev_size,
143 prev_dir);
144 bus_addr = 0;
145 }
146
147 if (!bus_addr) { /* need to map it */
148 bus_addr = dma_map_single(&isa_bridge_pcidev->dev, addr, size,
149 dir);
150 if (dma_mapping_error(&isa_bridge_pcidev->dev, bus_addr))
151 return -ENOMEM;
152 }
153
154 /* remember this one as prev */
155 prev_addr = addr;
156 prev_size = size;
157 prev_dir = dir;
158
159 fd_clear_dma_ff();
160 fd_set_dma_mode(mode);
161 set_dma_addr(FLOPPY_DMA, bus_addr);
162 fd_set_dma_count(size);
163 virtual_dma_port = io;
164 fd_enable_dma();
165
166 return 0;
167}
168
169static struct fd_dma_ops real_dma_ops =
170{
171 ._disable_dma = disable_dma,
172 ._free_dma = free_dma,
173 ._get_dma_residue = get_dma_residue,
174 ._dma_setup = hard_dma_setup
175};
176
177static struct fd_dma_ops virt_dma_ops =
178{
179 ._disable_dma = vdma_disable_dma,
180 ._free_dma = vdma_nop,
181 ._get_dma_residue = vdma_get_dma_residue,
182 ._dma_setup = vdma_dma_setup
183};
184
185static int fd_request_dma(void)
186{
187 if (can_use_virtual_dma & 1) {
188 fd_ops = &virt_dma_ops;
189 return 0;
190 }
191 else {
192 fd_ops = &real_dma_ops;
193 return request_dma(FLOPPY_DMA, "floppy");
194 }
195}
196
197static int FDC1 = 0x3f0;
198static int FDC2 = -1;
199
200/*
201 * Again, the CMOS information not available
202 */
203#define FLOPPY0_TYPE 6
204#define FLOPPY1_TYPE 0
205
206#define N_FDC 2 /* Don't change this! */
207#define N_DRIVE 8
208
209#define EXTRA_FLOPPY_PARAMS
210
211#endif /* __KERNEL__ */
212#endif /* __ASM_POWERPC_FLOPPY_H */