[GitHub/mt8127/android_kernel_alcatel_ttab.git] / include / asm-powerpc / floppy.h

/*
 * Architecture specific parts of the Floppy driver
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 * Copyright (C) 1995
 */
#ifndef __ASM_POWERPC_FLOPPY_H
#define __ASM_POWERPC_FLOPPY_H
#ifdef __KERNEL__

#include <asm/machdep.h>

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

#define fd_enable_dma()         enable_dma(FLOPPY_DMA)
#define fd_disable_dma()	 fd_ops->_disable_dma(FLOPPY_DMA)
#define fd_free_dma()           fd_ops->_free_dma(FLOPPY_DMA)
#define fd_clear_dma_ff()       clear_dma_ff(FLOPPY_DMA)
#define fd_set_dma_mode(mode)   set_dma_mode(FLOPPY_DMA, mode)
#define fd_set_dma_count(count) set_dma_count(FLOPPY_DMA, count)
#define fd_get_dma_residue()    fd_ops->_get_dma_residue(FLOPPY_DMA)
#define fd_enable_irq()         enable_irq(FLOPPY_IRQ)
#define fd_disable_irq()        disable_irq(FLOPPY_IRQ)
#define fd_cacheflush(addr,size) /* nothing */
#define fd_free_irq()           free_irq(FLOPPY_IRQ, NULL);

#include <linux/pci.h>
#include <asm/ppc-pci.h>	/* for isa_bridge_pcidev */

#define fd_dma_setup(addr,size,mode,io) fd_ops->_dma_setup(addr,size,mode,io)

static int fd_request_dma(void);

struct fd_dma_ops {
	void (*_disable_dma)(unsigned int dmanr);
	void (*_free_dma)(unsigned int dmanr);
	int (*_get_dma_residue)(unsigned int dummy);
	int (*_dma_setup)(char *addr, unsigned long size, int mode, int io);
};

static int virtual_dma_count;
static int virtual_dma_residue;
static char *virtual_dma_addr;
static int virtual_dma_mode;
static int doing_vdma;
static struct fd_dma_ops *fd_ops;

static irqreturn_t floppy_hardint(int irq, void *dev_id)
{
	unsigned char st;
	int lcount;
	char *lptr;

	if (!doing_vdma)
		return floppy_interrupt(irq, dev_id);


	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);
	}
	virtual_dma_count = lcount;
	virtual_dma_addr = lptr;
	st = inb(virtual_dma_port+4);

	if (st == 0x20)
		return IRQ_HANDLED;
	if (!(st & 0x20)) {
		virtual_dma_residue += virtual_dma_count;
		virtual_dma_count=0;
		doing_vdma = 0;
		floppy_interrupt(irq, dev_id);
		return IRQ_HANDLED;
	}
	return IRQ_HANDLED;
}

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

static void vdma_nop(unsigned int dummy)
{
}


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


static int fd_request_irq(void)
{
	if (can_use_virtual_dma)
		return request_irq(FLOPPY_IRQ, floppy_hardint,
				   IRQF_DISABLED, "floppy", NULL);
	else
		return request_irq(FLOPPY_IRQ, floppy_interrupt,
				   IRQF_DISABLED, "floppy", NULL);
}

static int vdma_dma_setup(char *addr, unsigned long size, int mode, int io)
{
	doing_vdma = 1;
	virtual_dma_port = io;
	virtual_dma_mode = (mode  == DMA_MODE_WRITE);
	virtual_dma_addr = addr;
	virtual_dma_count = size;
	virtual_dma_residue = 0;
	return 0;
}

static int hard_dma_setup(char *addr, unsigned long size, int mode, int io)
{
	static unsigned long prev_size;
	static dma_addr_t bus_addr = 0;
	static char *prev_addr;
	static int prev_dir;
	int dir;

	doing_vdma = 0;
	dir = (mode == DMA_MODE_READ) ? PCI_DMA_FROMDEVICE : PCI_DMA_TODEVICE;

	if (bus_addr 
	    && (addr != prev_addr || size != prev_size || dir != prev_dir)) {
		/* different from last time -- unmap prev */
		pci_unmap_single(isa_bridge_pcidev, bus_addr, prev_size, prev_dir);
		bus_addr = 0;
	}

	if (!bus_addr)	/* need to map it */
		bus_addr = pci_map_single(isa_bridge_pcidev, addr, size, dir);

	/* remember this one as prev */
	prev_addr = addr;
	prev_size = size;
	prev_dir = dir;

	fd_clear_dma_ff();
	fd_cacheflush(addr, size);
	fd_set_dma_mode(mode);
	set_dma_addr(FLOPPY_DMA, bus_addr);
	fd_set_dma_count(size);
	virtual_dma_port = io;
	fd_enable_dma();

	return 0;
}

static struct fd_dma_ops real_dma_ops =
{
	._disable_dma = disable_dma,
	._free_dma = free_dma,
	._get_dma_residue = get_dma_residue,
	._dma_setup = hard_dma_setup
};

static struct fd_dma_ops virt_dma_ops =
{
	._disable_dma = vdma_disable_dma,
	._free_dma = vdma_nop,
	._get_dma_residue = vdma_get_dma_residue,
	._dma_setup = vdma_dma_setup
};

static int fd_request_dma(void)
{
	if (can_use_virtual_dma & 1) {
		fd_ops = &virt_dma_ops;
		return 0;
	}
	else {
		fd_ops = &real_dma_ops;
		return request_dma(FLOPPY_DMA, "floppy");
	}
}

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

/*
 * Again, the CMOS information not available
 */
#define FLOPPY0_TYPE 6
#define FLOPPY1_TYPE 0

#define N_FDC 2			/* Don't change this! */
#define N_DRIVE 8

/*
 * The PowerPC has no problems with floppy DMA crossing 64k borders.
 */
#define CROSS_64KB(a,s)	(0)

#define EXTRA_FLOPPY_PARAMS

#endif /* __KERNEL__ */
#endif /* __ASM_POWERPC_FLOPPY_H */
Commit	Line	Data
1da177e4 LT	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	*/
c55377ee PM	10	#ifndef __ASM_POWERPC_FLOPPY_H
c55377ee PM	11	#define __ASM_POWERPC_FLOPPY_H
88ced031	12	#ifdef __KERNEL__
1da177e4	13
1da177e4 LT	14	#include <asm/machdep.h>
1da177e4 LT	15
c55377ee PM	16	#define fd_inb(port) inb_p(port)
c55377ee PM	17	#define fd_outb(value,port) outb_p(value,port)
1da177e4 LT	18
1da177e4 LT	19	#define fd_enable_dma() enable_dma(FLOPPY_DMA)
9ea8b7c9 PF	20	#define fd_disable_dma() fd_ops->_disable_dma(FLOPPY_DMA)
9ea8b7c9 PF	21	#define fd_free_dma() fd_ops->_free_dma(FLOPPY_DMA)
1da177e4	22	#define fd_clear_dma_ff() clear_dma_ff(FLOPPY_DMA)
c55377ee PM	23	#define fd_set_dma_mode(mode) set_dma_mode(FLOPPY_DMA, mode)
c55377ee PM	24	#define fd_set_dma_count(count) set_dma_count(FLOPPY_DMA, count)
9ea8b7c9	25	#define fd_get_dma_residue() fd_ops->_get_dma_residue(FLOPPY_DMA)
1da177e4 LT	26	#define fd_enable_irq() enable_irq(FLOPPY_IRQ)
	27	#define fd_disable_irq() disable_irq(FLOPPY_IRQ)
	28	#define fd_cacheflush(addr,size) /* nothing */
1da177e4 LT	29	#define fd_free_irq() free_irq(FLOPPY_IRQ, NULL);
1da177e4 LT	30
1da177e4	31	#include <linux/pci.h>
3d5134ee	32	#include <asm/ppc-pci.h> /* for isa_bridge_pcidev */
1da177e4	33
9ea8b7c9 PF	34	#define fd_dma_setup(addr,size,mode,io) fd_ops->_dma_setup(addr,size,mode,io)
	35
	36	static int fd_request_dma(void);
	37
	38	struct fd_dma_ops {
	39	void (*_disable_dma)(unsigned int dmanr);
	40	void (*_free_dma)(unsigned int dmanr);
	41	int (*_get_dma_residue)(unsigned int dummy);
	42	int (_dma_setup)(char addr, unsigned long size, int mode, int io);
	43	};
	44
	45	static int virtual_dma_count;
	46	static int virtual_dma_residue;
	47	static char *virtual_dma_addr;
	48	static int virtual_dma_mode;
	49	static int doing_vdma;
	50	static struct fd_dma_ops *fd_ops;
	51
	52	static irqreturn_t floppy_hardint(int irq, void *dev_id)
	53	{
	54	unsigned char st;
	55	int lcount;
	56	char *lptr;
	57
	58	if (!doing_vdma)
	59	return floppy_interrupt(irq, dev_id);
	60
	61
	62	st = 1;
	63	for (lcount=virtual_dma_count, lptr=virtual_dma_addr;
	64	lcount; lcount--, lptr++) {
	65	st=inb(virtual_dma_port+4) & 0xa0 ;
	66	if (st != 0xa0)
	67	break;
	68	if (virtual_dma_mode)
	69	outb_p(*lptr, virtual_dma_port+5);
	70	else
	71	*lptr = inb_p(virtual_dma_port+5);
	72	}
	73	virtual_dma_count = lcount;
	74	virtual_dma_addr = lptr;
	75	st = inb(virtual_dma_port+4);
	76
	77	if (st == 0x20)
	78	return IRQ_HANDLED;
	79	if (!(st & 0x20)) {
	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	}
1da177e4	88
9ea8b7c9 PF	89	static 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
	96	static void vdma_nop(unsigned int dummy)
	97	{
	98	}
	99
	100
	101	static int vdma_get_dma_residue(unsigned int dummy)
	102	{
	103	return virtual_dma_count + virtual_dma_residue;
	104	}
	105
	106
	107	static int fd_request_irq(void)
	108	{
	109	if (can_use_virtual_dma)
	110	return request_irq(FLOPPY_IRQ, floppy_hardint,
	111	IRQF_DISABLED, "floppy", NULL);
	112	else
	113	return request_irq(FLOPPY_IRQ, floppy_interrupt,
	114	IRQF_DISABLED, "floppy", NULL);
	115	}
	116
	117	static 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
	128	static int hard_dma_setup(char *addr, unsigned long size, int mode, int io)
1da177e4 LT	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
9ea8b7c9	136	doing_vdma = 0;
1da177e4 LT	137	dir = (mode == DMA_MODE_READ) ? PCI_DMA_FROMDEVICE : PCI_DMA_TODEVICE;
	138
	139	if (bus_addr
	140	&& (addr != prev_addr \|\| size != prev_size \|\| dir != prev_dir)) {
	141	/* different from last time -- unmap prev */
3d5134ee	142	pci_unmap_single(isa_bridge_pcidev, bus_addr, prev_size, prev_dir);
1da177e4 LT	143	bus_addr = 0;
	144	}
	145
c55377ee	146	if (!bus_addr) /* need to map it */
3d5134ee	147	bus_addr = pci_map_single(isa_bridge_pcidev, addr, size, dir);
1da177e4 LT	148
	149	/* remember this one as prev */
	150	prev_addr = addr;
	151	prev_size = size;
	152	prev_dir = dir;
	153
	154	fd_clear_dma_ff();
	155	fd_cacheflush(addr, size);
	156	fd_set_dma_mode(mode);
	157	set_dma_addr(FLOPPY_DMA, bus_addr);
	158	fd_set_dma_count(size);
	159	virtual_dma_port = io;
	160	fd_enable_dma();
	161
	162	return 0;
	163	}
	164
9ea8b7c9 PF	165	static struct fd_dma_ops real_dma_ops =
	166	{
	167	._disable_dma = disable_dma,
	168	._free_dma = free_dma,
	169	._get_dma_residue = get_dma_residue,
	170	._dma_setup = hard_dma_setup
	171	};
	172
	173	static struct fd_dma_ops virt_dma_ops =
	174	{
	175	._disable_dma = vdma_disable_dma,
	176	._free_dma = vdma_nop,
	177	._get_dma_residue = vdma_get_dma_residue,
	178	._dma_setup = vdma_dma_setup
	179	};
1da177e4	180
1be9ab05	181	static int fd_request_dma(void)
1da177e4	182	{
9ea8b7c9 PF	183	if (can_use_virtual_dma & 1) {
	184	fd_ops = &virt_dma_ops;
	185	return 0;
	186	}
	187	else {
	188	fd_ops = &real_dma_ops;
	189	return request_dma(FLOPPY_DMA, "floppy");
	190	}
1da177e4 LT	191	}
	192
	193	static int FDC1 = 0x3f0;
	194	static int FDC2 = -1;
	195
	196	/*
	197	* Again, the CMOS information not available
	198	*/
	199	#define FLOPPY0_TYPE 6
	200	#define FLOPPY1_TYPE 0
	201
	202	#define N_FDC 2 /* Don't change this! */
	203	#define N_DRIVE 8
	204
1da177e4 LT	205	/*
	206	* The PowerPC has no problems with floppy DMA crossing 64k borders.
	207	*/
	208	#define CROSS_64KB(a,s) (0)
	209
	210	#define EXTRA_FLOPPY_PARAMS
	211
88ced031	212	#endif /* __KERNEL__ */
c55377ee	213	#endif /* __ASM_POWERPC_FLOPPY_H */