summaryrefslogtreecommitdiffstats
path: root/include/asm-i386/floppy.h
blob: eb7272ef629dc1957d6ac36212752ad831978d33 (plain)
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
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
#ifndef __ASM_I386_FLOPPY_H
#define __ASM_I386_FLOPPY_H

#include <linux/vmalloc.h>

#define SW fd_routine[use_virtual_dma&1]


#define fd_inb(port)			inb_p(port)
#define fd_outb(port,value)		outb_p(port,value)

#define fd_enable_dma(channel)		SW._enable_dma(channel)
#define fd_disable_dma(channel)		SW._disable_dma(channel)
#define fd_request_dma(channel)		SW._request_dma(channel, "floppy")
#define fd_free_dma(channel)		SW._free_dma(channel)
#define fd_clear_dma_ff(channel)	SW._clear_dma_ff(channel)
#define fd_set_dma_mode(channel,mode)	SW._set_dma_mode(channel, mode)
#define fd_set_dma_addr(channel,addr)	SW._set_dma_addr(channel, addr)
#define fd_set_dma_count(channel,count)	SW._set_dma_count(channel ,count)
#define fd_enable_irq(irq)		enable_irq(irq)
#define fd_disable_irq(irq)		disable_irq(irq)
#define fd_cacheflush(addr,size)	/* nothing */
#define fd_request_irq(irq)		SW._request_irq(irq, \
					                floppy_interrupt, \
							SA_INTERRUPT \
					                | SA_SAMPLE_RANDOM, \
							"floppy", NULL)
#define fd_free_irq(irq)		free_irq(irq, NULL)
#define fd_get_dma_residue(channel)	SW._get_dma_residue(channel)

#define fd_dma_mem_alloc(size)		SW._dma_mem_alloc(size)
#define fd_dma_mem_free(addr,size)	SW._dma_mem_free(addr,size)

static int virtual_dma_count=0;
static int virtual_dma_residue=0;
static char *virtual_dma_addr=0;
static int virtual_dma_mode=0;
static int doing_pdma=0;

static void floppy_hardint(int irq, void *dev_id, struct pt_regs * regs)
{
	register unsigned char st;

#undef TRACE_FLPY_INT
#undef 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, regs);
		return;
	}

#ifdef TRACE_FLPY_INT
	if(!calls)
		bytes = virtual_dma_count;
#endif

#ifndef NO_FLOPPY_ASSEMBLER
	__asm__ (
       "testl %1,%1
	je 3f
1:	inb %w4,%b0
	andb $160,%b0
	cmpb $160,%b0
	jne 2f
	incw %w4
	testl %3,%3
	jne 4f
	inb %w4,%b0
	movb %0,(%2)
	jmp 5f
4:     	movb (%2),%0
	outb %b0,%w4
5:	decw %w4
	outb %0,$0x80
	decl %1
	incl %2
	testl %1,%1
	jne 1b
3:	inb %w4,%b0
2:	"
       : "=a" ((char) st), 
       "=c" ((long) virtual_dma_count), 
       "=S" ((long) virtual_dma_addr)
       : "b" ((long) virtual_dma_mode),
       "d" ((short) virtual_dma_port+4), 
       "1" ((long) virtual_dma_count),
       "2" ((long) virtual_dma_addr));
#else	
	{
		register int lcount;
		register char *lptr;

		st = 1;
		for(lcount=virtual_dma_count, lptr=virtual_dma_addr; 
		    lcount; lcount--, lptr++) {
			st=inb(virtual_dma_port+4) & 0xa0 ;
			if(st != 0xa0) 
				break;
			if(virtual_dma_mode)
				outb_p(*lptr, virtual_dma_port+5);
			else
				*lptr = inb_p(virtual_dma_port+5);
			st = inb(virtual_dma_port+4);
		}
		virtual_dma_count = lcount;
		virtual_dma_addr = lptr;
	}
#endif

#ifdef TRACE_FLPY_INT
	calls++;
#endif
	if(st == 0x20)
		return;
	if(!(st & 0x20)) {
		virtual_dma_residue += virtual_dma_count;
		virtual_dma_count=0;
#ifdef TRACE_FLPY_INT
		printk("count=%x, residue=%x calls=%d bytes=%d dma_wait=%d\n", 
		       virtual_dma_count, virtual_dma_residue, calls, bytes,
		       dma_wait);
		calls = 0;
		dma_wait=0;
#endif
		doing_pdma = 0;
		floppy_interrupt(irq, dev_id, regs);
		return;
	}
#ifdef TRACE_FLPY_INT
	if(!virtual_dma_count)
		dma_wait++;
#endif
}

static void vdma_enable_dma(unsigned int dummy)
{
	doing_pdma = 1;
}

static void vdma_disable_dma(unsigned int dummy)
{
	doing_pdma = 0;
	virtual_dma_residue += virtual_dma_count;
	virtual_dma_count=0;		
}

static int vdma_request_dma(unsigned int dmanr, const char * device_id)
{
	return 0;
}

static void vdma_nop(unsigned int dummy)
{
}

static void vdma_set_dma_mode(unsigned int dummy,char mode)
{
	virtual_dma_mode = (mode  == DMA_MODE_WRITE);
}

static void hset_dma_addr(unsigned int no, char *addr)
{
	set_dma_addr(no, virt_to_bus(addr));
}

static void vdma_set_dma_addr(unsigned int dummy, char *addr)
{
	virtual_dma_addr = addr;
}

static void vdma_set_dma_count(unsigned int dummy,unsigned int count)
{
	virtual_dma_count = count;
	virtual_dma_residue = 0;
}

static int vdma_get_dma_residue(unsigned int dummy)
{
	return virtual_dma_count + virtual_dma_residue;
}


static int vdma_request_irq(unsigned int irq,
			    void (*handler)(int, void *, struct pt_regs *),
			    unsigned long flags, 
			    const char *device,
			    void *dev_id)
{
	return request_irq(irq, floppy_hardint,SA_INTERRUPT,device, dev_id);

}

/* Pure 2^n version of get_order */
extern __inline__ int __get_order(unsigned long size)
{
	int order;

	size = (size-1) >> (PAGE_SHIFT-1);
	order = -1;
	do {
		size >>= 1;
		order++;
	} while (size);
	return order;
}

static unsigned long dma_mem_alloc(unsigned long size)
{
	return __get_dma_pages(GFP_KERNEL,__get_order(size));
}

static void dma_mem_free(unsigned long addr, unsigned long size)
{
	free_pages(addr, __get_order(size));
}

static unsigned long vdma_mem_alloc(unsigned long size)
{
	return (unsigned long) vmalloc(size);
}

static void vdma_mem_free(unsigned long addr, unsigned long size)
{
	return vfree((void *)addr);
}

struct fd_routine_l {
	void (*_enable_dma)(unsigned int dummy);
	void (*_disable_dma)(unsigned int dummy);
	int (*_request_dma)(unsigned int dmanr, const char * device_id);
	void (*_free_dma)(unsigned int dmanr);
	void (*_clear_dma_ff)(unsigned int dummy);
	void (*_set_dma_mode)(unsigned int dummy, char mode);
	void (*_set_dma_addr)(unsigned int dummy, char *addr);
	void (*_set_dma_count)(unsigned int dummy, unsigned int count);
	int (*_get_dma_residue)(unsigned int dummy);
	int (*_request_irq)(unsigned int irq,
			   void (*handler)(int, void *, struct pt_regs *),
			   unsigned long flags, 
			   const char *device,
			   void *dev_id);
	unsigned long (*_dma_mem_alloc) (unsigned long size);
	void (*_dma_mem_free)(unsigned long addr, unsigned long size);
} fd_routine[] = {
	{
		enable_dma,
		disable_dma,
		request_dma,
		free_dma,
		clear_dma_ff,
		set_dma_mode,
		hset_dma_addr,
		set_dma_count,
		get_dma_residue,
		request_irq,
		dma_mem_alloc,
		dma_mem_free
	},
	{
		vdma_enable_dma,
		vdma_disable_dma,
		vdma_request_dma,
		vdma_nop,
		vdma_nop,
		vdma_set_dma_mode,
		vdma_set_dma_addr,
		vdma_set_dma_count,
		vdma_get_dma_residue,
		vdma_request_irq,
		vdma_mem_alloc,
		vdma_mem_free
	}
};

__inline__ void virtual_dma_init(void)
{
	/* Nothing to do on an i386 */
}

static int FDC1 = 0x3f0;
static int FDC2 = -1;

#define FLOPPY0_TYPE	((CMOS_READ(0x10) >> 4) & 15)
#define FLOPPY1_TYPE	(CMOS_READ(0x10) & 15)

#define N_FDC 2
#define N_DRIVE 8

#define FLOPPY_MOTOR_MASK 0xf0

/*
 * The DMA channel used by the floppy controller cannot access data at
 * addresses >= 16MB
 *
 * Went back to the 1MB limit, as some people had problems with the floppy
 * driver otherwise. It doesn't matter much for performance anyway, as most
 * floppy accesses go through the track buffer.
 */
#define CROSS_64KB(a,s) (((unsigned long)(a)/K_64 != ((unsigned long)(a) + (s) - 1) / K_64) && ! (use_virtual_dma & 1))

#endif /* __ASM_I386_FLOPPY_H */