| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | #ifdef __KERNEL__ | 
 | 11 | #ifndef __ASM_PPC_FLOPPY_H | 
 | 12 | #define __ASM_PPC_FLOPPY_H | 
 | 13 |  | 
 | 14 | #define fd_inb(port)		inb_p(port) | 
 | 15 | #define fd_outb(value,port)	outb_p(value,port) | 
 | 16 |  | 
 | 17 | #define fd_disable_dma()	fd_ops->_disable_dma(FLOPPY_DMA) | 
 | 18 | #define fd_free_dma()           fd_ops->_free_dma(FLOPPY_DMA) | 
 | 19 | #define fd_get_dma_residue()    fd_ops->_get_dma_residue(FLOPPY_DMA) | 
 | 20 | #define fd_dma_setup(addr, size, mode, io) fd_ops->_dma_setup(addr, size, mode, io) | 
 | 21 | #define fd_enable_irq()         enable_irq(FLOPPY_IRQ) | 
 | 22 | #define fd_disable_irq()        disable_irq(FLOPPY_IRQ) | 
 | 23 | #define fd_free_irq()           free_irq(FLOPPY_IRQ, NULL); | 
 | 24 |  | 
 | 25 | static int fd_request_dma(void); | 
 | 26 |  | 
 | 27 | struct fd_dma_ops { | 
 | 28 | 	void (*_disable_dma)(unsigned int dmanr); | 
 | 29 | 	void (*_free_dma)(unsigned int dmanr); | 
 | 30 | 	int (*_get_dma_residue)(unsigned int dummy); | 
 | 31 | 	int (*_dma_setup)(char *addr, unsigned long size, int mode, int io); | 
 | 32 | }; | 
 | 33 |  | 
 | 34 | static int virtual_dma_count; | 
 | 35 | static int virtual_dma_residue; | 
 | 36 | static char *virtual_dma_addr; | 
 | 37 | static int virtual_dma_mode; | 
 | 38 | static int doing_vdma; | 
 | 39 | static struct fd_dma_ops *fd_ops; | 
 | 40 |  | 
| Paul Mackerras | 3211be5 | 2006-10-06 21:09:40 +1000 | [diff] [blame] | 41 | static irqreturn_t floppy_hardint(int irq, void *dev_id) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | { | 
 | 43 | 	unsigned char st; | 
 | 44 | 	int lcount; | 
 | 45 | 	char *lptr; | 
 | 46 |  | 
 | 47 | 	if (!doing_vdma) | 
| Paul Mackerras | 3211be5 | 2006-10-06 21:09:40 +1000 | [diff] [blame] | 48 | 		return floppy_interrupt(irq, dev_id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 49 |  | 
 | 50 |  | 
 | 51 | 	st = 1; | 
 | 52 | 	for (lcount=virtual_dma_count, lptr=virtual_dma_addr; | 
 | 53 | 	     lcount; lcount--, lptr++) { | 
 | 54 | 		st=inb(virtual_dma_port+4) & 0xa0 ; | 
 | 55 | 		if (st != 0xa0) | 
 | 56 | 			break; | 
 | 57 | 		if (virtual_dma_mode) | 
 | 58 | 			outb_p(*lptr, virtual_dma_port+5); | 
 | 59 | 		else | 
 | 60 | 			*lptr = inb_p(virtual_dma_port+5); | 
 | 61 | 	} | 
 | 62 | 	virtual_dma_count = lcount; | 
 | 63 | 	virtual_dma_addr = lptr; | 
 | 64 | 	st = inb(virtual_dma_port+4); | 
 | 65 |  | 
 | 66 | 	if (st == 0x20) | 
 | 67 | 		return IRQ_HANDLED; | 
 | 68 | 	if (!(st & 0x20)) { | 
 | 69 | 		virtual_dma_residue += virtual_dma_count; | 
 | 70 | 		virtual_dma_count=0; | 
 | 71 | 		doing_vdma = 0; | 
| Paul Mackerras | 3211be5 | 2006-10-06 21:09:40 +1000 | [diff] [blame] | 72 | 		floppy_interrupt(irq, dev_id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 73 | 		return IRQ_HANDLED; | 
 | 74 | 	} | 
 | 75 | 	return IRQ_HANDLED; | 
 | 76 | } | 
 | 77 |  | 
 | 78 | static void vdma_disable_dma(unsigned int dummy) | 
 | 79 | { | 
 | 80 | 	doing_vdma = 0; | 
 | 81 | 	virtual_dma_residue += virtual_dma_count; | 
 | 82 | 	virtual_dma_count=0; | 
 | 83 | } | 
 | 84 |  | 
 | 85 | static void vdma_nop(unsigned int dummy) | 
 | 86 | { | 
 | 87 | } | 
 | 88 |  | 
 | 89 |  | 
 | 90 | static int vdma_get_dma_residue(unsigned int dummy) | 
 | 91 | { | 
 | 92 | 	return virtual_dma_count + virtual_dma_residue; | 
 | 93 | } | 
 | 94 |  | 
 | 95 |  | 
 | 96 | static int fd_request_irq(void) | 
 | 97 | { | 
 | 98 | 	if (can_use_virtual_dma) | 
| Thomas Gleixner | bc59d28 | 2006-07-01 19:29:22 -0700 | [diff] [blame] | 99 | 		return request_irq(FLOPPY_IRQ, floppy_hardint, | 
 | 100 | 				   IRQF_DISABLED, "floppy", NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 101 | 	else | 
| Thomas Gleixner | bc59d28 | 2006-07-01 19:29:22 -0700 | [diff] [blame] | 102 | 		return request_irq(FLOPPY_IRQ, floppy_interrupt, | 
 | 103 | 				   IRQF_DISABLED, "floppy", NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 | } | 
 | 105 |  | 
 | 106 | static int vdma_dma_setup(char *addr, unsigned long size, int mode, int io) | 
 | 107 | { | 
 | 108 | 	doing_vdma = 1; | 
 | 109 | 	virtual_dma_port = io; | 
 | 110 | 	virtual_dma_mode = (mode  == DMA_MODE_WRITE); | 
 | 111 | 	virtual_dma_addr = addr; | 
 | 112 | 	virtual_dma_count = size; | 
 | 113 | 	virtual_dma_residue = 0; | 
 | 114 | 	return 0; | 
 | 115 | } | 
 | 116 |  | 
 | 117 | static int hard_dma_setup(char *addr, unsigned long size, int mode, int io) | 
 | 118 | { | 
 | 119 | 	/* actual, physical DMA */ | 
 | 120 | 	doing_vdma = 0; | 
 | 121 | 	clear_dma_ff(FLOPPY_DMA); | 
 | 122 | 	set_dma_mode(FLOPPY_DMA,mode); | 
 | 123 | 	set_dma_addr(FLOPPY_DMA,(unsigned int)virt_to_bus(addr)); | 
 | 124 | 	set_dma_count(FLOPPY_DMA,size); | 
 | 125 | 	enable_dma(FLOPPY_DMA); | 
 | 126 | 	return 0; | 
 | 127 | } | 
 | 128 |  | 
 | 129 | static struct fd_dma_ops real_dma_ops = | 
 | 130 | { | 
 | 131 | 	._disable_dma = disable_dma, | 
 | 132 | 	._free_dma = free_dma, | 
 | 133 | 	._get_dma_residue = get_dma_residue, | 
 | 134 | 	._dma_setup = hard_dma_setup | 
 | 135 | }; | 
 | 136 |  | 
 | 137 | static struct fd_dma_ops virt_dma_ops = | 
 | 138 | { | 
 | 139 | 	._disable_dma = vdma_disable_dma, | 
 | 140 | 	._free_dma = vdma_nop, | 
 | 141 | 	._get_dma_residue = vdma_get_dma_residue, | 
 | 142 | 	._dma_setup = vdma_dma_setup | 
 | 143 | }; | 
 | 144 |  | 
 | 145 | static int fd_request_dma() | 
 | 146 | { | 
 | 147 | 	if (can_use_virtual_dma & 1) { | 
 | 148 | 		fd_ops = &virt_dma_ops; | 
 | 149 | 		return 0; | 
 | 150 | 	} | 
 | 151 | 	else { | 
 | 152 | 		fd_ops = &real_dma_ops; | 
 | 153 | 		return request_dma(FLOPPY_DMA, "floppy"); | 
 | 154 | 	} | 
 | 155 | } | 
 | 156 |  | 
 | 157 | static int FDC1 = 0x3f0; | 
 | 158 | static int FDC2 = -1; | 
 | 159 |  | 
 | 160 | /* | 
 | 161 |  * Again, the CMOS information not available | 
 | 162 |  */ | 
 | 163 | #define FLOPPY0_TYPE 6 | 
 | 164 | #define FLOPPY1_TYPE 0 | 
 | 165 |  | 
 | 166 | #define N_FDC 2			/* Don't change this! */ | 
 | 167 | #define N_DRIVE 8 | 
 | 168 |  | 
 | 169 | #define FLOPPY_MOTOR_MASK 0xf0 | 
 | 170 |  | 
 | 171 | /* | 
 | 172 |  * The PowerPC has no problems with floppy DMA crossing 64k borders. | 
 | 173 |  */ | 
 | 174 | #define CROSS_64KB(a,s)	(0) | 
 | 175 |  | 
 | 176 | #endif /* __ASM_PPC_FLOPPY_H */ | 
 | 177 |  | 
 | 178 | #define EXTRA_FLOPPY_PARAMS | 
 | 179 |  | 
 | 180 | #endif /* __KERNEL__ */ |