xref: /OK3568_Linux_fs/kernel/arch/sparc/include/asm/floppy_64.h (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /* SPDX-License-Identifier: GPL-2.0 */
2*4882a593Smuzhiyun /* floppy.h: Sparc specific parts of the Floppy driver.
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * Copyright (C) 1996, 2007, 2008 David S. Miller (davem@davemloft.net)
5*4882a593Smuzhiyun  * Copyright (C) 1997 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Ultra/PCI support added: Sep 1997  Eddie C. Dost  (ecd@skynet.be)
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun #ifndef __ASM_SPARC64_FLOPPY_H
11*4882a593Smuzhiyun #define __ASM_SPARC64_FLOPPY_H
12*4882a593Smuzhiyun 
13*4882a593Smuzhiyun #include <linux/of.h>
14*4882a593Smuzhiyun #include <linux/of_device.h>
15*4882a593Smuzhiyun #include <linux/dma-mapping.h>
16*4882a593Smuzhiyun 
17*4882a593Smuzhiyun #include <asm/auxio.h>
18*4882a593Smuzhiyun 
19*4882a593Smuzhiyun /*
20*4882a593Smuzhiyun  * Define this to enable exchanging drive 0 and 1 if only drive 1 is
21*4882a593Smuzhiyun  * probed on PCI machines.
22*4882a593Smuzhiyun  */
23*4882a593Smuzhiyun #undef PCI_FDC_SWAP_DRIVES
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun /* References:
27*4882a593Smuzhiyun  * 1) Netbsd Sun floppy driver.
28*4882a593Smuzhiyun  * 2) NCR 82077 controller manual
29*4882a593Smuzhiyun  * 3) Intel 82077 controller manual
30*4882a593Smuzhiyun  */
31*4882a593Smuzhiyun struct sun_flpy_controller {
32*4882a593Smuzhiyun 	volatile unsigned char status1_82077; /* Auxiliary Status reg. 1 */
33*4882a593Smuzhiyun 	volatile unsigned char status2_82077; /* Auxiliary Status reg. 2 */
34*4882a593Smuzhiyun 	volatile unsigned char dor_82077;     /* Digital Output reg. */
35*4882a593Smuzhiyun 	volatile unsigned char tapectl_82077; /* Tape Control reg */
36*4882a593Smuzhiyun 	volatile unsigned char status_82077;  /* Main Status Register. */
37*4882a593Smuzhiyun #define drs_82077              status_82077   /* Digital Rate Select reg. */
38*4882a593Smuzhiyun 	volatile unsigned char data_82077;    /* Data fifo. */
39*4882a593Smuzhiyun 	volatile unsigned char ___unused;
40*4882a593Smuzhiyun 	volatile unsigned char dir_82077;     /* Digital Input reg. */
41*4882a593Smuzhiyun #define dcr_82077              dir_82077      /* Config Control reg. */
42*4882a593Smuzhiyun };
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun /* You'll only ever find one controller on an Ultra anyways. */
45*4882a593Smuzhiyun static struct sun_flpy_controller *sun_fdc = (struct sun_flpy_controller *)-1;
46*4882a593Smuzhiyun unsigned long fdc_status;
47*4882a593Smuzhiyun static struct platform_device *floppy_op = NULL;
48*4882a593Smuzhiyun 
49*4882a593Smuzhiyun struct sun_floppy_ops {
50*4882a593Smuzhiyun 	unsigned char	(*fd_inb) (unsigned long port, unsigned int reg);
51*4882a593Smuzhiyun 	void		(*fd_outb) (unsigned char value, unsigned long base,
52*4882a593Smuzhiyun 				    unsigned int reg);
53*4882a593Smuzhiyun 	void		(*fd_enable_dma) (void);
54*4882a593Smuzhiyun 	void		(*fd_disable_dma) (void);
55*4882a593Smuzhiyun 	void		(*fd_set_dma_mode) (int);
56*4882a593Smuzhiyun 	void		(*fd_set_dma_addr) (char *);
57*4882a593Smuzhiyun 	void		(*fd_set_dma_count) (int);
58*4882a593Smuzhiyun 	unsigned int	(*get_dma_residue) (void);
59*4882a593Smuzhiyun 	int		(*fd_request_irq) (void);
60*4882a593Smuzhiyun 	void		(*fd_free_irq) (void);
61*4882a593Smuzhiyun 	int		(*fd_eject) (int);
62*4882a593Smuzhiyun };
63*4882a593Smuzhiyun 
64*4882a593Smuzhiyun static struct sun_floppy_ops sun_fdops;
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun #define fd_inb(base, reg)         sun_fdops.fd_inb(base, reg)
67*4882a593Smuzhiyun #define fd_outb(value, base, reg) sun_fdops.fd_outb(value, base, reg)
68*4882a593Smuzhiyun #define fd_enable_dma()           sun_fdops.fd_enable_dma()
69*4882a593Smuzhiyun #define fd_disable_dma()          sun_fdops.fd_disable_dma()
70*4882a593Smuzhiyun #define fd_request_dma()          (0) /* nothing... */
71*4882a593Smuzhiyun #define fd_free_dma()             /* nothing... */
72*4882a593Smuzhiyun #define fd_clear_dma_ff()         /* nothing... */
73*4882a593Smuzhiyun #define fd_set_dma_mode(mode)     sun_fdops.fd_set_dma_mode(mode)
74*4882a593Smuzhiyun #define fd_set_dma_addr(addr)     sun_fdops.fd_set_dma_addr(addr)
75*4882a593Smuzhiyun #define fd_set_dma_count(count)   sun_fdops.fd_set_dma_count(count)
76*4882a593Smuzhiyun #define get_dma_residue(x)        sun_fdops.get_dma_residue()
77*4882a593Smuzhiyun #define fd_request_irq()          sun_fdops.fd_request_irq()
78*4882a593Smuzhiyun #define fd_free_irq()             sun_fdops.fd_free_irq()
79*4882a593Smuzhiyun #define fd_eject(drive)           sun_fdops.fd_eject(drive)
80*4882a593Smuzhiyun 
81*4882a593Smuzhiyun /* Super paranoid... */
82*4882a593Smuzhiyun #undef HAVE_DISABLE_HLT
83*4882a593Smuzhiyun 
84*4882a593Smuzhiyun static int sun_floppy_types[2] = { 0, 0 };
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun /* Here is where we catch the floppy driver trying to initialize,
87*4882a593Smuzhiyun  * therefore this is where we call the PROM device tree probing
88*4882a593Smuzhiyun  * routine etc. on the Sparc.
89*4882a593Smuzhiyun  */
90*4882a593Smuzhiyun #define FLOPPY0_TYPE		sun_floppy_init()
91*4882a593Smuzhiyun #define FLOPPY1_TYPE		sun_floppy_types[1]
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun #define FDC1			((unsigned long)sun_fdc)
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun #define N_FDC    1
96*4882a593Smuzhiyun #define N_DRIVE  8
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun /* No 64k boundary crossing problems on the Sparc. */
99*4882a593Smuzhiyun #define CROSS_64KB(a,s) (0)
100*4882a593Smuzhiyun 
sun_82077_fd_inb(unsigned long base,unsigned int reg)101*4882a593Smuzhiyun static unsigned char sun_82077_fd_inb(unsigned long base, unsigned int reg)
102*4882a593Smuzhiyun {
103*4882a593Smuzhiyun 	udelay(5);
104*4882a593Smuzhiyun 	switch (reg) {
105*4882a593Smuzhiyun 	default:
106*4882a593Smuzhiyun 		printk("floppy: Asked to read unknown port %x\n", reg);
107*4882a593Smuzhiyun 		panic("floppy: Port bolixed.");
108*4882a593Smuzhiyun 	case FD_STATUS:
109*4882a593Smuzhiyun 		return sbus_readb(&sun_fdc->status_82077) & ~STATUS_DMA;
110*4882a593Smuzhiyun 	case FD_DATA:
111*4882a593Smuzhiyun 		return sbus_readb(&sun_fdc->data_82077);
112*4882a593Smuzhiyun 	case FD_DIR:
113*4882a593Smuzhiyun 		/* XXX: Is DCL on 0x80 in sun4m? */
114*4882a593Smuzhiyun 		return sbus_readb(&sun_fdc->dir_82077);
115*4882a593Smuzhiyun 	}
116*4882a593Smuzhiyun 	panic("sun_82072_fd_inb: How did I get here?");
117*4882a593Smuzhiyun }
118*4882a593Smuzhiyun 
sun_82077_fd_outb(unsigned char value,unsigned long base,unsigned int reg)119*4882a593Smuzhiyun static void sun_82077_fd_outb(unsigned char value, unsigned long base,
120*4882a593Smuzhiyun 			      unsigned int reg)
121*4882a593Smuzhiyun {
122*4882a593Smuzhiyun 	udelay(5);
123*4882a593Smuzhiyun 	switch (reg) {
124*4882a593Smuzhiyun 	default:
125*4882a593Smuzhiyun 		printk("floppy: Asked to write to unknown port %x\n", reg);
126*4882a593Smuzhiyun 		panic("floppy: Port bolixed.");
127*4882a593Smuzhiyun 	case FD_DOR:
128*4882a593Smuzhiyun 		/* Happily, the 82077 has a real DOR register. */
129*4882a593Smuzhiyun 		sbus_writeb(value, &sun_fdc->dor_82077);
130*4882a593Smuzhiyun 		break;
131*4882a593Smuzhiyun 	case FD_DATA:
132*4882a593Smuzhiyun 		sbus_writeb(value, &sun_fdc->data_82077);
133*4882a593Smuzhiyun 		break;
134*4882a593Smuzhiyun 	case FD_DCR:
135*4882a593Smuzhiyun 		sbus_writeb(value, &sun_fdc->dcr_82077);
136*4882a593Smuzhiyun 		break;
137*4882a593Smuzhiyun 	case FD_DSR:
138*4882a593Smuzhiyun 		sbus_writeb(value, &sun_fdc->status_82077);
139*4882a593Smuzhiyun 		break;
140*4882a593Smuzhiyun 	}
141*4882a593Smuzhiyun 	return;
142*4882a593Smuzhiyun }
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun /* For pseudo-dma (Sun floppy drives have no real DMA available to
145*4882a593Smuzhiyun  * them so we must eat the data fifo bytes directly ourselves) we have
146*4882a593Smuzhiyun  * three state variables.  doing_pdma tells our inline low-level
147*4882a593Smuzhiyun  * assembly floppy interrupt entry point whether it should sit and eat
148*4882a593Smuzhiyun  * bytes from the fifo or just transfer control up to the higher level
149*4882a593Smuzhiyun  * floppy interrupt c-code.  I tried very hard but I could not get the
150*4882a593Smuzhiyun  * pseudo-dma to work in c-code without getting many overruns and
151*4882a593Smuzhiyun  * underruns.  If non-zero, doing_pdma encodes the direction of
152*4882a593Smuzhiyun  * the transfer for debugging.  1=read 2=write
153*4882a593Smuzhiyun  */
154*4882a593Smuzhiyun unsigned char *pdma_vaddr;
155*4882a593Smuzhiyun unsigned long pdma_size;
156*4882a593Smuzhiyun volatile int doing_pdma = 0;
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun /* This is software state */
159*4882a593Smuzhiyun char *pdma_base = NULL;
160*4882a593Smuzhiyun unsigned long pdma_areasize;
161*4882a593Smuzhiyun 
162*4882a593Smuzhiyun /* Common routines to all controller types on the Sparc. */
sun_fd_disable_dma(void)163*4882a593Smuzhiyun static void sun_fd_disable_dma(void)
164*4882a593Smuzhiyun {
165*4882a593Smuzhiyun 	doing_pdma = 0;
166*4882a593Smuzhiyun 	pdma_base = NULL;
167*4882a593Smuzhiyun }
168*4882a593Smuzhiyun 
sun_fd_set_dma_mode(int mode)169*4882a593Smuzhiyun static void sun_fd_set_dma_mode(int mode)
170*4882a593Smuzhiyun {
171*4882a593Smuzhiyun 	switch(mode) {
172*4882a593Smuzhiyun 	case DMA_MODE_READ:
173*4882a593Smuzhiyun 		doing_pdma = 1;
174*4882a593Smuzhiyun 		break;
175*4882a593Smuzhiyun 	case DMA_MODE_WRITE:
176*4882a593Smuzhiyun 		doing_pdma = 2;
177*4882a593Smuzhiyun 		break;
178*4882a593Smuzhiyun 	default:
179*4882a593Smuzhiyun 		printk("Unknown dma mode %d\n", mode);
180*4882a593Smuzhiyun 		panic("floppy: Giving up...");
181*4882a593Smuzhiyun 	}
182*4882a593Smuzhiyun }
183*4882a593Smuzhiyun 
sun_fd_set_dma_addr(char * buffer)184*4882a593Smuzhiyun static void sun_fd_set_dma_addr(char *buffer)
185*4882a593Smuzhiyun {
186*4882a593Smuzhiyun 	pdma_vaddr = buffer;
187*4882a593Smuzhiyun }
188*4882a593Smuzhiyun 
sun_fd_set_dma_count(int length)189*4882a593Smuzhiyun static void sun_fd_set_dma_count(int length)
190*4882a593Smuzhiyun {
191*4882a593Smuzhiyun 	pdma_size = length;
192*4882a593Smuzhiyun }
193*4882a593Smuzhiyun 
sun_fd_enable_dma(void)194*4882a593Smuzhiyun static void sun_fd_enable_dma(void)
195*4882a593Smuzhiyun {
196*4882a593Smuzhiyun 	pdma_base = pdma_vaddr;
197*4882a593Smuzhiyun 	pdma_areasize = pdma_size;
198*4882a593Smuzhiyun }
199*4882a593Smuzhiyun 
sparc_floppy_irq(int irq,void * dev_cookie)200*4882a593Smuzhiyun irqreturn_t sparc_floppy_irq(int irq, void *dev_cookie)
201*4882a593Smuzhiyun {
202*4882a593Smuzhiyun 	if (likely(doing_pdma)) {
203*4882a593Smuzhiyun 		void __iomem *stat = (void __iomem *) fdc_status;
204*4882a593Smuzhiyun 		unsigned char *vaddr = pdma_vaddr;
205*4882a593Smuzhiyun 		unsigned long size = pdma_size;
206*4882a593Smuzhiyun 		u8 val;
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun 		while (size) {
209*4882a593Smuzhiyun 			val = readb(stat);
210*4882a593Smuzhiyun 			if (unlikely(!(val & 0x80))) {
211*4882a593Smuzhiyun 				pdma_vaddr = vaddr;
212*4882a593Smuzhiyun 				pdma_size = size;
213*4882a593Smuzhiyun 				return IRQ_HANDLED;
214*4882a593Smuzhiyun 			}
215*4882a593Smuzhiyun 			if (unlikely(!(val & 0x20))) {
216*4882a593Smuzhiyun 				pdma_vaddr = vaddr;
217*4882a593Smuzhiyun 				pdma_size = size;
218*4882a593Smuzhiyun 				doing_pdma = 0;
219*4882a593Smuzhiyun 				goto main_interrupt;
220*4882a593Smuzhiyun 			}
221*4882a593Smuzhiyun 			if (val & 0x40) {
222*4882a593Smuzhiyun 				/* read */
223*4882a593Smuzhiyun 				*vaddr++ = readb(stat + 1);
224*4882a593Smuzhiyun 			} else {
225*4882a593Smuzhiyun 				unsigned char data = *vaddr++;
226*4882a593Smuzhiyun 
227*4882a593Smuzhiyun 				/* write */
228*4882a593Smuzhiyun 				writeb(data, stat + 1);
229*4882a593Smuzhiyun 			}
230*4882a593Smuzhiyun 			size--;
231*4882a593Smuzhiyun 		}
232*4882a593Smuzhiyun 
233*4882a593Smuzhiyun 		pdma_vaddr = vaddr;
234*4882a593Smuzhiyun 		pdma_size = size;
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 		/* Send Terminal Count pulse to floppy controller. */
237*4882a593Smuzhiyun 		val = readb(auxio_register);
238*4882a593Smuzhiyun 		val |= AUXIO_AUX1_FTCNT;
239*4882a593Smuzhiyun 		writeb(val, auxio_register);
240*4882a593Smuzhiyun 		val &= ~AUXIO_AUX1_FTCNT;
241*4882a593Smuzhiyun 		writeb(val, auxio_register);
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun 		doing_pdma = 0;
244*4882a593Smuzhiyun 	}
245*4882a593Smuzhiyun 
246*4882a593Smuzhiyun main_interrupt:
247*4882a593Smuzhiyun 	return floppy_interrupt(irq, dev_cookie);
248*4882a593Smuzhiyun }
249*4882a593Smuzhiyun 
sun_fd_request_irq(void)250*4882a593Smuzhiyun static int sun_fd_request_irq(void)
251*4882a593Smuzhiyun {
252*4882a593Smuzhiyun 	static int once = 0;
253*4882a593Smuzhiyun 	int error;
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 	if(!once) {
256*4882a593Smuzhiyun 		once = 1;
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun 		error = request_irq(FLOPPY_IRQ, sparc_floppy_irq,
259*4882a593Smuzhiyun 				    0, "floppy", NULL);
260*4882a593Smuzhiyun 
261*4882a593Smuzhiyun 		return ((error == 0) ? 0 : -1);
262*4882a593Smuzhiyun 	}
263*4882a593Smuzhiyun 	return 0;
264*4882a593Smuzhiyun }
265*4882a593Smuzhiyun 
sun_fd_free_irq(void)266*4882a593Smuzhiyun static void sun_fd_free_irq(void)
267*4882a593Smuzhiyun {
268*4882a593Smuzhiyun }
269*4882a593Smuzhiyun 
sun_get_dma_residue(void)270*4882a593Smuzhiyun static unsigned int sun_get_dma_residue(void)
271*4882a593Smuzhiyun {
272*4882a593Smuzhiyun 	/* XXX This isn't really correct. XXX */
273*4882a593Smuzhiyun 	return 0;
274*4882a593Smuzhiyun }
275*4882a593Smuzhiyun 
sun_fd_eject(int drive)276*4882a593Smuzhiyun static int sun_fd_eject(int drive)
277*4882a593Smuzhiyun {
278*4882a593Smuzhiyun 	set_dor(0x00, 0xff, 0x90);
279*4882a593Smuzhiyun 	udelay(500);
280*4882a593Smuzhiyun 	set_dor(0x00, 0x6f, 0x00);
281*4882a593Smuzhiyun 	udelay(500);
282*4882a593Smuzhiyun 	return 0;
283*4882a593Smuzhiyun }
284*4882a593Smuzhiyun 
285*4882a593Smuzhiyun #include <asm/ebus_dma.h>
286*4882a593Smuzhiyun #include <asm/ns87303.h>
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun static struct ebus_dma_info sun_pci_fd_ebus_dma;
289*4882a593Smuzhiyun static struct device *sun_floppy_dev;
290*4882a593Smuzhiyun static int sun_pci_broken_drive = -1;
291*4882a593Smuzhiyun 
292*4882a593Smuzhiyun struct sun_pci_dma_op {
293*4882a593Smuzhiyun 	unsigned int 	addr;
294*4882a593Smuzhiyun 	int		len;
295*4882a593Smuzhiyun 	int		direction;
296*4882a593Smuzhiyun 	char		*buf;
297*4882a593Smuzhiyun };
298*4882a593Smuzhiyun static struct sun_pci_dma_op sun_pci_dma_current = { -1U, 0, 0, NULL};
299*4882a593Smuzhiyun static struct sun_pci_dma_op sun_pci_dma_pending = { -1U, 0, 0, NULL};
300*4882a593Smuzhiyun 
301*4882a593Smuzhiyun irqreturn_t floppy_interrupt(int irq, void *dev_id);
302*4882a593Smuzhiyun 
sun_pci_fd_inb(unsigned long base,unsigned int reg)303*4882a593Smuzhiyun static unsigned char sun_pci_fd_inb(unsigned long base, unsigned int reg)
304*4882a593Smuzhiyun {
305*4882a593Smuzhiyun 	udelay(5);
306*4882a593Smuzhiyun 	return inb(base + reg);
307*4882a593Smuzhiyun }
308*4882a593Smuzhiyun 
sun_pci_fd_outb(unsigned char val,unsigned long base,unsigned int reg)309*4882a593Smuzhiyun static void sun_pci_fd_outb(unsigned char val, unsigned long base,
310*4882a593Smuzhiyun 			    unsigned int reg)
311*4882a593Smuzhiyun {
312*4882a593Smuzhiyun 	udelay(5);
313*4882a593Smuzhiyun 	outb(val, base + reg);
314*4882a593Smuzhiyun }
315*4882a593Smuzhiyun 
sun_pci_fd_broken_outb(unsigned char val,unsigned long base,unsigned int reg)316*4882a593Smuzhiyun static void sun_pci_fd_broken_outb(unsigned char val, unsigned long base,
317*4882a593Smuzhiyun 				   unsigned int reg)
318*4882a593Smuzhiyun {
319*4882a593Smuzhiyun 	udelay(5);
320*4882a593Smuzhiyun 	/*
321*4882a593Smuzhiyun 	 * XXX: Due to SUN's broken floppy connector on AX and AXi
322*4882a593Smuzhiyun 	 *      we need to turn on MOTOR_0 also, if the floppy is
323*4882a593Smuzhiyun 	 *      jumpered to DS1 (like most PC floppies are). I hope
324*4882a593Smuzhiyun 	 *      this does not hurt correct hardware like the AXmp.
325*4882a593Smuzhiyun 	 *      (Eddie, Sep 12 1998).
326*4882a593Smuzhiyun 	 */
327*4882a593Smuzhiyun 	if (reg == FD_DOR) {
328*4882a593Smuzhiyun 		if (((val & 0x03) == sun_pci_broken_drive) && (val & 0x20)) {
329*4882a593Smuzhiyun 			val |= 0x10;
330*4882a593Smuzhiyun 		}
331*4882a593Smuzhiyun 	}
332*4882a593Smuzhiyun 	outb(val, base + reg);
333*4882a593Smuzhiyun }
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun #ifdef PCI_FDC_SWAP_DRIVES
sun_pci_fd_lde_broken_outb(unsigned char val,unsigned long base,unsigned int reg)336*4882a593Smuzhiyun static void sun_pci_fd_lde_broken_outb(unsigned char val, unsigned long base,
337*4882a593Smuzhiyun 				       unsigned int reg)
338*4882a593Smuzhiyun {
339*4882a593Smuzhiyun 	udelay(5);
340*4882a593Smuzhiyun 	/*
341*4882a593Smuzhiyun 	 * XXX: Due to SUN's broken floppy connector on AX and AXi
342*4882a593Smuzhiyun 	 *      we need to turn on MOTOR_0 also, if the floppy is
343*4882a593Smuzhiyun 	 *      jumpered to DS1 (like most PC floppies are). I hope
344*4882a593Smuzhiyun 	 *      this does not hurt correct hardware like the AXmp.
345*4882a593Smuzhiyun 	 *      (Eddie, Sep 12 1998).
346*4882a593Smuzhiyun 	 */
347*4882a593Smuzhiyun 	if (reg == FD_DOR) {
348*4882a593Smuzhiyun 		if (((val & 0x03) == sun_pci_broken_drive) && (val & 0x10)) {
349*4882a593Smuzhiyun 			val &= ~(0x03);
350*4882a593Smuzhiyun 			val |= 0x21;
351*4882a593Smuzhiyun 		}
352*4882a593Smuzhiyun 	}
353*4882a593Smuzhiyun 	outb(val, base + reg);
354*4882a593Smuzhiyun }
355*4882a593Smuzhiyun #endif /* PCI_FDC_SWAP_DRIVES */
356*4882a593Smuzhiyun 
sun_pci_fd_enable_dma(void)357*4882a593Smuzhiyun static void sun_pci_fd_enable_dma(void)
358*4882a593Smuzhiyun {
359*4882a593Smuzhiyun 	BUG_ON((NULL == sun_pci_dma_pending.buf) 	||
360*4882a593Smuzhiyun 	    (0	  == sun_pci_dma_pending.len) 	||
361*4882a593Smuzhiyun 	    (0	  == sun_pci_dma_pending.direction));
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 	sun_pci_dma_current.buf = sun_pci_dma_pending.buf;
364*4882a593Smuzhiyun 	sun_pci_dma_current.len = sun_pci_dma_pending.len;
365*4882a593Smuzhiyun 	sun_pci_dma_current.direction = sun_pci_dma_pending.direction;
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 	sun_pci_dma_pending.buf  = NULL;
368*4882a593Smuzhiyun 	sun_pci_dma_pending.len  = 0;
369*4882a593Smuzhiyun 	sun_pci_dma_pending.direction = 0;
370*4882a593Smuzhiyun 	sun_pci_dma_pending.addr = -1U;
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun 	sun_pci_dma_current.addr =
373*4882a593Smuzhiyun 		dma_map_single(sun_floppy_dev,
374*4882a593Smuzhiyun 			       sun_pci_dma_current.buf,
375*4882a593Smuzhiyun 			       sun_pci_dma_current.len,
376*4882a593Smuzhiyun 			       sun_pci_dma_current.direction);
377*4882a593Smuzhiyun 
378*4882a593Smuzhiyun 	ebus_dma_enable(&sun_pci_fd_ebus_dma, 1);
379*4882a593Smuzhiyun 
380*4882a593Smuzhiyun 	if (ebus_dma_request(&sun_pci_fd_ebus_dma,
381*4882a593Smuzhiyun 			     sun_pci_dma_current.addr,
382*4882a593Smuzhiyun 			     sun_pci_dma_current.len))
383*4882a593Smuzhiyun 		BUG();
384*4882a593Smuzhiyun }
385*4882a593Smuzhiyun 
sun_pci_fd_disable_dma(void)386*4882a593Smuzhiyun static void sun_pci_fd_disable_dma(void)
387*4882a593Smuzhiyun {
388*4882a593Smuzhiyun 	ebus_dma_enable(&sun_pci_fd_ebus_dma, 0);
389*4882a593Smuzhiyun 	if (sun_pci_dma_current.addr != -1U)
390*4882a593Smuzhiyun 		dma_unmap_single(sun_floppy_dev,
391*4882a593Smuzhiyun 				 sun_pci_dma_current.addr,
392*4882a593Smuzhiyun 				 sun_pci_dma_current.len,
393*4882a593Smuzhiyun 				 sun_pci_dma_current.direction);
394*4882a593Smuzhiyun 	sun_pci_dma_current.addr = -1U;
395*4882a593Smuzhiyun }
396*4882a593Smuzhiyun 
sun_pci_fd_set_dma_mode(int mode)397*4882a593Smuzhiyun static void sun_pci_fd_set_dma_mode(int mode)
398*4882a593Smuzhiyun {
399*4882a593Smuzhiyun 	if (mode == DMA_MODE_WRITE)
400*4882a593Smuzhiyun 		sun_pci_dma_pending.direction = DMA_TO_DEVICE;
401*4882a593Smuzhiyun 	else
402*4882a593Smuzhiyun 		sun_pci_dma_pending.direction = DMA_FROM_DEVICE;
403*4882a593Smuzhiyun 
404*4882a593Smuzhiyun 	ebus_dma_prepare(&sun_pci_fd_ebus_dma, mode != DMA_MODE_WRITE);
405*4882a593Smuzhiyun }
406*4882a593Smuzhiyun 
sun_pci_fd_set_dma_count(int length)407*4882a593Smuzhiyun static void sun_pci_fd_set_dma_count(int length)
408*4882a593Smuzhiyun {
409*4882a593Smuzhiyun 	sun_pci_dma_pending.len = length;
410*4882a593Smuzhiyun }
411*4882a593Smuzhiyun 
sun_pci_fd_set_dma_addr(char * buffer)412*4882a593Smuzhiyun static void sun_pci_fd_set_dma_addr(char *buffer)
413*4882a593Smuzhiyun {
414*4882a593Smuzhiyun 	sun_pci_dma_pending.buf = buffer;
415*4882a593Smuzhiyun }
416*4882a593Smuzhiyun 
sun_pci_get_dma_residue(void)417*4882a593Smuzhiyun static unsigned int sun_pci_get_dma_residue(void)
418*4882a593Smuzhiyun {
419*4882a593Smuzhiyun 	return ebus_dma_residue(&sun_pci_fd_ebus_dma);
420*4882a593Smuzhiyun }
421*4882a593Smuzhiyun 
sun_pci_fd_request_irq(void)422*4882a593Smuzhiyun static int sun_pci_fd_request_irq(void)
423*4882a593Smuzhiyun {
424*4882a593Smuzhiyun 	return ebus_dma_irq_enable(&sun_pci_fd_ebus_dma, 1);
425*4882a593Smuzhiyun }
426*4882a593Smuzhiyun 
sun_pci_fd_free_irq(void)427*4882a593Smuzhiyun static void sun_pci_fd_free_irq(void)
428*4882a593Smuzhiyun {
429*4882a593Smuzhiyun 	ebus_dma_irq_enable(&sun_pci_fd_ebus_dma, 0);
430*4882a593Smuzhiyun }
431*4882a593Smuzhiyun 
sun_pci_fd_eject(int drive)432*4882a593Smuzhiyun static int sun_pci_fd_eject(int drive)
433*4882a593Smuzhiyun {
434*4882a593Smuzhiyun 	return -EINVAL;
435*4882a593Smuzhiyun }
436*4882a593Smuzhiyun 
sun_pci_fd_dma_callback(struct ebus_dma_info * p,int event,void * cookie)437*4882a593Smuzhiyun void sun_pci_fd_dma_callback(struct ebus_dma_info *p, int event, void *cookie)
438*4882a593Smuzhiyun {
439*4882a593Smuzhiyun 	floppy_interrupt(0, NULL);
440*4882a593Smuzhiyun }
441*4882a593Smuzhiyun 
442*4882a593Smuzhiyun /*
443*4882a593Smuzhiyun  * Floppy probing, we'd like to use /dev/fd0 for a single Floppy on PCI,
444*4882a593Smuzhiyun  * even if this is configured using DS1, thus looks like /dev/fd1 with
445*4882a593Smuzhiyun  * the cabling used in Ultras.
446*4882a593Smuzhiyun  */
447*4882a593Smuzhiyun #define DOR	(port + 2)
448*4882a593Smuzhiyun #define MSR	(port + 4)
449*4882a593Smuzhiyun #define FIFO	(port + 5)
450*4882a593Smuzhiyun 
sun_pci_fd_out_byte(unsigned long port,unsigned char val,unsigned long reg)451*4882a593Smuzhiyun static void sun_pci_fd_out_byte(unsigned long port, unsigned char val,
452*4882a593Smuzhiyun 			        unsigned long reg)
453*4882a593Smuzhiyun {
454*4882a593Smuzhiyun 	unsigned char status;
455*4882a593Smuzhiyun 	int timeout = 1000;
456*4882a593Smuzhiyun 
457*4882a593Smuzhiyun 	while (!((status = inb(MSR)) & 0x80) && --timeout)
458*4882a593Smuzhiyun 		udelay(100);
459*4882a593Smuzhiyun 	outb(val, reg);
460*4882a593Smuzhiyun }
461*4882a593Smuzhiyun 
sun_pci_fd_sensei(unsigned long port)462*4882a593Smuzhiyun static unsigned char sun_pci_fd_sensei(unsigned long port)
463*4882a593Smuzhiyun {
464*4882a593Smuzhiyun 	unsigned char result[2] = { 0x70, 0x00 };
465*4882a593Smuzhiyun 	unsigned char status;
466*4882a593Smuzhiyun 	int i = 0;
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 	sun_pci_fd_out_byte(port, 0x08, FIFO);
469*4882a593Smuzhiyun 	do {
470*4882a593Smuzhiyun 		int timeout = 1000;
471*4882a593Smuzhiyun 
472*4882a593Smuzhiyun 		while (!((status = inb(MSR)) & 0x80) && --timeout)
473*4882a593Smuzhiyun 			udelay(100);
474*4882a593Smuzhiyun 
475*4882a593Smuzhiyun 		if (!timeout)
476*4882a593Smuzhiyun 			break;
477*4882a593Smuzhiyun 
478*4882a593Smuzhiyun 		if ((status & 0xf0) == 0xd0)
479*4882a593Smuzhiyun 			result[i++] = inb(FIFO);
480*4882a593Smuzhiyun 		else
481*4882a593Smuzhiyun 			break;
482*4882a593Smuzhiyun 	} while (i < 2);
483*4882a593Smuzhiyun 
484*4882a593Smuzhiyun 	return result[0];
485*4882a593Smuzhiyun }
486*4882a593Smuzhiyun 
sun_pci_fd_reset(unsigned long port)487*4882a593Smuzhiyun static void sun_pci_fd_reset(unsigned long port)
488*4882a593Smuzhiyun {
489*4882a593Smuzhiyun 	unsigned char mask = 0x00;
490*4882a593Smuzhiyun 	unsigned char status;
491*4882a593Smuzhiyun 	int timeout = 10000;
492*4882a593Smuzhiyun 
493*4882a593Smuzhiyun 	outb(0x80, MSR);
494*4882a593Smuzhiyun 	do {
495*4882a593Smuzhiyun 		status = sun_pci_fd_sensei(port);
496*4882a593Smuzhiyun 		if ((status & 0xc0) == 0xc0)
497*4882a593Smuzhiyun 			mask |= 1 << (status & 0x03);
498*4882a593Smuzhiyun 		else
499*4882a593Smuzhiyun 			udelay(100);
500*4882a593Smuzhiyun 	} while ((mask != 0x0f) && --timeout);
501*4882a593Smuzhiyun }
502*4882a593Smuzhiyun 
sun_pci_fd_test_drive(unsigned long port,int drive)503*4882a593Smuzhiyun static int sun_pci_fd_test_drive(unsigned long port, int drive)
504*4882a593Smuzhiyun {
505*4882a593Smuzhiyun 	unsigned char status, data;
506*4882a593Smuzhiyun 	int timeout = 1000;
507*4882a593Smuzhiyun 	int ready;
508*4882a593Smuzhiyun 
509*4882a593Smuzhiyun 	sun_pci_fd_reset(port);
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun 	data = (0x10 << drive) | 0x0c | drive;
512*4882a593Smuzhiyun 	sun_pci_fd_out_byte(port, data, DOR);
513*4882a593Smuzhiyun 
514*4882a593Smuzhiyun 	sun_pci_fd_out_byte(port, 0x07, FIFO);
515*4882a593Smuzhiyun 	sun_pci_fd_out_byte(port, drive & 0x03, FIFO);
516*4882a593Smuzhiyun 
517*4882a593Smuzhiyun 	do {
518*4882a593Smuzhiyun 		udelay(100);
519*4882a593Smuzhiyun 		status = sun_pci_fd_sensei(port);
520*4882a593Smuzhiyun 	} while (((status & 0xc0) == 0x80) && --timeout);
521*4882a593Smuzhiyun 
522*4882a593Smuzhiyun 	if (!timeout)
523*4882a593Smuzhiyun 		ready = 0;
524*4882a593Smuzhiyun 	else
525*4882a593Smuzhiyun 		ready = (status & 0x10) ? 0 : 1;
526*4882a593Smuzhiyun 
527*4882a593Smuzhiyun 	sun_pci_fd_reset(port);
528*4882a593Smuzhiyun 	return ready;
529*4882a593Smuzhiyun }
530*4882a593Smuzhiyun #undef FIFO
531*4882a593Smuzhiyun #undef MSR
532*4882a593Smuzhiyun #undef DOR
533*4882a593Smuzhiyun 
ebus_fdthree_p(struct device_node * dp)534*4882a593Smuzhiyun static int __init ebus_fdthree_p(struct device_node *dp)
535*4882a593Smuzhiyun {
536*4882a593Smuzhiyun 	if (of_node_name_eq(dp, "fdthree"))
537*4882a593Smuzhiyun 		return 1;
538*4882a593Smuzhiyun 	if (of_node_name_eq(dp, "floppy")) {
539*4882a593Smuzhiyun 		const char *compat;
540*4882a593Smuzhiyun 
541*4882a593Smuzhiyun 		compat = of_get_property(dp, "compatible", NULL);
542*4882a593Smuzhiyun 		if (compat && !strcmp(compat, "fdthree"))
543*4882a593Smuzhiyun 			return 1;
544*4882a593Smuzhiyun 	}
545*4882a593Smuzhiyun 	return 0;
546*4882a593Smuzhiyun }
547*4882a593Smuzhiyun 
sun_floppy_init(void)548*4882a593Smuzhiyun static unsigned long __init sun_floppy_init(void)
549*4882a593Smuzhiyun {
550*4882a593Smuzhiyun 	static int initialized = 0;
551*4882a593Smuzhiyun 	struct device_node *dp;
552*4882a593Smuzhiyun 	struct platform_device *op;
553*4882a593Smuzhiyun 	const char *prop;
554*4882a593Smuzhiyun 	char state[128];
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun 	if (initialized)
557*4882a593Smuzhiyun 		return sun_floppy_types[0];
558*4882a593Smuzhiyun 	initialized = 1;
559*4882a593Smuzhiyun 
560*4882a593Smuzhiyun 	op = NULL;
561*4882a593Smuzhiyun 
562*4882a593Smuzhiyun 	for_each_node_by_name(dp, "SUNW,fdtwo") {
563*4882a593Smuzhiyun 		if (!of_node_name_eq(dp->parent, "sbus"))
564*4882a593Smuzhiyun 			continue;
565*4882a593Smuzhiyun 		op = of_find_device_by_node(dp);
566*4882a593Smuzhiyun 		if (op)
567*4882a593Smuzhiyun 			break;
568*4882a593Smuzhiyun 	}
569*4882a593Smuzhiyun 	if (op) {
570*4882a593Smuzhiyun 		floppy_op = op;
571*4882a593Smuzhiyun 		FLOPPY_IRQ = op->archdata.irqs[0];
572*4882a593Smuzhiyun 	} else {
573*4882a593Smuzhiyun 		struct device_node *ebus_dp;
574*4882a593Smuzhiyun 		void __iomem *auxio_reg;
575*4882a593Smuzhiyun 		const char *state_prop;
576*4882a593Smuzhiyun 		unsigned long config;
577*4882a593Smuzhiyun 
578*4882a593Smuzhiyun 		dp = NULL;
579*4882a593Smuzhiyun 		for_each_node_by_name(ebus_dp, "ebus") {
580*4882a593Smuzhiyun 			for (dp = ebus_dp->child; dp; dp = dp->sibling) {
581*4882a593Smuzhiyun 				if (ebus_fdthree_p(dp))
582*4882a593Smuzhiyun 					goto found_fdthree;
583*4882a593Smuzhiyun 			}
584*4882a593Smuzhiyun 		}
585*4882a593Smuzhiyun 	found_fdthree:
586*4882a593Smuzhiyun 		if (!dp)
587*4882a593Smuzhiyun 			return 0;
588*4882a593Smuzhiyun 
589*4882a593Smuzhiyun 		op = of_find_device_by_node(dp);
590*4882a593Smuzhiyun 		if (!op)
591*4882a593Smuzhiyun 			return 0;
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 		state_prop = of_get_property(op->dev.of_node, "status", NULL);
594*4882a593Smuzhiyun 		if (state_prop && !strncmp(state_prop, "disabled", 8))
595*4882a593Smuzhiyun 			return 0;
596*4882a593Smuzhiyun 
597*4882a593Smuzhiyun 		FLOPPY_IRQ = op->archdata.irqs[0];
598*4882a593Smuzhiyun 
599*4882a593Smuzhiyun 		/* Make sure the high density bit is set, some systems
600*4882a593Smuzhiyun 		 * (most notably Ultra5/Ultra10) come up with it clear.
601*4882a593Smuzhiyun 		 */
602*4882a593Smuzhiyun 		auxio_reg = (void __iomem *) op->resource[2].start;
603*4882a593Smuzhiyun 		writel(readl(auxio_reg)|0x2, auxio_reg);
604*4882a593Smuzhiyun 
605*4882a593Smuzhiyun 		sun_floppy_dev = &op->dev;
606*4882a593Smuzhiyun 
607*4882a593Smuzhiyun 		spin_lock_init(&sun_pci_fd_ebus_dma.lock);
608*4882a593Smuzhiyun 
609*4882a593Smuzhiyun 		/* XXX ioremap */
610*4882a593Smuzhiyun 		sun_pci_fd_ebus_dma.regs = (void __iomem *)
611*4882a593Smuzhiyun 			op->resource[1].start;
612*4882a593Smuzhiyun 		if (!sun_pci_fd_ebus_dma.regs)
613*4882a593Smuzhiyun 			return 0;
614*4882a593Smuzhiyun 
615*4882a593Smuzhiyun 		sun_pci_fd_ebus_dma.flags = (EBUS_DMA_FLAG_USE_EBDMA_HANDLER |
616*4882a593Smuzhiyun 					     EBUS_DMA_FLAG_TCI_DISABLE);
617*4882a593Smuzhiyun 		sun_pci_fd_ebus_dma.callback = sun_pci_fd_dma_callback;
618*4882a593Smuzhiyun 		sun_pci_fd_ebus_dma.client_cookie = NULL;
619*4882a593Smuzhiyun 		sun_pci_fd_ebus_dma.irq = FLOPPY_IRQ;
620*4882a593Smuzhiyun 		strcpy(sun_pci_fd_ebus_dma.name, "floppy");
621*4882a593Smuzhiyun 		if (ebus_dma_register(&sun_pci_fd_ebus_dma))
622*4882a593Smuzhiyun 			return 0;
623*4882a593Smuzhiyun 
624*4882a593Smuzhiyun 		/* XXX ioremap */
625*4882a593Smuzhiyun 		sun_fdc = (struct sun_flpy_controller *) op->resource[0].start;
626*4882a593Smuzhiyun 
627*4882a593Smuzhiyun 		sun_fdops.fd_inb = sun_pci_fd_inb;
628*4882a593Smuzhiyun 		sun_fdops.fd_outb = sun_pci_fd_outb;
629*4882a593Smuzhiyun 
630*4882a593Smuzhiyun 		can_use_virtual_dma = use_virtual_dma = 0;
631*4882a593Smuzhiyun 		sun_fdops.fd_enable_dma = sun_pci_fd_enable_dma;
632*4882a593Smuzhiyun 		sun_fdops.fd_disable_dma = sun_pci_fd_disable_dma;
633*4882a593Smuzhiyun 		sun_fdops.fd_set_dma_mode = sun_pci_fd_set_dma_mode;
634*4882a593Smuzhiyun 		sun_fdops.fd_set_dma_addr = sun_pci_fd_set_dma_addr;
635*4882a593Smuzhiyun 		sun_fdops.fd_set_dma_count = sun_pci_fd_set_dma_count;
636*4882a593Smuzhiyun 		sun_fdops.get_dma_residue = sun_pci_get_dma_residue;
637*4882a593Smuzhiyun 
638*4882a593Smuzhiyun 		sun_fdops.fd_request_irq = sun_pci_fd_request_irq;
639*4882a593Smuzhiyun 		sun_fdops.fd_free_irq = sun_pci_fd_free_irq;
640*4882a593Smuzhiyun 
641*4882a593Smuzhiyun 		sun_fdops.fd_eject = sun_pci_fd_eject;
642*4882a593Smuzhiyun 
643*4882a593Smuzhiyun 		fdc_status = (unsigned long) &sun_fdc->status_82077;
644*4882a593Smuzhiyun 
645*4882a593Smuzhiyun 		/*
646*4882a593Smuzhiyun 		 * XXX: Find out on which machines this is really needed.
647*4882a593Smuzhiyun 		 */
648*4882a593Smuzhiyun 		if (1) {
649*4882a593Smuzhiyun 			sun_pci_broken_drive = 1;
650*4882a593Smuzhiyun 			sun_fdops.fd_outb = sun_pci_fd_broken_outb;
651*4882a593Smuzhiyun 		}
652*4882a593Smuzhiyun 
653*4882a593Smuzhiyun 		allowed_drive_mask = 0;
654*4882a593Smuzhiyun 		if (sun_pci_fd_test_drive((unsigned long)sun_fdc, 0))
655*4882a593Smuzhiyun 			sun_floppy_types[0] = 4;
656*4882a593Smuzhiyun 		if (sun_pci_fd_test_drive((unsigned long)sun_fdc, 1))
657*4882a593Smuzhiyun 			sun_floppy_types[1] = 4;
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun 		/*
660*4882a593Smuzhiyun 		 * Find NS87303 SuperIO config registers (through ecpp).
661*4882a593Smuzhiyun 		 */
662*4882a593Smuzhiyun 		config = 0;
663*4882a593Smuzhiyun 		for (dp = ebus_dp->child; dp; dp = dp->sibling) {
664*4882a593Smuzhiyun 			if (of_node_name_eq(dp, "ecpp")) {
665*4882a593Smuzhiyun 				struct platform_device *ecpp_op;
666*4882a593Smuzhiyun 
667*4882a593Smuzhiyun 				ecpp_op = of_find_device_by_node(dp);
668*4882a593Smuzhiyun 				if (ecpp_op)
669*4882a593Smuzhiyun 					config = ecpp_op->resource[1].start;
670*4882a593Smuzhiyun 				goto config_done;
671*4882a593Smuzhiyun 			}
672*4882a593Smuzhiyun 		}
673*4882a593Smuzhiyun 	config_done:
674*4882a593Smuzhiyun 
675*4882a593Smuzhiyun 		/*
676*4882a593Smuzhiyun 		 * Sanity check, is this really the NS87303?
677*4882a593Smuzhiyun 		 */
678*4882a593Smuzhiyun 		switch (config & 0x3ff) {
679*4882a593Smuzhiyun 		case 0x02e:
680*4882a593Smuzhiyun 		case 0x15c:
681*4882a593Smuzhiyun 		case 0x26e:
682*4882a593Smuzhiyun 		case 0x398:
683*4882a593Smuzhiyun 			break;
684*4882a593Smuzhiyun 		default:
685*4882a593Smuzhiyun 			config = 0;
686*4882a593Smuzhiyun 		}
687*4882a593Smuzhiyun 
688*4882a593Smuzhiyun 		if (!config)
689*4882a593Smuzhiyun 			return sun_floppy_types[0];
690*4882a593Smuzhiyun 
691*4882a593Smuzhiyun 		/* Enable PC-AT mode. */
692*4882a593Smuzhiyun 		ns87303_modify(config, ASC, 0, 0xc0);
693*4882a593Smuzhiyun 
694*4882a593Smuzhiyun #ifdef PCI_FDC_SWAP_DRIVES
695*4882a593Smuzhiyun 		/*
696*4882a593Smuzhiyun 		 * If only Floppy 1 is present, swap drives.
697*4882a593Smuzhiyun 		 */
698*4882a593Smuzhiyun 		if (!sun_floppy_types[0] && sun_floppy_types[1]) {
699*4882a593Smuzhiyun 			/*
700*4882a593Smuzhiyun 			 * Set the drive exchange bit in FCR on NS87303,
701*4882a593Smuzhiyun 			 * make sure other bits are sane before doing so.
702*4882a593Smuzhiyun 			 */
703*4882a593Smuzhiyun 			ns87303_modify(config, FER, FER_EDM, 0);
704*4882a593Smuzhiyun 			ns87303_modify(config, ASC, ASC_DRV2_SEL, 0);
705*4882a593Smuzhiyun 			ns87303_modify(config, FCR, 0, FCR_LDE);
706*4882a593Smuzhiyun 
707*4882a593Smuzhiyun 			config = sun_floppy_types[0];
708*4882a593Smuzhiyun 			sun_floppy_types[0] = sun_floppy_types[1];
709*4882a593Smuzhiyun 			sun_floppy_types[1] = config;
710*4882a593Smuzhiyun 
711*4882a593Smuzhiyun 			if (sun_pci_broken_drive != -1) {
712*4882a593Smuzhiyun 				sun_pci_broken_drive = 1 - sun_pci_broken_drive;
713*4882a593Smuzhiyun 				sun_fdops.fd_outb = sun_pci_fd_lde_broken_outb;
714*4882a593Smuzhiyun 			}
715*4882a593Smuzhiyun 		}
716*4882a593Smuzhiyun #endif /* PCI_FDC_SWAP_DRIVES */
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun 		return sun_floppy_types[0];
719*4882a593Smuzhiyun 	}
720*4882a593Smuzhiyun 	prop = of_get_property(op->dev.of_node, "status", NULL);
721*4882a593Smuzhiyun 	if (prop && !strncmp(state, "disabled", 8))
722*4882a593Smuzhiyun 		return 0;
723*4882a593Smuzhiyun 
724*4882a593Smuzhiyun 	/*
725*4882a593Smuzhiyun 	 * We cannot do of_ioremap here: it does request_region,
726*4882a593Smuzhiyun 	 * which the generic floppy driver tries to do once again.
727*4882a593Smuzhiyun 	 * But we must use the sdev resource values as they have
728*4882a593Smuzhiyun 	 * had parent ranges applied.
729*4882a593Smuzhiyun 	 */
730*4882a593Smuzhiyun 	sun_fdc = (struct sun_flpy_controller *)
731*4882a593Smuzhiyun 		(op->resource[0].start +
732*4882a593Smuzhiyun 		 ((op->resource[0].flags & 0x1ffUL) << 32UL));
733*4882a593Smuzhiyun 
734*4882a593Smuzhiyun 	/* Last minute sanity check... */
735*4882a593Smuzhiyun 	if (sbus_readb(&sun_fdc->status1_82077) == 0xff) {
736*4882a593Smuzhiyun 		sun_fdc = (struct sun_flpy_controller *)-1;
737*4882a593Smuzhiyun 		return 0;
738*4882a593Smuzhiyun 	}
739*4882a593Smuzhiyun 
740*4882a593Smuzhiyun         sun_fdops.fd_inb = sun_82077_fd_inb;
741*4882a593Smuzhiyun         sun_fdops.fd_outb = sun_82077_fd_outb;
742*4882a593Smuzhiyun 
743*4882a593Smuzhiyun 	can_use_virtual_dma = use_virtual_dma = 1;
744*4882a593Smuzhiyun 	sun_fdops.fd_enable_dma = sun_fd_enable_dma;
745*4882a593Smuzhiyun 	sun_fdops.fd_disable_dma = sun_fd_disable_dma;
746*4882a593Smuzhiyun 	sun_fdops.fd_set_dma_mode = sun_fd_set_dma_mode;
747*4882a593Smuzhiyun 	sun_fdops.fd_set_dma_addr = sun_fd_set_dma_addr;
748*4882a593Smuzhiyun 	sun_fdops.fd_set_dma_count = sun_fd_set_dma_count;
749*4882a593Smuzhiyun 	sun_fdops.get_dma_residue = sun_get_dma_residue;
750*4882a593Smuzhiyun 
751*4882a593Smuzhiyun 	sun_fdops.fd_request_irq = sun_fd_request_irq;
752*4882a593Smuzhiyun 	sun_fdops.fd_free_irq = sun_fd_free_irq;
753*4882a593Smuzhiyun 
754*4882a593Smuzhiyun 	sun_fdops.fd_eject = sun_fd_eject;
755*4882a593Smuzhiyun 
756*4882a593Smuzhiyun         fdc_status = (unsigned long) &sun_fdc->status_82077;
757*4882a593Smuzhiyun 
758*4882a593Smuzhiyun 	/* Success... */
759*4882a593Smuzhiyun 	allowed_drive_mask = 0x01;
760*4882a593Smuzhiyun 	sun_floppy_types[0] = 4;
761*4882a593Smuzhiyun 	sun_floppy_types[1] = 0;
762*4882a593Smuzhiyun 
763*4882a593Smuzhiyun 	return sun_floppy_types[0];
764*4882a593Smuzhiyun }
765*4882a593Smuzhiyun 
766*4882a593Smuzhiyun #define EXTRA_FLOPPY_PARAMS
767*4882a593Smuzhiyun 
768*4882a593Smuzhiyun static DEFINE_SPINLOCK(dma_spin_lock);
769*4882a593Smuzhiyun 
770*4882a593Smuzhiyun #define claim_dma_lock() \
771*4882a593Smuzhiyun ({	unsigned long flags; \
772*4882a593Smuzhiyun 	spin_lock_irqsave(&dma_spin_lock, flags); \
773*4882a593Smuzhiyun 	flags; \
774*4882a593Smuzhiyun })
775*4882a593Smuzhiyun 
776*4882a593Smuzhiyun #define release_dma_lock(__flags) \
777*4882a593Smuzhiyun 	spin_unlock_irqrestore(&dma_spin_lock, __flags);
778*4882a593Smuzhiyun 
779*4882a593Smuzhiyun #endif /* !(__ASM_SPARC64_FLOPPY_H) */
780