| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 1 | /* | 
 | 2 |  * linux/drivers/ide/mips/au1xxx-ide.c  version 01.30.00        Aug. 02 2005 | 
 | 3 |  * | 
 | 4 |  * BRIEF MODULE DESCRIPTION | 
 | 5 |  * AMD Alchemy Au1xxx IDE interface routines over the Static Bus | 
 | 6 |  * | 
 | 7 |  * Copyright (c) 2003-2005 AMD, Personal Connectivity Solutions | 
 | 8 |  * | 
 | 9 |  * This program is free software; you can redistribute it and/or modify it under | 
 | 10 |  * the terms of the GNU General Public License as published by the Free Software | 
 | 11 |  * Foundation; either version 2 of the License, or (at your option) any later | 
 | 12 |  * version. | 
 | 13 |  * | 
 | 14 |  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, | 
 | 15 |  * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND | 
 | 16 |  * FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR | 
 | 17 |  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR | 
 | 18 |  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF | 
 | 19 |  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS | 
 | 20 |  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN | 
 | 21 |  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) | 
 | 22 |  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE | 
 | 23 |  * POSSIBILITY OF SUCH DAMAGE. | 
 | 24 |  * | 
 | 25 |  * You should have received a copy of the GNU General Public License along with | 
 | 26 |  * this program; if not, write to the Free Software Foundation, Inc., | 
 | 27 |  * 675 Mass Ave, Cambridge, MA 02139, USA. | 
 | 28 |  * | 
 | 29 |  * Note: for more information, please refer "AMD Alchemy Au1200/Au1550 IDE | 
 | 30 |  *       Interface and Linux Device Driver" Application Note. | 
 | 31 |  */ | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 32 | #include <linux/types.h> | 
 | 33 | #include <linux/module.h> | 
 | 34 | #include <linux/kernel.h> | 
 | 35 | #include <linux/delay.h> | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 36 | #include <linux/platform_device.h> | 
 | 37 |  | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 38 | #include <linux/init.h> | 
 | 39 | #include <linux/ide.h> | 
 | 40 | #include <linux/sysdev.h> | 
 | 41 |  | 
 | 42 | #include <linux/dma-mapping.h> | 
 | 43 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 44 | #include "ide-timing.h" | 
 | 45 |  | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 46 | #include <asm/io.h> | 
 | 47 | #include <asm/mach-au1x00/au1xxx.h> | 
 | 48 | #include <asm/mach-au1x00/au1xxx_dbdma.h> | 
 | 49 |  | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 50 | #include <asm/mach-au1x00/au1xxx_ide.h> | 
 | 51 |  | 
 | 52 | #define DRV_NAME	"au1200-ide" | 
 | 53 | #define DRV_VERSION	"1.0" | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 54 | #define DRV_AUTHOR	"Enrico Walther <enrico.walther@amd.com> / Pete Popov <ppopov@embeddedalley.com>" | 
 | 55 |  | 
 | 56 | /* enable the burstmode in the dbdma */ | 
 | 57 | #define IDE_AU1XXX_BURSTMODE	1 | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 58 |  | 
 | 59 | static _auide_hwif auide_hwif; | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 60 | static int dbdma_init_done; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 61 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 62 | #if defined(CONFIG_BLK_DEV_IDE_AU1XXX_PIO_DBDMA) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 63 |  | 
 | 64 | void auide_insw(unsigned long port, void *addr, u32 count) | 
 | 65 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 66 | 	_auide_hwif *ahwif = &auide_hwif; | 
 | 67 | 	chan_tab_t *ctp; | 
 | 68 | 	au1x_ddma_desc_t *dp; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 69 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 70 | 	if(!put_dest_flags(ahwif->rx_chan, (void*)addr, count << 1,  | 
 | 71 | 			   DDMA_FLAGS_NOIE)) { | 
 | 72 | 		printk(KERN_ERR "%s failed %d\n", __FUNCTION__, __LINE__); | 
 | 73 | 		return; | 
 | 74 | 	} | 
 | 75 | 	ctp = *((chan_tab_t **)ahwif->rx_chan); | 
 | 76 | 	dp = ctp->cur_ptr; | 
 | 77 | 	while (dp->dscr_cmd0 & DSCR_CMD0_V) | 
 | 78 | 		; | 
 | 79 | 	ctp->cur_ptr = au1xxx_ddma_get_nextptr_virt(dp); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 80 | } | 
 | 81 |  | 
 | 82 | void auide_outsw(unsigned long port, void *addr, u32 count) | 
 | 83 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 84 | 	_auide_hwif *ahwif = &auide_hwif; | 
 | 85 | 	chan_tab_t *ctp; | 
 | 86 | 	au1x_ddma_desc_t *dp; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 87 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 88 | 	if(!put_source_flags(ahwif->tx_chan, (void*)addr, | 
 | 89 | 			     count << 1, DDMA_FLAGS_NOIE)) { | 
 | 90 | 		printk(KERN_ERR "%s failed %d\n", __FUNCTION__, __LINE__); | 
 | 91 | 		return; | 
 | 92 | 	} | 
 | 93 | 	ctp = *((chan_tab_t **)ahwif->tx_chan); | 
 | 94 | 	dp = ctp->cur_ptr; | 
 | 95 | 	while (dp->dscr_cmd0 & DSCR_CMD0_V) | 
 | 96 | 		; | 
 | 97 | 	ctp->cur_ptr = au1xxx_ddma_get_nextptr_virt(dp); | 
 | 98 | } | 
 | 99 |  | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 100 | #endif | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 101 |  | 
| Bartlomiej Zolnierkiewicz | 26bcb87 | 2007-10-11 23:54:00 +0200 | [diff] [blame] | 102 | static void au1xxx_set_pio_mode(ide_drive_t *drive, const u8 pio) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 103 | { | 
| Bartlomiej Zolnierkiewicz | 88b2b32 | 2007-10-13 17:47:51 +0200 | [diff] [blame] | 104 | 	int mem_sttime = 0, mem_stcfg = au_readl(MEM_STCFG2); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 105 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 106 | 	/* set pio mode! */ | 
 | 107 | 	switch(pio) { | 
 | 108 | 	case 0: | 
 | 109 | 		mem_sttime = SBC_IDE_TIMING(PIO0); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 110 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 111 | 		/* set configuration for RCS2# */ | 
 | 112 | 		mem_stcfg |= TS_MASK; | 
 | 113 | 		mem_stcfg &= ~TCSOE_MASK; | 
 | 114 | 		mem_stcfg &= ~TOECS_MASK; | 
 | 115 | 		mem_stcfg |= SBC_IDE_PIO0_TCSOE | SBC_IDE_PIO0_TOECS; | 
 | 116 | 		break; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 117 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 118 | 	case 1: | 
 | 119 | 		mem_sttime = SBC_IDE_TIMING(PIO1); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 120 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 121 | 		/* set configuration for RCS2# */ | 
 | 122 | 		mem_stcfg |= TS_MASK; | 
 | 123 | 		mem_stcfg &= ~TCSOE_MASK; | 
 | 124 | 		mem_stcfg &= ~TOECS_MASK; | 
 | 125 | 		mem_stcfg |= SBC_IDE_PIO1_TCSOE | SBC_IDE_PIO1_TOECS; | 
 | 126 | 		break; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 127 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 128 | 	case 2: | 
 | 129 | 		mem_sttime = SBC_IDE_TIMING(PIO2); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 130 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 131 | 		/* set configuration for RCS2# */ | 
 | 132 | 		mem_stcfg &= ~TS_MASK; | 
 | 133 | 		mem_stcfg &= ~TCSOE_MASK; | 
 | 134 | 		mem_stcfg &= ~TOECS_MASK; | 
 | 135 | 		mem_stcfg |= SBC_IDE_PIO2_TCSOE | SBC_IDE_PIO2_TOECS; | 
 | 136 | 		break; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 137 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 138 | 	case 3: | 
 | 139 | 		mem_sttime = SBC_IDE_TIMING(PIO3); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 140 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 141 | 		/* set configuration for RCS2# */ | 
 | 142 | 		mem_stcfg &= ~TS_MASK; | 
 | 143 | 		mem_stcfg &= ~TCSOE_MASK; | 
 | 144 | 		mem_stcfg &= ~TOECS_MASK; | 
 | 145 | 		mem_stcfg |= SBC_IDE_PIO3_TCSOE | SBC_IDE_PIO3_TOECS; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 146 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 147 | 		break; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 148 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 149 | 	case 4: | 
 | 150 | 		mem_sttime = SBC_IDE_TIMING(PIO4); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 151 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 152 | 		/* set configuration for RCS2# */ | 
 | 153 | 		mem_stcfg &= ~TS_MASK; | 
 | 154 | 		mem_stcfg &= ~TCSOE_MASK; | 
 | 155 | 		mem_stcfg &= ~TOECS_MASK; | 
 | 156 | 		mem_stcfg |= SBC_IDE_PIO4_TCSOE | SBC_IDE_PIO4_TOECS; | 
 | 157 | 		break; | 
 | 158 | 	} | 
 | 159 |  | 
 | 160 | 	au_writel(mem_sttime,MEM_STTIME2); | 
 | 161 | 	au_writel(mem_stcfg,MEM_STCFG2); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 162 | } | 
 | 163 |  | 
| Bartlomiej Zolnierkiewicz | 88b2b32 | 2007-10-13 17:47:51 +0200 | [diff] [blame] | 164 | static void auide_set_dma_mode(ide_drive_t *drive, const u8 speed) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 165 | { | 
| Bartlomiej Zolnierkiewicz | 88b2b32 | 2007-10-13 17:47:51 +0200 | [diff] [blame] | 166 | 	int mem_sttime = 0, mem_stcfg = au_readl(MEM_STCFG2); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 167 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 168 | 	switch(speed) { | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 169 | #ifdef CONFIG_BLK_DEV_IDE_AU1XXX_MDMA2_DBDMA | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 170 | 	case XFER_MW_DMA_2: | 
 | 171 | 		mem_sttime = SBC_IDE_TIMING(MDMA2); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 172 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 173 | 		/* set configuration for RCS2# */ | 
 | 174 | 		mem_stcfg &= ~TS_MASK; | 
 | 175 | 		mem_stcfg &= ~TCSOE_MASK; | 
 | 176 | 		mem_stcfg &= ~TOECS_MASK; | 
 | 177 | 		mem_stcfg |= SBC_IDE_MDMA2_TCSOE | SBC_IDE_MDMA2_TOECS; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 178 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 179 | 		break; | 
 | 180 | 	case XFER_MW_DMA_1: | 
 | 181 | 		mem_sttime = SBC_IDE_TIMING(MDMA1); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 182 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 183 | 		/* set configuration for RCS2# */ | 
 | 184 | 		mem_stcfg &= ~TS_MASK; | 
 | 185 | 		mem_stcfg &= ~TCSOE_MASK; | 
 | 186 | 		mem_stcfg &= ~TOECS_MASK; | 
 | 187 | 		mem_stcfg |= SBC_IDE_MDMA1_TCSOE | SBC_IDE_MDMA1_TOECS; | 
 | 188 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 189 | 		break; | 
 | 190 | 	case XFER_MW_DMA_0: | 
 | 191 | 		mem_sttime = SBC_IDE_TIMING(MDMA0); | 
 | 192 |  | 
 | 193 | 		/* set configuration for RCS2# */ | 
 | 194 | 		mem_stcfg |= TS_MASK; | 
 | 195 | 		mem_stcfg &= ~TCSOE_MASK; | 
 | 196 | 		mem_stcfg &= ~TOECS_MASK; | 
 | 197 | 		mem_stcfg |= SBC_IDE_MDMA0_TCSOE | SBC_IDE_MDMA0_TOECS; | 
 | 198 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 199 | 		break; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 200 | #endif | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 201 | 	default: | 
| Bartlomiej Zolnierkiewicz | 88b2b32 | 2007-10-13 17:47:51 +0200 | [diff] [blame] | 202 | 		return; | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 203 | 	} | 
| Bartlomiej Zolnierkiewicz | a523a17 | 2007-02-17 02:40:23 +0100 | [diff] [blame] | 204 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 205 | 	au_writel(mem_sttime,MEM_STTIME2); | 
 | 206 | 	au_writel(mem_stcfg,MEM_STCFG2); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 207 | } | 
 | 208 |  | 
 | 209 | /* | 
 | 210 |  * Multi-Word DMA + DbDMA functions | 
 | 211 |  */ | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 212 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 213 | #ifdef CONFIG_BLK_DEV_IDE_AU1XXX_MDMA2_DBDMA | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 214 |  | 
 | 215 | static int auide_build_sglist(ide_drive_t *drive,  struct request *rq) | 
 | 216 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 217 | 	ide_hwif_t *hwif = drive->hwif; | 
 | 218 | 	_auide_hwif *ahwif = (_auide_hwif*)hwif->hwif_data; | 
 | 219 | 	struct scatterlist *sg = hwif->sg_table; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 220 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 221 | 	ide_map_sg(drive, rq); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 222 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 223 | 	if (rq_data_dir(rq) == READ) | 
 | 224 | 		hwif->sg_dma_direction = DMA_FROM_DEVICE; | 
 | 225 | 	else | 
 | 226 | 		hwif->sg_dma_direction = DMA_TO_DEVICE; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 227 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 228 | 	return dma_map_sg(ahwif->dev, sg, hwif->sg_nents, | 
 | 229 | 			  hwif->sg_dma_direction); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 230 | } | 
 | 231 |  | 
 | 232 | static int auide_build_dmatable(ide_drive_t *drive) | 
 | 233 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 234 | 	int i, iswrite, count = 0; | 
 | 235 | 	ide_hwif_t *hwif = HWIF(drive); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 236 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 237 | 	struct request *rq = HWGROUP(drive)->rq; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 238 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 239 | 	_auide_hwif *ahwif = (_auide_hwif*)hwif->hwif_data; | 
 | 240 | 	struct scatterlist *sg; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 241 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 242 | 	iswrite = (rq_data_dir(rq) == WRITE); | 
 | 243 | 	/* Save for interrupt context */ | 
 | 244 | 	ahwif->drive = drive; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 245 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 246 | 	/* Build sglist */ | 
 | 247 | 	hwif->sg_nents = i = auide_build_sglist(drive, rq); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 248 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 249 | 	if (!i) | 
 | 250 | 		return 0; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 251 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 252 | 	/* fill the descriptors */ | 
 | 253 | 	sg = hwif->sg_table; | 
 | 254 | 	while (i && sg_dma_len(sg)) { | 
 | 255 | 		u32 cur_addr; | 
 | 256 | 		u32 cur_len; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 257 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 258 | 		cur_addr = sg_dma_address(sg); | 
 | 259 | 		cur_len = sg_dma_len(sg); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 260 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 261 | 		while (cur_len) { | 
 | 262 | 			u32 flags = DDMA_FLAGS_NOIE; | 
 | 263 | 			unsigned int tc = (cur_len < 0xfe00)? cur_len: 0xfe00; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 264 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 265 | 			if (++count >= PRD_ENTRIES) { | 
 | 266 | 				printk(KERN_WARNING "%s: DMA table too small\n", | 
 | 267 | 				       drive->name); | 
 | 268 | 				goto use_pio_instead; | 
 | 269 | 			} | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 270 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 271 | 			/* Lets enable intr for the last descriptor only */ | 
 | 272 | 			if (1==i) | 
 | 273 | 				flags = DDMA_FLAGS_IE; | 
 | 274 | 			else | 
 | 275 | 				flags = DDMA_FLAGS_NOIE; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 276 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 277 | 			if (iswrite) { | 
 | 278 | 				if(!put_source_flags(ahwif->tx_chan,  | 
| Jens Axboe | 45711f1 | 2007-10-22 21:19:53 +0200 | [diff] [blame] | 279 | 						     (void*) sg_virt(sg), | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 280 | 						     tc, flags)) {  | 
 | 281 | 					printk(KERN_ERR "%s failed %d\n",  | 
 | 282 | 					       __FUNCTION__, __LINE__); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 283 | 				} | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 284 | 			} else  | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 285 | 			{ | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 286 | 				if(!put_dest_flags(ahwif->rx_chan,  | 
| Jens Axboe | 45711f1 | 2007-10-22 21:19:53 +0200 | [diff] [blame] | 287 | 						   (void*) sg_virt(sg), | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 288 | 						   tc, flags)) {  | 
 | 289 | 					printk(KERN_ERR "%s failed %d\n",  | 
 | 290 | 					       __FUNCTION__, __LINE__); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 291 | 				} | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 292 | 			} | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 293 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 294 | 			cur_addr += tc; | 
 | 295 | 			cur_len -= tc; | 
 | 296 | 		} | 
| Jens Axboe | 55c16a7 | 2007-07-25 08:13:56 +0200 | [diff] [blame] | 297 | 		sg = sg_next(sg); | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 298 | 		i--; | 
 | 299 | 	} | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 300 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 301 | 	if (count) | 
 | 302 | 		return 1; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 303 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 304 |  use_pio_instead: | 
 | 305 | 	dma_unmap_sg(ahwif->dev, | 
 | 306 | 		     hwif->sg_table, | 
 | 307 | 		     hwif->sg_nents, | 
 | 308 | 		     hwif->sg_dma_direction); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 309 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 310 | 	return 0; /* revert to PIO for this request */ | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 311 | } | 
 | 312 |  | 
 | 313 | static int auide_dma_end(ide_drive_t *drive) | 
 | 314 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 315 | 	ide_hwif_t *hwif = HWIF(drive); | 
 | 316 | 	_auide_hwif *ahwif = (_auide_hwif*)hwif->hwif_data; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 317 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 318 | 	if (hwif->sg_nents) { | 
 | 319 | 		dma_unmap_sg(ahwif->dev, hwif->sg_table, hwif->sg_nents, | 
 | 320 | 			     hwif->sg_dma_direction); | 
 | 321 | 		hwif->sg_nents = 0; | 
 | 322 | 	} | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 323 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 324 | 	return 0; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 325 | } | 
 | 326 |  | 
 | 327 | static void auide_dma_start(ide_drive_t *drive ) | 
 | 328 | { | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 329 | } | 
 | 330 |  | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 331 |  | 
 | 332 | static void auide_dma_exec_cmd(ide_drive_t *drive, u8 command) | 
 | 333 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 334 | 	/* issue cmd to drive */ | 
 | 335 | 	ide_execute_command(drive, command, &ide_dma_intr, | 
 | 336 | 			    (2*WAIT_CMD), NULL); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 337 | } | 
 | 338 |  | 
 | 339 | static int auide_dma_setup(ide_drive_t *drive) | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 340 | {       	 | 
 | 341 | 	struct request *rq = HWGROUP(drive)->rq; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 342 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 343 | 	if (!auide_build_dmatable(drive)) { | 
 | 344 | 		ide_map_sg(drive, rq); | 
 | 345 | 		return 1; | 
 | 346 | 	} | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 347 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 348 | 	drive->waiting_for_dma = 1; | 
 | 349 | 	return 0; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 350 | } | 
 | 351 |  | 
| Bartlomiej Zolnierkiewicz | 8446f65 | 2007-10-16 22:29:54 +0200 | [diff] [blame] | 352 | static u8 auide_mdma_filter(ide_drive_t *drive) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 353 | { | 
| Bartlomiej Zolnierkiewicz | 8446f65 | 2007-10-16 22:29:54 +0200 | [diff] [blame] | 354 | 	/* | 
 | 355 | 	 * FIXME: ->white_list and ->black_list are based on completely bogus | 
 | 356 | 	 * ->ide_dma_check implementation which didn't set neither the host | 
 | 357 | 	 * controller timings nor the device for the desired transfer mode. | 
 | 358 | 	 * | 
 | 359 | 	 * They should be either removed or 0x00 MWDMA mask should be | 
 | 360 | 	 * returned for devices on the ->black_list. | 
 | 361 | 	 */ | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 362 |  | 
| Bartlomiej Zolnierkiewicz | 8446f65 | 2007-10-16 22:29:54 +0200 | [diff] [blame] | 363 | 	if (dbdma_init_done == 0) { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 364 | 		auide_hwif.white_list = ide_in_drive_list(drive->id, | 
 | 365 | 							  dma_white_list); | 
 | 366 | 		auide_hwif.black_list = ide_in_drive_list(drive->id, | 
 | 367 | 							  dma_black_list); | 
 | 368 | 		auide_hwif.drive = drive; | 
 | 369 | 		auide_ddma_init(&auide_hwif); | 
 | 370 | 		dbdma_init_done = 1; | 
 | 371 | 	} | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 372 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 373 | 	/* Is the drive in our DMA black list? */ | 
| Bartlomiej Zolnierkiewicz | 8446f65 | 2007-10-16 22:29:54 +0200 | [diff] [blame] | 374 | 	if (auide_hwif.black_list) | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 375 | 		printk(KERN_WARNING "%s: Disabling DMA for %s (blacklisted)\n", | 
| Bartlomiej Zolnierkiewicz | 8446f65 | 2007-10-16 22:29:54 +0200 | [diff] [blame] | 376 | 				    drive->name, drive->id->model); | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 377 |  | 
| Bartlomiej Zolnierkiewicz | 8446f65 | 2007-10-16 22:29:54 +0200 | [diff] [blame] | 378 | 	return drive->hwif->mwdma_mask; | 
 | 379 | } | 
 | 380 |  | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 381 | static int auide_dma_test_irq(ide_drive_t *drive) | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 382 | {	 | 
 | 383 | 	if (drive->waiting_for_dma == 0) | 
 | 384 | 		printk(KERN_WARNING "%s: ide_dma_test_irq \ | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 385 |                                      called while not waiting\n", drive->name); | 
 | 386 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 387 | 	/* If dbdma didn't execute the STOP command yet, the | 
 | 388 | 	 * active bit is still set | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 389 | 	 */ | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 390 | 	drive->waiting_for_dma++; | 
 | 391 | 	if (drive->waiting_for_dma >= DMA_WAIT_TIMEOUT) { | 
 | 392 | 		printk(KERN_WARNING "%s: timeout waiting for ddma to \ | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 393 |                                      complete\n", drive->name); | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 394 | 		return 1; | 
 | 395 | 	} | 
 | 396 | 	udelay(10); | 
 | 397 | 	return 0; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 398 | } | 
 | 399 |  | 
| Bartlomiej Zolnierkiewicz | ccf3528 | 2007-02-17 02:40:26 +0100 | [diff] [blame] | 400 | static void auide_dma_host_on(ide_drive_t *drive) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 401 | { | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 402 | } | 
 | 403 |  | 
 | 404 | static int auide_dma_on(ide_drive_t *drive) | 
 | 405 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 406 | 	drive->using_dma = 1; | 
| Bartlomiej Zolnierkiewicz | ccf3528 | 2007-02-17 02:40:26 +0100 | [diff] [blame] | 407 |  | 
 | 408 | 	return 0; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 409 | } | 
 | 410 |  | 
| Bartlomiej Zolnierkiewicz | 7469aaf | 2007-02-17 02:40:26 +0100 | [diff] [blame] | 411 | static void auide_dma_host_off(ide_drive_t *drive) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 412 | { | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 413 | } | 
 | 414 |  | 
| Bartlomiej Zolnierkiewicz | 7469aaf | 2007-02-17 02:40:26 +0100 | [diff] [blame] | 415 | static void auide_dma_off_quietly(ide_drive_t *drive) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 416 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 417 | 	drive->using_dma = 0; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 418 | } | 
 | 419 |  | 
| Sergei Shtylyov | 841d2a9 | 2007-07-09 23:17:54 +0200 | [diff] [blame] | 420 | static void auide_dma_lost_irq(ide_drive_t *drive) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 421 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 422 | 	printk(KERN_ERR "%s: IRQ lost\n", drive->name); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 423 | } | 
 | 424 |  | 
| Ralf Baechle | 53e62d3 | 2006-09-25 23:32:10 -0700 | [diff] [blame] | 425 | static void auide_ddma_tx_callback(int irq, void *param) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 426 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 427 | 	_auide_hwif *ahwif = (_auide_hwif*)param; | 
 | 428 | 	ahwif->drive->waiting_for_dma = 0; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 429 | } | 
 | 430 |  | 
| Ralf Baechle | 53e62d3 | 2006-09-25 23:32:10 -0700 | [diff] [blame] | 431 | static void auide_ddma_rx_callback(int irq, void *param) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 432 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 433 | 	_auide_hwif *ahwif = (_auide_hwif*)param; | 
 | 434 | 	ahwif->drive->waiting_for_dma = 0; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 435 | } | 
 | 436 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 437 | #endif /* end CONFIG_BLK_DEV_IDE_AU1XXX_MDMA2_DBDMA */ | 
 | 438 |  | 
 | 439 | static void auide_init_dbdma_dev(dbdev_tab_t *dev, u32 dev_id, u32 tsize, u32 devwidth, u32 flags) | 
 | 440 | { | 
 | 441 | 	dev->dev_id          = dev_id; | 
 | 442 | 	dev->dev_physaddr    = (u32)AU1XXX_ATA_PHYS_ADDR; | 
 | 443 | 	dev->dev_intlevel    = 0; | 
 | 444 | 	dev->dev_intpolarity = 0; | 
 | 445 | 	dev->dev_tsize       = tsize; | 
 | 446 | 	dev->dev_devwidth    = devwidth; | 
 | 447 | 	dev->dev_flags       = flags; | 
 | 448 | } | 
 | 449 |    | 
 | 450 | #if defined(CONFIG_BLK_DEV_IDE_AU1XXX_MDMA2_DBDMA) | 
 | 451 |  | 
| Sergei Shtylyov | c283f5d | 2007-07-09 23:17:54 +0200 | [diff] [blame] | 452 | static void auide_dma_timeout(ide_drive_t *drive) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 453 | { | 
| Sergei Shtylyov | c283f5d | 2007-07-09 23:17:54 +0200 | [diff] [blame] | 454 | 	ide_hwif_t *hwif = HWIF(drive); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 455 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 456 | 	printk(KERN_ERR "%s: DMA timeout occurred: ", drive->name); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 457 |  | 
| Sergei Shtylyov | c283f5d | 2007-07-09 23:17:54 +0200 | [diff] [blame] | 458 | 	if (hwif->ide_dma_test_irq(drive)) | 
 | 459 | 		return; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 460 |  | 
| Sergei Shtylyov | c283f5d | 2007-07-09 23:17:54 +0200 | [diff] [blame] | 461 | 	hwif->ide_dma_end(drive); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 462 | } | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 463 | 					 | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 464 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 465 | static int auide_ddma_init(_auide_hwif *auide) { | 
 | 466 | 	 | 
 | 467 | 	dbdev_tab_t source_dev_tab, target_dev_tab; | 
 | 468 | 	u32 dev_id, tsize, devwidth, flags; | 
 | 469 | 	ide_hwif_t *hwif = auide->hwif; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 470 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 471 | 	dev_id   = AU1XXX_ATA_DDMA_REQ; | 
 | 472 |  | 
 | 473 | 	if (auide->white_list || auide->black_list) { | 
 | 474 | 		tsize    = 8; | 
 | 475 | 		devwidth = 32; | 
 | 476 | 	} | 
 | 477 | 	else {  | 
 | 478 | 		tsize    = 1; | 
 | 479 | 		devwidth = 16; | 
 | 480 | 		 | 
 | 481 | 		printk(KERN_ERR "au1xxx-ide: %s is not on ide driver whitelist.\n",auide_hwif.drive->id->model); | 
 | 482 | 		printk(KERN_ERR "            please read 'Documentation/mips/AU1xxx_IDE.README'"); | 
 | 483 | 	} | 
 | 484 |  | 
 | 485 | #ifdef IDE_AU1XXX_BURSTMODE  | 
 | 486 | 	flags = DEV_FLAGS_SYNC | DEV_FLAGS_BURSTABLE; | 
 | 487 | #else | 
 | 488 | 	flags = DEV_FLAGS_SYNC; | 
 | 489 | #endif | 
 | 490 |  | 
 | 491 | 	/* setup dev_tab for tx channel */ | 
 | 492 | 	auide_init_dbdma_dev( &source_dev_tab, | 
 | 493 | 			      dev_id, | 
 | 494 | 			      tsize, devwidth, DEV_FLAGS_OUT | flags); | 
 | 495 |  	auide->tx_dev_id = au1xxx_ddma_add_device( &source_dev_tab ); | 
 | 496 |  | 
 | 497 | 	auide_init_dbdma_dev( &source_dev_tab, | 
 | 498 | 			      dev_id, | 
 | 499 | 			      tsize, devwidth, DEV_FLAGS_IN | flags); | 
 | 500 |  	auide->rx_dev_id = au1xxx_ddma_add_device( &source_dev_tab ); | 
 | 501 | 	 | 
 | 502 | 	/* We also need to add a target device for the DMA */ | 
 | 503 | 	auide_init_dbdma_dev( &target_dev_tab, | 
 | 504 | 			      (u32)DSCR_CMD0_ALWAYS, | 
 | 505 | 			      tsize, devwidth, DEV_FLAGS_ANYUSE); | 
 | 506 | 	auide->target_dev_id = au1xxx_ddma_add_device(&target_dev_tab);	 | 
 | 507 |   | 
 | 508 | 	/* Get a channel for TX */ | 
 | 509 | 	auide->tx_chan = au1xxx_dbdma_chan_alloc(auide->target_dev_id, | 
 | 510 | 						 auide->tx_dev_id, | 
 | 511 | 						 auide_ddma_tx_callback, | 
 | 512 | 						 (void*)auide); | 
 | 513 |   | 
 | 514 | 	/* Get a channel for RX */ | 
 | 515 | 	auide->rx_chan = au1xxx_dbdma_chan_alloc(auide->rx_dev_id, | 
 | 516 | 						 auide->target_dev_id, | 
 | 517 | 						 auide_ddma_rx_callback, | 
 | 518 | 						 (void*)auide); | 
 | 519 |  | 
 | 520 | 	auide->tx_desc_head = (void*)au1xxx_dbdma_ring_alloc(auide->tx_chan, | 
 | 521 | 							     NUM_DESCRIPTORS); | 
 | 522 | 	auide->rx_desc_head = (void*)au1xxx_dbdma_ring_alloc(auide->rx_chan, | 
 | 523 | 							     NUM_DESCRIPTORS); | 
 | 524 |   | 
 | 525 | 	hwif->dmatable_cpu = dma_alloc_coherent(auide->dev, | 
 | 526 | 						PRD_ENTRIES * PRD_BYTES,        /* 1 Page */ | 
 | 527 | 						&hwif->dmatable_dma, GFP_KERNEL); | 
 | 528 | 	 | 
 | 529 | 	au1xxx_dbdma_start( auide->tx_chan ); | 
 | 530 | 	au1xxx_dbdma_start( auide->rx_chan ); | 
 | 531 |   | 
 | 532 | 	return 0; | 
 | 533 | }  | 
 | 534 | #else | 
 | 535 |   | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 536 | static int auide_ddma_init( _auide_hwif *auide ) | 
 | 537 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 538 | 	dbdev_tab_t source_dev_tab; | 
 | 539 | 	int flags; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 540 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 541 | #ifdef IDE_AU1XXX_BURSTMODE  | 
 | 542 | 	flags = DEV_FLAGS_SYNC | DEV_FLAGS_BURSTABLE; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 543 | #else | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 544 | 	flags = DEV_FLAGS_SYNC; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 545 | #endif | 
 | 546 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 547 | 	/* setup dev_tab for tx channel */ | 
 | 548 | 	auide_init_dbdma_dev( &source_dev_tab, | 
 | 549 | 			      (u32)DSCR_CMD0_ALWAYS, | 
 | 550 | 			      8, 32, DEV_FLAGS_OUT | flags); | 
 | 551 |  	auide->tx_dev_id = au1xxx_ddma_add_device( &source_dev_tab ); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 552 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 553 | 	auide_init_dbdma_dev( &source_dev_tab, | 
 | 554 | 			      (u32)DSCR_CMD0_ALWAYS, | 
 | 555 | 			      8, 32, DEV_FLAGS_IN | flags); | 
 | 556 |  	auide->rx_dev_id = au1xxx_ddma_add_device( &source_dev_tab ); | 
 | 557 | 	 | 
 | 558 | 	/* Get a channel for TX */ | 
 | 559 | 	auide->tx_chan = au1xxx_dbdma_chan_alloc(DSCR_CMD0_ALWAYS, | 
 | 560 | 						 auide->tx_dev_id, | 
 | 561 | 						 NULL, | 
 | 562 | 						 (void*)auide); | 
 | 563 |   | 
 | 564 | 	/* Get a channel for RX */ | 
 | 565 | 	auide->rx_chan = au1xxx_dbdma_chan_alloc(auide->rx_dev_id, | 
 | 566 | 						 DSCR_CMD0_ALWAYS, | 
 | 567 | 						 NULL, | 
 | 568 | 						 (void*)auide); | 
 | 569 |   | 
 | 570 | 	auide->tx_desc_head = (void*)au1xxx_dbdma_ring_alloc(auide->tx_chan, | 
 | 571 | 							     NUM_DESCRIPTORS); | 
 | 572 | 	auide->rx_desc_head = (void*)au1xxx_dbdma_ring_alloc(auide->rx_chan, | 
 | 573 | 							     NUM_DESCRIPTORS); | 
 | 574 |   | 
 | 575 | 	au1xxx_dbdma_start( auide->tx_chan ); | 
 | 576 | 	au1xxx_dbdma_start( auide->rx_chan ); | 
 | 577 |  	 | 
 | 578 | 	return 0; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 579 | } | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 580 | #endif | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 581 |  | 
 | 582 | static void auide_setup_ports(hw_regs_t *hw, _auide_hwif *ahwif) | 
 | 583 | { | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 584 | 	int i; | 
 | 585 | 	unsigned long *ata_regs = hw->io_ports; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 586 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 587 | 	/* FIXME? */ | 
 | 588 | 	for (i = 0; i < IDE_CONTROL_OFFSET; i++) { | 
 | 589 | 		*ata_regs++ = ahwif->regbase + (i << AU1XXX_ATA_REG_OFFSET); | 
 | 590 | 	} | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 591 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 592 | 	/* set the Alternative Status register */ | 
 | 593 | 	*ata_regs = ahwif->regbase + (14 << AU1XXX_ATA_REG_OFFSET); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 594 | } | 
 | 595 |  | 
 | 596 | static int au_ide_probe(struct device *dev) | 
 | 597 | { | 
 | 598 | 	struct platform_device *pdev = to_platform_device(dev); | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 599 | 	_auide_hwif *ahwif = &auide_hwif; | 
 | 600 | 	ide_hwif_t *hwif; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 601 | 	struct resource *res; | 
 | 602 | 	int ret = 0; | 
| Bartlomiej Zolnierkiewicz | 8447d9d | 2007-10-20 00:32:31 +0200 | [diff] [blame] | 603 | 	u8 idx[4] = { 0xff, 0xff, 0xff, 0xff }; | 
| Bartlomiej Zolnierkiewicz | 9239b33 | 2007-10-20 00:32:33 +0200 | [diff] [blame] | 604 | 	hw_regs_t hw; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 605 |  | 
 | 606 | #if defined(CONFIG_BLK_DEV_IDE_AU1XXX_MDMA2_DBDMA) | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 607 | 	char *mode = "MWDMA2"; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 608 | #elif defined(CONFIG_BLK_DEV_IDE_AU1XXX_PIO_DBDMA) | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 609 | 	char *mode = "PIO+DDMA(offload)"; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 610 | #endif | 
 | 611 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 612 | 	memset(&auide_hwif, 0, sizeof(_auide_hwif)); | 
 | 613 | 	auide_hwif.dev                  = 0; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 614 |  | 
 | 615 | 	ahwif->dev = dev; | 
 | 616 | 	ahwif->irq = platform_get_irq(pdev, 0); | 
 | 617 |  | 
 | 618 | 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 
 | 619 |  | 
 | 620 | 	if (res == NULL) { | 
 | 621 | 		pr_debug("%s %d: no base address\n", DRV_NAME, pdev->id); | 
 | 622 | 		ret = -ENODEV; | 
 | 623 | 		goto out; | 
 | 624 | 	} | 
| David Vrabel | 4894473 | 2006-01-19 17:56:29 +0000 | [diff] [blame] | 625 | 	if (ahwif->irq < 0) { | 
 | 626 | 		pr_debug("%s %d: no IRQ\n", DRV_NAME, pdev->id); | 
 | 627 | 		ret = -ENODEV; | 
 | 628 | 		goto out; | 
 | 629 | 	} | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 630 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 631 | 	if (!request_mem_region (res->start, res->end-res->start, pdev->name)) { | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 632 | 		pr_debug("%s: request_mem_region failed\n", DRV_NAME); | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 633 | 		ret =  -EBUSY; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 634 | 		goto out; | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 635 | 	} | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 636 |  | 
 | 637 | 	ahwif->regbase = (u32)ioremap(res->start, res->end-res->start); | 
 | 638 | 	if (ahwif->regbase == 0) { | 
 | 639 | 		ret = -ENOMEM; | 
 | 640 | 		goto out; | 
 | 641 | 	} | 
 | 642 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 643 | 	/* FIXME:  This might possibly break PCMCIA IDE devices */ | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 644 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 645 | 	hwif                            = &ide_hwifs[pdev->id]; | 
| Bartlomiej Zolnierkiewicz | 9239b33 | 2007-10-20 00:32:33 +0200 | [diff] [blame] | 646 | 	hwif->irq			= ahwif->irq; | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 647 | 	hwif->chipset                   = ide_au1xxx; | 
 | 648 |  | 
| Bartlomiej Zolnierkiewicz | 9239b33 | 2007-10-20 00:32:33 +0200 | [diff] [blame] | 649 | 	memset(&hw, 0, sizeof(hw)); | 
 | 650 | 	auide_setup_ports(&hw, ahwif); | 
 | 651 | 	memcpy(hwif->io_ports, hw.io_ports, sizeof(hwif->io_ports)); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 652 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 653 | 	hwif->ultra_mask                = 0x0;  /* Disable Ultra DMA */ | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 654 | #ifdef CONFIG_BLK_DEV_IDE_AU1XXX_MDMA2_DBDMA | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 655 | 	hwif->mwdma_mask                = 0x07; /* Multimode-2 DMA  */ | 
 | 656 | 	hwif->swdma_mask                = 0x00; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 657 | #else | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 658 | 	hwif->mwdma_mask                = 0x0; | 
 | 659 | 	hwif->swdma_mask                = 0x0; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 660 | #endif | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 661 |  | 
| Bartlomiej Zolnierkiewicz | 4099d14 | 2007-07-20 01:11:59 +0200 | [diff] [blame] | 662 | 	hwif->pio_mask = ATA_PIO4; | 
| Bartlomiej Zolnierkiewicz | 88b2b32 | 2007-10-13 17:47:51 +0200 | [diff] [blame] | 663 | 	hwif->host_flags = IDE_HFLAG_POST_SET_MODE; | 
| Bartlomiej Zolnierkiewicz | 4099d14 | 2007-07-20 01:11:59 +0200 | [diff] [blame] | 664 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 665 | 	hwif->noprobe = 0; | 
 | 666 | 	hwif->drives[0].unmask          = 1; | 
 | 667 | 	hwif->drives[1].unmask          = 1; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 668 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 669 | 	/* hold should be on in all cases */ | 
 | 670 | 	hwif->hold                      = 1; | 
| Bartlomiej Zolnierkiewicz | 2ad1e55 | 2007-02-17 02:40:25 +0100 | [diff] [blame] | 671 |  | 
 | 672 | 	hwif->mmio  = 1; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 673 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 674 | 	/* If the user has selected DDMA assisted copies, | 
 | 675 | 	   then set up a few local I/O function entry points  | 
 | 676 | 	*/ | 
 | 677 |  | 
 | 678 | #ifdef CONFIG_BLK_DEV_IDE_AU1XXX_PIO_DBDMA	 | 
 | 679 | 	hwif->INSW                      = auide_insw; | 
 | 680 | 	hwif->OUTSW                     = auide_outsw; | 
 | 681 | #endif | 
 | 682 |  | 
| Bartlomiej Zolnierkiewicz | 26bcb87 | 2007-10-11 23:54:00 +0200 | [diff] [blame] | 683 | 	hwif->set_pio_mode		= &au1xxx_set_pio_mode; | 
| Bartlomiej Zolnierkiewicz | 88b2b32 | 2007-10-13 17:47:51 +0200 | [diff] [blame] | 684 | 	hwif->set_dma_mode		= &auide_set_dma_mode; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 685 |  | 
 | 686 | #ifdef CONFIG_BLK_DEV_IDE_AU1XXX_MDMA2_DBDMA | 
| Bartlomiej Zolnierkiewicz | 7469aaf | 2007-02-17 02:40:26 +0100 | [diff] [blame] | 687 | 	hwif->dma_off_quietly		= &auide_dma_off_quietly; | 
| Sergei Shtylyov | c283f5d | 2007-07-09 23:17:54 +0200 | [diff] [blame] | 688 | 	hwif->dma_timeout		= &auide_dma_timeout; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 689 |  | 
| Bartlomiej Zolnierkiewicz | 8446f65 | 2007-10-16 22:29:54 +0200 | [diff] [blame] | 690 | 	hwif->mdma_filter		= &auide_mdma_filter; | 
 | 691 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 692 | 	hwif->dma_exec_cmd              = &auide_dma_exec_cmd; | 
 | 693 | 	hwif->dma_start                 = &auide_dma_start; | 
 | 694 | 	hwif->ide_dma_end               = &auide_dma_end; | 
 | 695 | 	hwif->dma_setup                 = &auide_dma_setup; | 
 | 696 | 	hwif->ide_dma_test_irq          = &auide_dma_test_irq; | 
| Bartlomiej Zolnierkiewicz | 7469aaf | 2007-02-17 02:40:26 +0100 | [diff] [blame] | 697 | 	hwif->dma_host_off		= &auide_dma_host_off; | 
| Bartlomiej Zolnierkiewicz | ccf3528 | 2007-02-17 02:40:26 +0100 | [diff] [blame] | 698 | 	hwif->dma_host_on		= &auide_dma_host_on; | 
| Sergei Shtylyov | 841d2a9 | 2007-07-09 23:17:54 +0200 | [diff] [blame] | 699 | 	hwif->dma_lost_irq		= &auide_dma_lost_irq; | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 700 | 	hwif->ide_dma_on                = &auide_dma_on; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 701 | #else /* !CONFIG_BLK_DEV_IDE_AU1XXX_MDMA2_DBDMA */ | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 702 | 	hwif->channel                   = 0; | 
 | 703 | 	hwif->hold                      = 1; | 
 | 704 | 	hwif->select_data               = 0;    /* no chipset-specific code */ | 
 | 705 | 	hwif->config_data               = 0;    /* no chipset-specific code */ | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 706 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 707 | 	hwif->drives[0].autotune        = 1;    /* 1=autotune, 2=noautotune, 0=default */ | 
| Bartlomiej Zolnierkiewicz | a05e2fa | 2007-10-20 00:32:33 +0200 | [diff] [blame] | 708 | 	hwif->drives[1].autotune	= 1; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 709 | #endif | 
| Bartlomiej Zolnierkiewicz | a05e2fa | 2007-10-20 00:32:33 +0200 | [diff] [blame] | 710 | 	hwif->drives[0].no_io_32bit	= 1; | 
 | 711 | 	hwif->drives[1].no_io_32bit	= 1; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 712 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 713 | 	auide_hwif.hwif                 = hwif; | 
 | 714 | 	hwif->hwif_data                 = &auide_hwif; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 715 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 716 | #ifdef CONFIG_BLK_DEV_IDE_AU1XXX_PIO_DBDMA            | 
 | 717 | 	auide_ddma_init(&auide_hwif); | 
 | 718 | 	dbdma_init_done = 1; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 719 | #endif | 
 | 720 |  | 
| Bartlomiej Zolnierkiewicz | 8447d9d | 2007-10-20 00:32:31 +0200 | [diff] [blame] | 721 | 	idx[0] = hwif->index; | 
| Bartlomiej Zolnierkiewicz | 5cbf79c | 2007-05-10 00:01:11 +0200 | [diff] [blame] | 722 |  | 
| Bartlomiej Zolnierkiewicz | 8447d9d | 2007-10-20 00:32:31 +0200 | [diff] [blame] | 723 | 	ide_device_add(idx); | 
| Bartlomiej Zolnierkiewicz | 5cbf79c | 2007-05-10 00:01:11 +0200 | [diff] [blame] | 724 |  | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 725 | 	dev_set_drvdata(dev, hwif); | 
 | 726 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 727 | 	printk(KERN_INFO "Au1xxx IDE(builtin) configured for %s\n", mode ); | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 728 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 729 |  out: | 
 | 730 | 	return ret; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 731 | } | 
 | 732 |  | 
 | 733 | static int au_ide_remove(struct device *dev) | 
 | 734 | { | 
 | 735 | 	struct platform_device *pdev = to_platform_device(dev); | 
 | 736 | 	struct resource *res; | 
 | 737 | 	ide_hwif_t *hwif = dev_get_drvdata(dev); | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 738 | 	_auide_hwif *ahwif = &auide_hwif; | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 739 |  | 
 | 740 | 	ide_unregister(hwif - ide_hwifs); | 
 | 741 |  | 
 | 742 | 	iounmap((void *)ahwif->regbase); | 
 | 743 |  | 
 | 744 | 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 
 | 745 | 	release_mem_region(res->start, res->end - res->start); | 
 | 746 |  | 
 | 747 | 	return 0; | 
 | 748 | } | 
 | 749 |  | 
 | 750 | static struct device_driver au1200_ide_driver = { | 
 | 751 | 	.name		= "au1200-ide", | 
 | 752 | 	.bus		= &platform_bus_type, | 
 | 753 | 	.probe 		= au_ide_probe, | 
 | 754 | 	.remove		= au_ide_remove, | 
 | 755 | }; | 
 | 756 |  | 
 | 757 | static int __init au_ide_init(void) | 
 | 758 | { | 
 | 759 | 	return driver_register(&au1200_ide_driver); | 
 | 760 | } | 
 | 761 |  | 
| Jordan Crouse | 8f29e65 | 2005-12-15 02:17:46 +0100 | [diff] [blame] | 762 | static void __exit au_ide_exit(void) | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 763 | { | 
 | 764 | 	driver_unregister(&au1200_ide_driver); | 
 | 765 | } | 
 | 766 |  | 
| Pete Popov | 26a940e | 2005-09-15 08:03:12 +0000 | [diff] [blame] | 767 | MODULE_LICENSE("GPL"); | 
 | 768 | MODULE_DESCRIPTION("AU1200 IDE driver"); | 
 | 769 |  | 
 | 770 | module_init(au_ide_init); | 
 | 771 | module_exit(au_ide_exit); |