[deliverable/linux.git] / arch / sparc / include / asm / floppy_32.h

/* asm/floppy.h: Sparc specific parts of the Floppy driver.
 *
 * Copyright (C) 1995 David S. Miller (davem@davemloft.net)
 */

#ifndef __ASM_SPARC_FLOPPY_H
#define __ASM_SPARC_FLOPPY_H

#include <linux/of.h>
#include <linux/of_device.h>

#include <asm/page.h>
#include <asm/pgtable.h>
#include <asm/system.h>
#include <asm/idprom.h>
#include <asm/machines.h>
#include <asm/oplib.h>
#include <asm/auxio.h>
#include <asm/irq.h>

/* 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)

/* References:
 * 1) Netbsd Sun floppy driver.
 * 2) NCR 82077 controller manual
 * 3) Intel 82077 controller manual
 */
struct sun_flpy_controller {
	volatile unsigned char status_82072;  /* Main Status reg. */
#define dcr_82072              status_82072   /* Digital Control reg. */
#define status1_82077          status_82072   /* Auxiliary Status reg. 1 */

	volatile unsigned char data_82072;    /* Data fifo. */
#define status2_82077          data_82072     /* Auxiliary Status reg. 2 */

	volatile unsigned char dor_82077;     /* Digital Output reg. */
	volatile unsigned char tapectl_82077; /* What the? Tape control reg? */

	volatile unsigned char status_82077;  /* Main Status Register. */
#define drs_82077              status_82077   /* Digital Rate Select reg. */

	volatile unsigned char data_82077;    /* Data fifo. */
	volatile unsigned char ___unused;
	volatile unsigned char dir_82077;     /* Digital Input reg. */
#define dcr_82077              dir_82077      /* Config Control reg. */
};

/* You'll only ever find one controller on a SparcStation anyways. */
static struct sun_flpy_controller *sun_fdc = NULL;
extern volatile unsigned char *fdc_status;

struct sun_floppy_ops {
	unsigned char (*fd_inb)(int port);
	void (*fd_outb)(unsigned char value, int port);
};

static struct sun_floppy_ops sun_fdops;

#define fd_inb(port)              sun_fdops.fd_inb(port)
#define fd_outb(value,port)       sun_fdops.fd_outb(value,port)
#define fd_enable_dma()           sun_fd_enable_dma()
#define fd_disable_dma()          sun_fd_disable_dma()
#define fd_request_dma()          (0) /* nothing... */
#define fd_free_dma()             /* nothing... */
#define fd_clear_dma_ff()         /* nothing... */
#define fd_set_dma_mode(mode)     sun_fd_set_dma_mode(mode)
#define fd_set_dma_addr(addr)     sun_fd_set_dma_addr(addr)
#define fd_set_dma_count(count)   sun_fd_set_dma_count(count)
#define fd_enable_irq()           /* nothing... */
#define fd_disable_irq()          /* nothing... */
#define fd_cacheflush(addr, size) /* nothing... */
#define fd_request_irq()          sun_fd_request_irq()
#define fd_free_irq()             /* nothing... */
#if 0  /* P3: added by Alain, these cause a MMU corruption. 19960524 XXX */
#define fd_dma_mem_alloc(size)    ((unsigned long) vmalloc(size))
#define fd_dma_mem_free(addr,size) (vfree((void *)(addr)))
#endif

/* XXX This isn't really correct. XXX */
#define get_dma_residue(x)        (0)

#define FLOPPY0_TYPE  4
#define FLOPPY1_TYPE  0

/* Super paranoid... */
#undef HAVE_DISABLE_HLT

/* Here is where we catch the floppy driver trying to initialize,
 * therefore this is where we call the PROM device tree probing
 * routine etc. on the Sparc.
 */
#define FDC1                      sun_floppy_init()

#define N_FDC    1
#define N_DRIVE  8

/* No 64k boundary crossing problems on the Sparc. */
#define CROSS_64KB(a,s) (0)

/* Routines unique to each controller type on a Sun. */
static void sun_set_dor(unsigned char value, int fdc_82077)
{
	if (sparc_cpu_model == sun4c) {
		unsigned int bits = 0;
		if (value & 0x10)
			bits |= AUXIO_FLPY_DSEL;
		if ((value & 0x80) == 0)
			bits |= AUXIO_FLPY_EJCT;
		set_auxio(bits, (~bits) & (AUXIO_FLPY_DSEL|AUXIO_FLPY_EJCT));
	}
	if (fdc_82077) {
		sun_fdc->dor_82077 = value;
	}
}

static unsigned char sun_read_dir(void)
{
	if (sparc_cpu_model == sun4c)
		return (get_auxio() & AUXIO_FLPY_DCHG) ? 0x80 : 0;
	else
		return sun_fdc->dir_82077;
}

static unsigned char sun_82072_fd_inb(int port)
{
	udelay(5);
	switch(port & 7) {
	default:
		printk("floppy: Asked to read unknown port %d\n", port);
		panic("floppy: Port bolixed.");
	case 4: /* FD_STATUS */
		return sun_fdc->status_82072 & ~STATUS_DMA;
	case 5: /* FD_DATA */
		return sun_fdc->data_82072;
	case 7: /* FD_DIR */
		return sun_read_dir();
	};
	panic("sun_82072_fd_inb: How did I get here?");
}

static void sun_82072_fd_outb(unsigned char value, int port)
{
	udelay(5);
	switch(port & 7) {
	default:
		printk("floppy: Asked to write to unknown port %d\n", port);
		panic("floppy: Port bolixed.");
	case 2: /* FD_DOR */
		sun_set_dor(value, 0);
		break;
	case 5: /* FD_DATA */
		sun_fdc->data_82072 = value;
		break;
	case 7: /* FD_DCR */
		sun_fdc->dcr_82072 = value;
		break;
	case 4: /* FD_STATUS */
		sun_fdc->status_82072 = value;
		break;
	};
	return;
}

static unsigned char sun_82077_fd_inb(int port)
{
	udelay(5);
	switch(port & 7) {
	default:
		printk("floppy: Asked to read unknown port %d\n", port);
		panic("floppy: Port bolixed.");
	case 0: /* FD_STATUS_0 */
		return sun_fdc->status1_82077;
	case 1: /* FD_STATUS_1 */
		return sun_fdc->status2_82077;
	case 2: /* FD_DOR */
		return sun_fdc->dor_82077;
	case 3: /* FD_TDR */
		return sun_fdc->tapectl_82077;
	case 4: /* FD_STATUS */
		return sun_fdc->status_82077 & ~STATUS_DMA;
	case 5: /* FD_DATA */
		return sun_fdc->data_82077;
	case 7: /* FD_DIR */
		return sun_read_dir();
	};
	panic("sun_82077_fd_inb: How did I get here?");
}

static void sun_82077_fd_outb(unsigned char value, int port)
{
	udelay(5);
	switch(port & 7) {
	default:
		printk("floppy: Asked to write to unknown port %d\n", port);
		panic("floppy: Port bolixed.");
	case 2: /* FD_DOR */
		sun_set_dor(value, 1);
		break;
	case 5: /* FD_DATA */
		sun_fdc->data_82077 = value;
		break;
	case 7: /* FD_DCR */
		sun_fdc->dcr_82077 = value;
		break;
	case 4: /* FD_STATUS */
		sun_fdc->status_82077 = value;
		break;
	case 3: /* FD_TDR */
		sun_fdc->tapectl_82077 = value;
		break;
	};
	return;
}

/* For pseudo-dma (Sun floppy drives have no real DMA available to
 * them so we must eat the data fifo bytes directly ourselves) we have
 * three state variables.  doing_pdma tells our inline low-level
 * assembly floppy interrupt entry point whether it should sit and eat
 * bytes from the fifo or just transfer control up to the higher level
 * floppy interrupt c-code.  I tried very hard but I could not get the
 * pseudo-dma to work in c-code without getting many overruns and
 * underruns.  If non-zero, doing_pdma encodes the direction of
 * the transfer for debugging.  1=read 2=write
 */
extern char *pdma_vaddr;
extern unsigned long pdma_size;
extern volatile int doing_pdma;

/* This is software state */
extern char *pdma_base;
extern unsigned long pdma_areasize;

/* Common routines to all controller types on the Sparc. */
static inline void virtual_dma_init(void)
{
	/* nothing... */
}

static inline void sun_fd_disable_dma(void)
{
	doing_pdma = 0;
	if (pdma_base) {
		mmu_unlockarea(pdma_base, pdma_areasize);
		pdma_base = NULL;
	}
}

static inline void sun_fd_set_dma_mode(int mode)
{
	switch(mode) {
	case DMA_MODE_READ:
		doing_pdma = 1;
		break;
	case DMA_MODE_WRITE:
		doing_pdma = 2;
		break;
	default:
		printk("Unknown dma mode %d\n", mode);
		panic("floppy: Giving up...");
	}
}

static inline void sun_fd_set_dma_addr(char *buffer)
{
	pdma_vaddr = buffer;
}

static inline void sun_fd_set_dma_count(int length)
{
	pdma_size = length;
}

static inline void sun_fd_enable_dma(void)
{
	pdma_vaddr = mmu_lockarea(pdma_vaddr, pdma_size);
	pdma_base = pdma_vaddr;
	pdma_areasize = pdma_size;
}

/* Our low-level entry point in arch/sparc/kernel/entry.S */
extern int sparc_floppy_request_irq(int irq, unsigned long flags,
				    irq_handler_t irq_handler);

static int sun_fd_request_irq(void)
{
	static int once = 0;
	int error;

	if(!once) {
		once = 1;
		error = sparc_floppy_request_irq(FLOPPY_IRQ,
						 IRQF_DISABLED,
						 floppy_interrupt);
		return ((error == 0) ? 0 : -1);
	} else return 0;
}

static struct linux_prom_registers fd_regs[2];

static int sun_floppy_init(void)
{
	char state[128];
	phandle tnode, fd_node;
	int num_regs;
	struct resource r;

	use_virtual_dma = 1;

	FLOPPY_IRQ = 11;
	/* Forget it if we aren't on a machine that could possibly
	 * ever have a floppy drive.
	 */
	if((sparc_cpu_model != sun4c && sparc_cpu_model != sun4m) ||
	   ((idprom->id_machtype == (SM_SUN4C | SM_4C_SLC)) ||
	    (idprom->id_machtype == (SM_SUN4C | SM_4C_ELC)))) {
		/* We certainly don't have a floppy controller. */
		goto no_sun_fdc;
	}
	/* Well, try to find one. */
	tnode = prom_getchild(prom_root_node);
	fd_node = prom_searchsiblings(tnode, "obio");
	if(fd_node != 0) {
		tnode = prom_getchild(fd_node);
		fd_node = prom_searchsiblings(tnode, "SUNW,fdtwo");
	} else {
		fd_node = prom_searchsiblings(tnode, "fd");
	}
	if(fd_node == 0) {
		goto no_sun_fdc;
	}

	/* The sun4m lets us know if the controller is actually usable. */
	if(sparc_cpu_model == sun4m &&
	   prom_getproperty(fd_node, "status", state, sizeof(state)) != -1) {
		if(!strcmp(state, "disabled")) {
			goto no_sun_fdc;
		}
	}
	num_regs = prom_getproperty(fd_node, "reg", (char *) fd_regs, sizeof(fd_regs));
	num_regs = (num_regs / sizeof(fd_regs[0]));
	prom_apply_obio_ranges(fd_regs, num_regs);
	memset(&r, 0, sizeof(r));
	r.flags = fd_regs[0].which_io;
	r.start = fd_regs[0].phys_addr;
	sun_fdc = (struct sun_flpy_controller *)
	    of_ioremap(&r, 0, fd_regs[0].reg_size, "floppy");

	/* Last minute sanity check... */
	if(sun_fdc->status_82072 == 0xff) {
		sun_fdc = NULL;
		goto no_sun_fdc;
	}

	sun_fdops.fd_inb = sun_82077_fd_inb;
	sun_fdops.fd_outb = sun_82077_fd_outb;
	fdc_status = &sun_fdc->status_82077;

	if (sun_fdc->dor_82077 == 0x80) {
		sun_fdc->dor_82077 = 0x02;
		if (sun_fdc->dor_82077 == 0x80) {
			sun_fdops.fd_inb = sun_82072_fd_inb;
			sun_fdops.fd_outb = sun_82072_fd_outb;
			fdc_status = &sun_fdc->status_82072;
		}
	}

	/* Success... */
	allowed_drive_mask = 0x01;
	return (int) sun_fdc;

no_sun_fdc:
	return -1;
}

static int sparc_eject(void)
{
	set_dor(0x00, 0xff, 0x90);
	udelay(500);
	set_dor(0x00, 0x6f, 0x00);
	udelay(500);
	return 0;
}

#define fd_eject(drive) sparc_eject()

#define EXTRA_FLOPPY_PARAMS

static DEFINE_SPINLOCK(dma_spin_lock);

#define claim_dma_lock() \
({	unsigned long flags; \
	spin_lock_irqsave(&dma_spin_lock, flags); \
	flags; \
})

#define release_dma_lock(__flags) \
	spin_unlock_irqrestore(&dma_spin_lock, __flags);

#endif /* !(__ASM_SPARC_FLOPPY_H) */
Commit	Line	Data
a439fe51	1	/* asm/floppy.h: Sparc specific parts of the Floppy driver.
f5e706ad SR	2	*
	3	* Copyright (C) 1995 David S. Miller (davem@davemloft.net)
	4	*/
	5
	6	#ifndef __ASM_SPARC_FLOPPY_H
	7	#define __ASM_SPARC_FLOPPY_H
	8
454eeb2d DM	9	#include <linux/of.h>
	10	#include <linux/of_device.h>
	11
f5e706ad SR	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	/* We don't need no stinkin' I/O port allocation crap. */
	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	/* References:
	28	* 1) Netbsd Sun floppy driver.
	29	* 2) NCR 82077 controller manual
	30	* 3) Intel 82077 controller manual
	31	*/
	32	struct sun_flpy_controller {
	33	volatile unsigned char status_82072; /* Main Status reg. */
	34	#define dcr_82072 status_82072 /* Digital Control reg. */
	35	#define status1_82077 status_82072 /* Auxiliary Status reg. 1 */
	36
	37	volatile unsigned char data_82072; /* Data fifo. */
	38	#define status2_82077 data_82072 /* Auxiliary Status reg. 2 */
	39
	40	volatile unsigned char dor_82077; /* Digital Output reg. */
	41	volatile unsigned char tapectl_82077; /* What the? Tape control reg? */
	42
	43	volatile unsigned char status_82077; /* Main Status Register. */
	44	#define drs_82077 status_82077 /* Digital Rate Select reg. */
	45
	46	volatile unsigned char data_82077; /* Data fifo. */
	47	volatile unsigned char ___unused;
	48	volatile unsigned char dir_82077; /* Digital Input reg. */
	49	#define dcr_82077 dir_82077 /* Config Control reg. */
	50	};
	51
	52	/* You'll only ever find one controller on a SparcStation anyways. */
	53	static struct sun_flpy_controller *sun_fdc = NULL;
	54	extern volatile unsigned char *fdc_status;
	55
	56	struct sun_floppy_ops {
	57	unsigned char (*fd_inb)(int port);
	58	void (*fd_outb)(unsigned char value, int port);
	59	};
	60
	61	static 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) /* nothing... */
	68	#define fd_free_dma() /* nothing... */
	69	#define fd_clear_dma_ff() /* nothing... */
	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() /* nothing... */
	74	#define fd_disable_irq() /* nothing... */
	75	#define fd_cacheflush(addr, size) /* nothing... */
76	#define fd_request_irq() sun_fd_request_irq()
77	#define fd_free_irq() /* nothing... */
78	#if 0 /* P3: added by Alain, these cause a MMU corruption. 19960524 XXX */
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	/* XXX This isn't really correct. XXX */
84	#define get_dma_residue(x) (0)
85
86	#define FLOPPY0_TYPE 4
87	#define FLOPPY1_TYPE 0
88
89	/* Super paranoid... */
90	#undef HAVE_DISABLE_HLT
91
92	/* Here is where we catch the floppy driver trying to initialize,
93	* therefore this is where we call the PROM device tree probing
94	* routine etc. on the Sparc.
95	*/
96	#define FDC1 sun_floppy_init()
97
98	#define N_FDC 1
99	#define N_DRIVE 8
100
101	/* No 64k boundary crossing problems on the Sparc. */
102	#define CROSS_64KB(a,s) (0)
103
104	/* Routines unique to each controller type on a Sun. */
105	static 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
120	static 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
128	static 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: /* FD_STATUS */
136	return sun_fdc->status_82072 & ~STATUS_DMA;
137	case 5: /* FD_DATA */
138	return sun_fdc->data_82072;
139	case 7: /* FD_DIR */
140	return sun_read_dir();
141	};
142	panic("sun_82072_fd_inb: How did I get here?");
143	}
144
145	static 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: /* FD_DOR */
153	sun_set_dor(value, 0);
154	break;
155	case 5: /* FD_DATA */
156	sun_fdc->data_82072 = value;
157	break;
158	case 7: /* FD_DCR */
159	sun_fdc->dcr_82072 = value;
160	break;
161	case 4: /* FD_STATUS */
162	sun_fdc->status_82072 = value;
163	break;
164	};
165	return;
166	}
167
168	static 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: /* FD_STATUS_0 */
176	return sun_fdc->status1_82077;
177	case 1: /* FD_STATUS_1 */
178	return sun_fdc->status2_82077;
179	case 2: /* FD_DOR */
180	return sun_fdc->dor_82077;
181	case 3: /* FD_TDR */
182	return sun_fdc->tapectl_82077;
183	case 4: /* FD_STATUS */
184	return sun_fdc->status_82077 & ~STATUS_DMA;
185	case 5: /* FD_DATA */
186	return sun_fdc->data_82077;
187	case 7: /* FD_DIR */
188	return sun_read_dir();
189	};
190	panic("sun_82077_fd_inb: How did I get here?");
191	}
192
193	static 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: /* FD_DOR */
201	sun_set_dor(value, 1);
202	break;
203	case 5: /* FD_DATA */
204	sun_fdc->data_82077 = value;
205	break;
206	case 7: /* FD_DCR */
207	sun_fdc->dcr_82077 = value;
208	break;
209	case 4: /* FD_STATUS */
210	sun_fdc->status_82077 = value;
211	break;
212	case 3: /* FD_TDR */
213	sun_fdc->tapectl_82077 = value;
214	break;
215	};
216	return;
217	}
218
219	/* For pseudo-dma (Sun floppy drives have no real DMA available to
220	* them so we must eat the data fifo bytes directly ourselves) we have
221	* three state variables. doing_pdma tells our inline low-level
222	* assembly floppy interrupt entry point whether it should sit and eat
223	* bytes from the fifo or just transfer control up to the higher level
224	* floppy interrupt c-code. I tried very hard but I could not get the
225	* pseudo-dma to work in c-code without getting many overruns and
226	* underruns. If non-zero, doing_pdma encodes the direction of
227	* the transfer for debugging. 1=read 2=write
228	*/
229	extern char *pdma_vaddr;
230	extern unsigned long pdma_size;
231	extern volatile int doing_pdma;
232
233	/* This is software state */
234	extern char *pdma_base;
235	extern unsigned long pdma_areasize;
236
237	/* Common routines to all controller types on the Sparc. */
238	static inline void virtual_dma_init(void)
239	{
240	/* nothing... */
241	}
242
243	static 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
252	static 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
267	static inline void sun_fd_set_dma_addr(char *buffer)
268	{
269	pdma_vaddr = buffer;
270	}
271
272	static inline void sun_fd_set_dma_count(int length)
273	{
274	pdma_size = length;
275	}
276
277	static 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
284	/* Our low-level entry point in arch/sparc/kernel/entry.S */
285	extern int sparc_floppy_request_irq(int irq, unsigned long flags,
286	irq_handler_t irq_handler);
287
288	static int sun_fd_request_irq(void)
289	{
290	static int once = 0;
291	int error;
292
293	if(!once) {
294	once = 1;
295	error = sparc_floppy_request_irq(FLOPPY_IRQ,
296	IRQF_DISABLED,
297	floppy_interrupt);
298	return ((error == 0) ? 0 : -1);
299	} else return 0;
300	}
301
302	static struct linux_prom_registers fd_regs[2];
303
304	static int sun_floppy_init(void)
305	{
306	char state[128];
8d125562 AS	307	phandle tnode, fd_node;
8d125562 AS	308	int num_regs;
f5e706ad SR	309	struct resource r;
	310
	311	use_virtual_dma = 1;
	312
	313	FLOPPY_IRQ = 11;
	314	/* Forget it if we aren't on a machine that could possibly
	315	* ever have a floppy drive.
	316	*/
	317	if((sparc_cpu_model != sun4c && sparc_cpu_model != sun4m) \|\|
	318	((idprom->id_machtype == (SM_SUN4C \| SM_4C_SLC)) \|\|
	319	(idprom->id_machtype == (SM_SUN4C \| SM_4C_ELC)))) {
	320	/* We certainly don't have a floppy controller. */
	321	goto no_sun_fdc;
	322	}
	323	/* Well, try to find one. */
	324	tnode = prom_getchild(prom_root_node);
	325	fd_node = prom_searchsiblings(tnode, "obio");
	326	if(fd_node != 0) {
	327	tnode = prom_getchild(fd_node);
	328	fd_node = prom_searchsiblings(tnode, "SUNW,fdtwo");
	329	} else {
	330	fd_node = prom_searchsiblings(tnode, "fd");
	331	}
	332	if(fd_node == 0) {
	333	goto no_sun_fdc;
	334	}
	335
	336	/* The sun4m lets us know if the controller is actually usable. */
	337	if(sparc_cpu_model == sun4m &&
	338	prom_getproperty(fd_node, "status", state, sizeof(state)) != -1) {
	339	if(!strcmp(state, "disabled")) {
	340	goto no_sun_fdc;
	341	}
	342	}
	343	num_regs = prom_getproperty(fd_node, "reg", (char *) fd_regs, sizeof(fd_regs));
	344	num_regs = (num_regs / sizeof(fd_regs[0]));
	345	prom_apply_obio_ranges(fd_regs, num_regs);
	346	memset(&r, 0, sizeof(r));
	347	r.flags = fd_regs[0].which_io;
	348	r.start = fd_regs[0].phys_addr;
	349	sun_fdc = (struct sun_flpy_controller *)
454eeb2d	350	of_ioremap(&r, 0, fd_regs[0].reg_size, "floppy");
f5e706ad SR	351
	352	/* Last minute sanity check... */
	353	if(sun_fdc->status_82072 == 0xff) {
	354	sun_fdc = NULL;
	355	goto no_sun_fdc;
	356	}
	357
	358	sun_fdops.fd_inb = sun_82077_fd_inb;
	359	sun_fdops.fd_outb = sun_82077_fd_outb;
	360	fdc_status = &sun_fdc->status_82077;
	361
	362	if (sun_fdc->dor_82077 == 0x80) {
	363	sun_fdc->dor_82077 = 0x02;
	364	if (sun_fdc->dor_82077 == 0x80) {
	365	sun_fdops.fd_inb = sun_82072_fd_inb;
	366	sun_fdops.fd_outb = sun_82072_fd_outb;
	367	fdc_status = &sun_fdc->status_82072;
	368	}
	369	}
	370
	371	/* Success... */
	372	allowed_drive_mask = 0x01;
	373	return (int) sun_fdc;
	374
	375	no_sun_fdc:
	376	return -1;
	377	}
	378
	379	static int sparc_eject(void)
	380	{
	381	set_dor(0x00, 0xff, 0x90);
	382	udelay(500);
	383	set_dor(0x00, 0x6f, 0x00);
	384	udelay(500);
	385	return 0;
	386	}
	387
	388	#define fd_eject(drive) sparc_eject()
	389
	390	#define EXTRA_FLOPPY_PARAMS
	391
334ae614 DM	392	static DEFINE_SPINLOCK(dma_spin_lock);
	393
	394	#define claim_dma_lock() \
	395	({ unsigned long flags; \
	396	spin_lock_irqsave(&dma_spin_lock, flags); \
	397	flags; \
	398	})
	399
	400	#define release_dma_lock(__flags) \
	401	spin_unlock_irqrestore(&dma_spin_lock, __flags);
	402
f5e706ad	403	#endif /* !(__ASM_SPARC_FLOPPY_H) */