| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |  *  sata_promise.c - Promise SATA | 
 | 3 |  * | 
 | 4 |  *  Maintained by:  Jeff Garzik <jgarzik@pobox.com> | 
 | 5 |  *  		    Please ALWAYS copy linux-ide@vger.kernel.org | 
 | 6 |  *		    on emails. | 
 | 7 |  * | 
 | 8 |  *  Copyright 2003-2004 Red Hat, Inc. | 
 | 9 |  * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 10 |  * | 
| Jeff Garzik | af36d7f | 2005-08-28 20:18:39 -0400 | [diff] [blame] | 11 |  *  This program is free software; you can redistribute it and/or modify | 
 | 12 |  *  it under the terms of the GNU General Public License as published by | 
 | 13 |  *  the Free Software Foundation; either version 2, or (at your option) | 
 | 14 |  *  any later version. | 
 | 15 |  * | 
 | 16 |  *  This program is distributed in the hope that it will be useful, | 
 | 17 |  *  but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 | 18 |  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
 | 19 |  *  GNU General Public License for more details. | 
 | 20 |  * | 
 | 21 |  *  You should have received a copy of the GNU General Public License | 
 | 22 |  *  along with this program; see the file COPYING.  If not, write to | 
 | 23 |  *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA. | 
 | 24 |  * | 
 | 25 |  * | 
 | 26 |  *  libata documentation is available via 'make {ps|pdf}docs', | 
 | 27 |  *  as Documentation/DocBook/libata.* | 
 | 28 |  * | 
 | 29 |  *  Hardware information only available under NDA. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 |  * | 
 | 31 |  */ | 
 | 32 |  | 
 | 33 | #include <linux/kernel.h> | 
 | 34 | #include <linux/module.h> | 
 | 35 | #include <linux/pci.h> | 
 | 36 | #include <linux/init.h> | 
 | 37 | #include <linux/blkdev.h> | 
 | 38 | #include <linux/delay.h> | 
 | 39 | #include <linux/interrupt.h> | 
 | 40 | #include <linux/sched.h> | 
| Jeff Garzik | a9524a7 | 2005-10-30 14:39:11 -0500 | [diff] [blame] | 41 | #include <linux/device.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | #include <scsi/scsi_host.h> | 
| Jeff Garzik | 193515d | 2005-11-07 00:59:37 -0500 | [diff] [blame] | 43 | #include <scsi/scsi_cmnd.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 | #include <linux/libata.h> | 
 | 45 | #include <asm/io.h> | 
 | 46 | #include "sata_promise.h" | 
 | 47 |  | 
 | 48 | #define DRV_NAME	"sata_promise" | 
| Jeff Garzik | 7bdd720 | 2005-11-16 11:06:59 -0500 | [diff] [blame] | 49 | #define DRV_VERSION	"1.03" | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 50 |  | 
 | 51 |  | 
 | 52 | enum { | 
 | 53 | 	PDC_PKT_SUBMIT		= 0x40, /* Command packet pointer addr */ | 
 | 54 | 	PDC_INT_SEQMASK		= 0x40,	/* Mask of asserted SEQ INTs */ | 
 | 55 | 	PDC_TBG_MODE		= 0x41,	/* TBG mode */ | 
 | 56 | 	PDC_FLASH_CTL		= 0x44, /* Flash control register */ | 
 | 57 | 	PDC_PCI_CTL		= 0x48, /* PCI control and status register */ | 
 | 58 | 	PDC_GLOBAL_CTL		= 0x48, /* Global control/status (per port) */ | 
 | 59 | 	PDC_CTLSTAT		= 0x60,	/* IDE control and status (per port) */ | 
 | 60 | 	PDC_SATA_PLUG_CSR	= 0x6C, /* SATA Plug control/status reg */ | 
 | 61 | 	PDC_SLEW_CTL		= 0x470, /* slew rate control reg */ | 
 | 62 |  | 
 | 63 | 	PDC_ERR_MASK		= (1<<19) | (1<<20) | (1<<21) | (1<<22) | | 
 | 64 | 				  (1<<8) | (1<<9) | (1<<10), | 
 | 65 |  | 
 | 66 | 	board_2037x		= 0,	/* FastTrak S150 TX2plus */ | 
 | 67 | 	board_20319		= 1,	/* FastTrak S150 TX4 */ | 
| Tobias Lorenz | f497ba7 | 2005-05-12 15:51:01 -0400 | [diff] [blame] | 68 | 	board_20619		= 2,	/* FastTrak TX4000 */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 69 |  | 
 | 70 | 	PDC_HAS_PATA		= (1 << 1), /* PDC20375 has PATA */ | 
 | 71 |  | 
 | 72 | 	PDC_RESET		= (1 << 11), /* HDMA reset */ | 
| Jeff Garzik | 5063019 | 2005-12-13 02:29:45 -0500 | [diff] [blame] | 73 |  | 
 | 74 | 	PDC_COMMON_FLAGS	= ATA_FLAG_NO_LEGACY | ATA_FLAG_SRST | | 
 | 75 | 				  ATA_FLAG_MMIO | ATA_FLAG_NO_ATAPI, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 76 | }; | 
 | 77 |  | 
 | 78 |  | 
 | 79 | struct pdc_port_priv { | 
 | 80 | 	u8			*pkt; | 
 | 81 | 	dma_addr_t		pkt_dma; | 
 | 82 | }; | 
 | 83 |  | 
 | 84 | static u32 pdc_sata_scr_read (struct ata_port *ap, unsigned int sc_reg); | 
 | 85 | static void pdc_sata_scr_write (struct ata_port *ap, unsigned int sc_reg, u32 val); | 
 | 86 | static int pdc_ata_init_one (struct pci_dev *pdev, const struct pci_device_id *ent); | 
 | 87 | static irqreturn_t pdc_interrupt (int irq, void *dev_instance, struct pt_regs *regs); | 
 | 88 | static void pdc_eng_timeout(struct ata_port *ap); | 
 | 89 | static int pdc_port_start(struct ata_port *ap); | 
 | 90 | static void pdc_port_stop(struct ata_port *ap); | 
| Jeff Garzik | 2cba582 | 2005-08-29 05:12:30 -0400 | [diff] [blame] | 91 | static void pdc_pata_phy_reset(struct ata_port *ap); | 
 | 92 | static void pdc_sata_phy_reset(struct ata_port *ap); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 93 | static void pdc_qc_prep(struct ata_queued_cmd *qc); | 
| Jeff Garzik | 057ace5 | 2005-10-22 14:27:05 -0400 | [diff] [blame] | 94 | static void pdc_tf_load_mmio(struct ata_port *ap, const struct ata_taskfile *tf); | 
 | 95 | static void pdc_exec_command_mmio(struct ata_port *ap, const struct ata_taskfile *tf); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 96 | static void pdc_irq_clear(struct ata_port *ap); | 
 | 97 | static int pdc_qc_issue_prot(struct ata_queued_cmd *qc); | 
 | 98 |  | 
| Jeff Garzik | 374b187 | 2005-08-30 05:42:52 -0400 | [diff] [blame] | 99 |  | 
| Jeff Garzik | 193515d | 2005-11-07 00:59:37 -0500 | [diff] [blame] | 100 | static struct scsi_host_template pdc_ata_sht = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 101 | 	.module			= THIS_MODULE, | 
 | 102 | 	.name			= DRV_NAME, | 
 | 103 | 	.ioctl			= ata_scsi_ioctl, | 
 | 104 | 	.queuecommand		= ata_scsi_queuecmd, | 
 | 105 | 	.eh_strategy_handler	= ata_scsi_error, | 
 | 106 | 	.can_queue		= ATA_DEF_QUEUE, | 
 | 107 | 	.this_id		= ATA_SHT_THIS_ID, | 
 | 108 | 	.sg_tablesize		= LIBATA_MAX_PRD, | 
 | 109 | 	.max_sectors		= ATA_MAX_SECTORS, | 
 | 110 | 	.cmd_per_lun		= ATA_SHT_CMD_PER_LUN, | 
 | 111 | 	.emulated		= ATA_SHT_EMULATED, | 
 | 112 | 	.use_clustering		= ATA_SHT_USE_CLUSTERING, | 
 | 113 | 	.proc_name		= DRV_NAME, | 
 | 114 | 	.dma_boundary		= ATA_DMA_BOUNDARY, | 
 | 115 | 	.slave_configure	= ata_scsi_slave_config, | 
 | 116 | 	.bios_param		= ata_std_bios_param, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 117 | }; | 
 | 118 |  | 
| Jeff Garzik | 057ace5 | 2005-10-22 14:27:05 -0400 | [diff] [blame] | 119 | static const struct ata_port_operations pdc_sata_ops = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 120 | 	.port_disable		= ata_port_disable, | 
 | 121 | 	.tf_load		= pdc_tf_load_mmio, | 
 | 122 | 	.tf_read		= ata_tf_read, | 
 | 123 | 	.check_status		= ata_check_status, | 
 | 124 | 	.exec_command		= pdc_exec_command_mmio, | 
 | 125 | 	.dev_select		= ata_std_dev_select, | 
| Jeff Garzik | 2cba582 | 2005-08-29 05:12:30 -0400 | [diff] [blame] | 126 |  | 
 | 127 | 	.phy_reset		= pdc_sata_phy_reset, | 
 | 128 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 129 | 	.qc_prep		= pdc_qc_prep, | 
 | 130 | 	.qc_issue		= pdc_qc_issue_prot, | 
 | 131 | 	.eng_timeout		= pdc_eng_timeout, | 
 | 132 | 	.irq_handler		= pdc_interrupt, | 
 | 133 | 	.irq_clear		= pdc_irq_clear, | 
| Jeff Garzik | 2cba582 | 2005-08-29 05:12:30 -0400 | [diff] [blame] | 134 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 135 | 	.scr_read		= pdc_sata_scr_read, | 
 | 136 | 	.scr_write		= pdc_sata_scr_write, | 
 | 137 | 	.port_start		= pdc_port_start, | 
 | 138 | 	.port_stop		= pdc_port_stop, | 
| Jeff Garzik | 374b187 | 2005-08-30 05:42:52 -0400 | [diff] [blame] | 139 | 	.host_stop		= ata_pci_host_stop, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 140 | }; | 
 | 141 |  | 
| Jeff Garzik | 057ace5 | 2005-10-22 14:27:05 -0400 | [diff] [blame] | 142 | static const struct ata_port_operations pdc_pata_ops = { | 
| Jeff Garzik | 2cba582 | 2005-08-29 05:12:30 -0400 | [diff] [blame] | 143 | 	.port_disable		= ata_port_disable, | 
 | 144 | 	.tf_load		= pdc_tf_load_mmio, | 
 | 145 | 	.tf_read		= ata_tf_read, | 
 | 146 | 	.check_status		= ata_check_status, | 
 | 147 | 	.exec_command		= pdc_exec_command_mmio, | 
 | 148 | 	.dev_select		= ata_std_dev_select, | 
 | 149 |  | 
 | 150 | 	.phy_reset		= pdc_pata_phy_reset, | 
 | 151 |  | 
 | 152 | 	.qc_prep		= pdc_qc_prep, | 
 | 153 | 	.qc_issue		= pdc_qc_issue_prot, | 
 | 154 | 	.eng_timeout		= pdc_eng_timeout, | 
 | 155 | 	.irq_handler		= pdc_interrupt, | 
 | 156 | 	.irq_clear		= pdc_irq_clear, | 
 | 157 |  | 
 | 158 | 	.port_start		= pdc_port_start, | 
 | 159 | 	.port_stop		= pdc_port_stop, | 
| Jeff Garzik | 374b187 | 2005-08-30 05:42:52 -0400 | [diff] [blame] | 160 | 	.host_stop		= ata_pci_host_stop, | 
| Jeff Garzik | 2cba582 | 2005-08-29 05:12:30 -0400 | [diff] [blame] | 161 | }; | 
 | 162 |  | 
| Arjan van de Ven | 98ac62d | 2005-11-28 10:06:23 +0100 | [diff] [blame] | 163 | static const struct ata_port_info pdc_port_info[] = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 164 | 	/* board_2037x */ | 
 | 165 | 	{ | 
 | 166 | 		.sht		= &pdc_ata_sht, | 
| Jeff Garzik | 5063019 | 2005-12-13 02:29:45 -0500 | [diff] [blame] | 167 | 		.host_flags	= PDC_COMMON_FLAGS | ATA_FLAG_SATA, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 168 | 		.pio_mask	= 0x1f, /* pio0-4 */ | 
 | 169 | 		.mwdma_mask	= 0x07, /* mwdma0-2 */ | 
 | 170 | 		.udma_mask	= 0x7f, /* udma0-6 ; FIXME */ | 
| Jeff Garzik | 2cba582 | 2005-08-29 05:12:30 -0400 | [diff] [blame] | 171 | 		.port_ops	= &pdc_sata_ops, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 172 | 	}, | 
 | 173 |  | 
 | 174 | 	/* board_20319 */ | 
 | 175 | 	{ | 
 | 176 | 		.sht		= &pdc_ata_sht, | 
| Jeff Garzik | 5063019 | 2005-12-13 02:29:45 -0500 | [diff] [blame] | 177 | 		.host_flags	= PDC_COMMON_FLAGS | ATA_FLAG_SATA, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 178 | 		.pio_mask	= 0x1f, /* pio0-4 */ | 
 | 179 | 		.mwdma_mask	= 0x07, /* mwdma0-2 */ | 
 | 180 | 		.udma_mask	= 0x7f, /* udma0-6 ; FIXME */ | 
| Jeff Garzik | 2cba582 | 2005-08-29 05:12:30 -0400 | [diff] [blame] | 181 | 		.port_ops	= &pdc_sata_ops, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 182 | 	}, | 
| Tobias Lorenz | f497ba7 | 2005-05-12 15:51:01 -0400 | [diff] [blame] | 183 |  | 
 | 184 | 	/* board_20619 */ | 
 | 185 | 	{ | 
 | 186 | 		.sht		= &pdc_ata_sht, | 
| Jeff Garzik | 5063019 | 2005-12-13 02:29:45 -0500 | [diff] [blame] | 187 | 		.host_flags	= PDC_COMMON_FLAGS | ATA_FLAG_SLAVE_POSS, | 
| Tobias Lorenz | f497ba7 | 2005-05-12 15:51:01 -0400 | [diff] [blame] | 188 | 		.pio_mask	= 0x1f, /* pio0-4 */ | 
 | 189 | 		.mwdma_mask	= 0x07, /* mwdma0-2 */ | 
 | 190 | 		.udma_mask	= 0x7f, /* udma0-6 ; FIXME */ | 
| Jeff Garzik | 2cba582 | 2005-08-29 05:12:30 -0400 | [diff] [blame] | 191 | 		.port_ops	= &pdc_pata_ops, | 
| Tobias Lorenz | f497ba7 | 2005-05-12 15:51:01 -0400 | [diff] [blame] | 192 | 	}, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 193 | }; | 
 | 194 |  | 
| Jeff Garzik | 3b7d697 | 2005-11-10 11:04:11 -0500 | [diff] [blame] | 195 | static const struct pci_device_id pdc_ata_pci_tbl[] = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 196 | 	{ PCI_VENDOR_ID_PROMISE, 0x3371, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 197 | 	  board_2037x }, | 
| Jeff Garzik | 07c1da2 | 2005-10-28 17:00:31 -0400 | [diff] [blame] | 198 | 	{ PCI_VENDOR_ID_PROMISE, 0x3570, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 199 | 	  board_2037x }, | 
| Francisco Javier | 4c3a53d | 2005-05-25 19:29:37 -0400 | [diff] [blame] | 200 | 	{ PCI_VENDOR_ID_PROMISE, 0x3571, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 201 | 	  board_2037x }, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 202 | 	{ PCI_VENDOR_ID_PROMISE, 0x3373, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 203 | 	  board_2037x }, | 
 | 204 | 	{ PCI_VENDOR_ID_PROMISE, 0x3375, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 205 | 	  board_2037x }, | 
 | 206 | 	{ PCI_VENDOR_ID_PROMISE, 0x3376, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 207 | 	  board_2037x }, | 
 | 208 | 	{ PCI_VENDOR_ID_PROMISE, 0x3574, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 209 | 	  board_2037x }, | 
 | 210 | 	{ PCI_VENDOR_ID_PROMISE, 0x3d75, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 211 | 	  board_2037x }, | 
| Ed Kear | c45154a | 2005-07-16 23:32:19 -0400 | [diff] [blame] | 212 | 	{ PCI_VENDOR_ID_PROMISE, 0x3d73, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 213 | 	  board_2037x }, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 214 |  | 
 | 215 | 	{ PCI_VENDOR_ID_PROMISE, 0x3318, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 216 | 	  board_20319 }, | 
 | 217 | 	{ PCI_VENDOR_ID_PROMISE, 0x3319, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 218 | 	  board_20319 }, | 
| Daniel Drake | 9309049 | 2005-08-22 14:59:23 +0100 | [diff] [blame] | 219 | 	{ PCI_VENDOR_ID_PROMISE, 0x3519, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 220 | 	  board_20319 }, | 
| Otto Meier | 08b791c | 2005-08-22 14:58:57 +0100 | [diff] [blame] | 221 | 	{ PCI_VENDOR_ID_PROMISE, 0x3d17, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 222 | 	  board_20319 }, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 223 | 	{ PCI_VENDOR_ID_PROMISE, 0x3d18, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 224 | 	  board_20319 }, | 
 | 225 |  | 
| Tobias Lorenz | f497ba7 | 2005-05-12 15:51:01 -0400 | [diff] [blame] | 226 | 	{ PCI_VENDOR_ID_PROMISE, 0x6629, PCI_ANY_ID, PCI_ANY_ID, 0, 0, | 
 | 227 | 	  board_20619 }, | 
 | 228 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 229 | 	{ }	/* terminate list */ | 
 | 230 | }; | 
 | 231 |  | 
 | 232 |  | 
 | 233 | static struct pci_driver pdc_ata_pci_driver = { | 
 | 234 | 	.name			= DRV_NAME, | 
 | 235 | 	.id_table		= pdc_ata_pci_tbl, | 
 | 236 | 	.probe			= pdc_ata_init_one, | 
 | 237 | 	.remove			= ata_pci_remove_one, | 
 | 238 | }; | 
 | 239 |  | 
 | 240 |  | 
 | 241 | static int pdc_port_start(struct ata_port *ap) | 
 | 242 | { | 
 | 243 | 	struct device *dev = ap->host_set->dev; | 
 | 244 | 	struct pdc_port_priv *pp; | 
 | 245 | 	int rc; | 
 | 246 |  | 
 | 247 | 	rc = ata_port_start(ap); | 
 | 248 | 	if (rc) | 
 | 249 | 		return rc; | 
 | 250 |  | 
 | 251 | 	pp = kmalloc(sizeof(*pp), GFP_KERNEL); | 
 | 252 | 	if (!pp) { | 
 | 253 | 		rc = -ENOMEM; | 
 | 254 | 		goto err_out; | 
 | 255 | 	} | 
 | 256 | 	memset(pp, 0, sizeof(*pp)); | 
 | 257 |  | 
 | 258 | 	pp->pkt = dma_alloc_coherent(dev, 128, &pp->pkt_dma, GFP_KERNEL); | 
 | 259 | 	if (!pp->pkt) { | 
 | 260 | 		rc = -ENOMEM; | 
 | 261 | 		goto err_out_kfree; | 
 | 262 | 	} | 
 | 263 |  | 
 | 264 | 	ap->private_data = pp; | 
 | 265 |  | 
 | 266 | 	return 0; | 
 | 267 |  | 
 | 268 | err_out_kfree: | 
 | 269 | 	kfree(pp); | 
 | 270 | err_out: | 
 | 271 | 	ata_port_stop(ap); | 
 | 272 | 	return rc; | 
 | 273 | } | 
 | 274 |  | 
 | 275 |  | 
 | 276 | static void pdc_port_stop(struct ata_port *ap) | 
 | 277 | { | 
 | 278 | 	struct device *dev = ap->host_set->dev; | 
 | 279 | 	struct pdc_port_priv *pp = ap->private_data; | 
 | 280 |  | 
 | 281 | 	ap->private_data = NULL; | 
 | 282 | 	dma_free_coherent(dev, 128, pp->pkt, pp->pkt_dma); | 
 | 283 | 	kfree(pp); | 
 | 284 | 	ata_port_stop(ap); | 
 | 285 | } | 
 | 286 |  | 
 | 287 |  | 
 | 288 | static void pdc_reset_port(struct ata_port *ap) | 
 | 289 | { | 
| Jeff Garzik | ea6ba10 | 2005-08-30 05:18:18 -0400 | [diff] [blame] | 290 | 	void __iomem *mmio = (void __iomem *) ap->ioaddr.cmd_addr + PDC_CTLSTAT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 291 | 	unsigned int i; | 
 | 292 | 	u32 tmp; | 
 | 293 |  | 
 | 294 | 	for (i = 11; i > 0; i--) { | 
 | 295 | 		tmp = readl(mmio); | 
 | 296 | 		if (tmp & PDC_RESET) | 
 | 297 | 			break; | 
 | 298 |  | 
 | 299 | 		udelay(100); | 
 | 300 |  | 
 | 301 | 		tmp |= PDC_RESET; | 
 | 302 | 		writel(tmp, mmio); | 
 | 303 | 	} | 
 | 304 |  | 
 | 305 | 	tmp &= ~PDC_RESET; | 
 | 306 | 	writel(tmp, mmio); | 
 | 307 | 	readl(mmio);	/* flush */ | 
 | 308 | } | 
 | 309 |  | 
| Jeff Garzik | 2cba582 | 2005-08-29 05:12:30 -0400 | [diff] [blame] | 310 | static void pdc_sata_phy_reset(struct ata_port *ap) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 311 | { | 
 | 312 | 	pdc_reset_port(ap); | 
 | 313 | 	sata_phy_reset(ap); | 
 | 314 | } | 
 | 315 |  | 
| Jeff Garzik | 2cba582 | 2005-08-29 05:12:30 -0400 | [diff] [blame] | 316 | static void pdc_pata_phy_reset(struct ata_port *ap) | 
 | 317 | { | 
 | 318 | 	/* FIXME: add cable detect.  Don't assume 40-pin cable */ | 
 | 319 | 	ap->cbl = ATA_CBL_PATA40; | 
 | 320 | 	ap->udma_mask &= ATA_UDMA_MASK_40C; | 
 | 321 |  | 
 | 322 | 	pdc_reset_port(ap); | 
 | 323 | 	ata_port_probe(ap); | 
 | 324 | 	ata_bus_reset(ap); | 
 | 325 | } | 
 | 326 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 327 | static u32 pdc_sata_scr_read (struct ata_port *ap, unsigned int sc_reg) | 
 | 328 | { | 
 | 329 | 	if (sc_reg > SCR_CONTROL) | 
 | 330 | 		return 0xffffffffU; | 
| Al Viro | b181d3b | 2005-10-21 06:46:02 +0100 | [diff] [blame] | 331 | 	return readl((void __iomem *) ap->ioaddr.scr_addr + (sc_reg * 4)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 332 | } | 
 | 333 |  | 
 | 334 |  | 
 | 335 | static void pdc_sata_scr_write (struct ata_port *ap, unsigned int sc_reg, | 
 | 336 | 			       u32 val) | 
 | 337 | { | 
 | 338 | 	if (sc_reg > SCR_CONTROL) | 
 | 339 | 		return; | 
| Al Viro | b181d3b | 2005-10-21 06:46:02 +0100 | [diff] [blame] | 340 | 	writel(val, (void __iomem *) ap->ioaddr.scr_addr + (sc_reg * 4)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 341 | } | 
 | 342 |  | 
 | 343 | static void pdc_qc_prep(struct ata_queued_cmd *qc) | 
 | 344 | { | 
 | 345 | 	struct pdc_port_priv *pp = qc->ap->private_data; | 
 | 346 | 	unsigned int i; | 
 | 347 |  | 
 | 348 | 	VPRINTK("ENTER\n"); | 
 | 349 |  | 
 | 350 | 	switch (qc->tf.protocol) { | 
 | 351 | 	case ATA_PROT_DMA: | 
 | 352 | 		ata_qc_prep(qc); | 
 | 353 | 		/* fall through */ | 
 | 354 |  | 
 | 355 | 	case ATA_PROT_NODATA: | 
 | 356 | 		i = pdc_pkt_header(&qc->tf, qc->ap->prd_dma, | 
 | 357 | 				   qc->dev->devno, pp->pkt); | 
 | 358 |  | 
 | 359 | 		if (qc->tf.flags & ATA_TFLAG_LBA48) | 
 | 360 | 			i = pdc_prep_lba48(&qc->tf, pp->pkt, i); | 
 | 361 | 		else | 
 | 362 | 			i = pdc_prep_lba28(&qc->tf, pp->pkt, i); | 
 | 363 |  | 
 | 364 | 		pdc_pkt_footer(&qc->tf, pp->pkt, i); | 
 | 365 | 		break; | 
 | 366 |  | 
 | 367 | 	default: | 
 | 368 | 		break; | 
 | 369 | 	} | 
 | 370 | } | 
 | 371 |  | 
 | 372 | static void pdc_eng_timeout(struct ata_port *ap) | 
 | 373 | { | 
| Jeff Garzik | b8f6153 | 2005-08-25 22:01:20 -0400 | [diff] [blame] | 374 | 	struct ata_host_set *host_set = ap->host_set; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 375 | 	u8 drv_stat; | 
 | 376 | 	struct ata_queued_cmd *qc; | 
| Jeff Garzik | b8f6153 | 2005-08-25 22:01:20 -0400 | [diff] [blame] | 377 | 	unsigned long flags; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 378 |  | 
 | 379 | 	DPRINTK("ENTER\n"); | 
 | 380 |  | 
| Jeff Garzik | b8f6153 | 2005-08-25 22:01:20 -0400 | [diff] [blame] | 381 | 	spin_lock_irqsave(&host_set->lock, flags); | 
 | 382 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 383 | 	qc = ata_qc_from_tag(ap, ap->active_tag); | 
 | 384 | 	if (!qc) { | 
 | 385 | 		printk(KERN_ERR "ata%u: BUG: timeout without command\n", | 
 | 386 | 		       ap->id); | 
 | 387 | 		goto out; | 
 | 388 | 	} | 
 | 389 |  | 
 | 390 | 	/* hack alert!  We cannot use the supplied completion | 
 | 391 | 	 * function from inside the ->eh_strategy_handler() thread. | 
 | 392 | 	 * libata is the only user of ->eh_strategy_handler() in | 
 | 393 | 	 * any kernel, so the default scsi_done() assumes it is | 
 | 394 | 	 * not being called from the SCSI EH. | 
 | 395 | 	 */ | 
 | 396 | 	qc->scsidone = scsi_finish_command; | 
 | 397 |  | 
 | 398 | 	switch (qc->tf.protocol) { | 
 | 399 | 	case ATA_PROT_DMA: | 
 | 400 | 	case ATA_PROT_NODATA: | 
 | 401 | 		printk(KERN_ERR "ata%u: command timeout\n", ap->id); | 
| Jeff Garzik | a7dac44 | 2005-10-30 04:44:42 -0500 | [diff] [blame] | 402 | 		drv_stat = ata_wait_idle(ap); | 
| Albert Lee | a22e2eb | 2005-12-05 15:38:02 +0800 | [diff] [blame] | 403 | 		qc->err_mask |= __ac_err_mask(drv_stat); | 
 | 404 | 		ata_qc_complete(qc); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 405 | 		break; | 
 | 406 |  | 
 | 407 | 	default: | 
 | 408 | 		drv_stat = ata_busy_wait(ap, ATA_BUSY | ATA_DRQ, 1000); | 
 | 409 |  | 
 | 410 | 		printk(KERN_ERR "ata%u: unknown timeout, cmd 0x%x stat 0x%x\n", | 
 | 411 | 		       ap->id, qc->tf.command, drv_stat); | 
 | 412 |  | 
| Albert Lee | a22e2eb | 2005-12-05 15:38:02 +0800 | [diff] [blame] | 413 | 		qc->err_mask |= ac_err_mask(drv_stat); | 
 | 414 | 		ata_qc_complete(qc); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 415 | 		break; | 
 | 416 | 	} | 
 | 417 |  | 
 | 418 | out: | 
| Jeff Garzik | b8f6153 | 2005-08-25 22:01:20 -0400 | [diff] [blame] | 419 | 	spin_unlock_irqrestore(&host_set->lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 420 | 	DPRINTK("EXIT\n"); | 
 | 421 | } | 
 | 422 |  | 
 | 423 | static inline unsigned int pdc_host_intr( struct ata_port *ap, | 
 | 424 |                                           struct ata_queued_cmd *qc) | 
 | 425 | { | 
| Albert Lee | a22e2eb | 2005-12-05 15:38:02 +0800 | [diff] [blame] | 426 | 	unsigned int handled = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 427 | 	u32 tmp; | 
| Jeff Garzik | ea6ba10 | 2005-08-30 05:18:18 -0400 | [diff] [blame] | 428 | 	void __iomem *mmio = (void __iomem *) ap->ioaddr.cmd_addr + PDC_GLOBAL_CTL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 429 |  | 
 | 430 | 	tmp = readl(mmio); | 
 | 431 | 	if (tmp & PDC_ERR_MASK) { | 
| Albert Lee | a22e2eb | 2005-12-05 15:38:02 +0800 | [diff] [blame] | 432 | 		qc->err_mask |= AC_ERR_DEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 433 | 		pdc_reset_port(ap); | 
 | 434 | 	} | 
 | 435 |  | 
 | 436 | 	switch (qc->tf.protocol) { | 
 | 437 | 	case ATA_PROT_DMA: | 
 | 438 | 	case ATA_PROT_NODATA: | 
| Albert Lee | a22e2eb | 2005-12-05 15:38:02 +0800 | [diff] [blame] | 439 | 		qc->err_mask |= ac_err_mask(ata_wait_idle(ap)); | 
 | 440 | 		ata_qc_complete(qc); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 441 | 		handled = 1; | 
 | 442 | 		break; | 
 | 443 |  | 
 | 444 |         default: | 
| Albert Lee | ee500aa | 2005-09-27 17:34:38 +0800 | [diff] [blame] | 445 | 		ap->stats.idle_irq++; | 
 | 446 | 		break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 447 |         } | 
 | 448 |  | 
| Albert Lee | ee500aa | 2005-09-27 17:34:38 +0800 | [diff] [blame] | 449 | 	return handled; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 450 | } | 
 | 451 |  | 
 | 452 | static void pdc_irq_clear(struct ata_port *ap) | 
 | 453 | { | 
 | 454 | 	struct ata_host_set *host_set = ap->host_set; | 
| Jeff Garzik | ea6ba10 | 2005-08-30 05:18:18 -0400 | [diff] [blame] | 455 | 	void __iomem *mmio = host_set->mmio_base; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 456 |  | 
 | 457 | 	readl(mmio + PDC_INT_SEQMASK); | 
 | 458 | } | 
 | 459 |  | 
 | 460 | static irqreturn_t pdc_interrupt (int irq, void *dev_instance, struct pt_regs *regs) | 
 | 461 | { | 
 | 462 | 	struct ata_host_set *host_set = dev_instance; | 
 | 463 | 	struct ata_port *ap; | 
 | 464 | 	u32 mask = 0; | 
 | 465 | 	unsigned int i, tmp; | 
 | 466 | 	unsigned int handled = 0; | 
| Jeff Garzik | ea6ba10 | 2005-08-30 05:18:18 -0400 | [diff] [blame] | 467 | 	void __iomem *mmio_base; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 468 |  | 
 | 469 | 	VPRINTK("ENTER\n"); | 
 | 470 |  | 
 | 471 | 	if (!host_set || !host_set->mmio_base) { | 
 | 472 | 		VPRINTK("QUICK EXIT\n"); | 
 | 473 | 		return IRQ_NONE; | 
 | 474 | 	} | 
 | 475 |  | 
 | 476 | 	mmio_base = host_set->mmio_base; | 
 | 477 |  | 
 | 478 | 	/* reading should also clear interrupts */ | 
 | 479 | 	mask = readl(mmio_base + PDC_INT_SEQMASK); | 
 | 480 |  | 
 | 481 | 	if (mask == 0xffffffff) { | 
 | 482 | 		VPRINTK("QUICK EXIT 2\n"); | 
 | 483 | 		return IRQ_NONE; | 
 | 484 | 	} | 
 | 485 | 	mask &= 0xffff;		/* only 16 tags possible */ | 
 | 486 | 	if (!mask) { | 
 | 487 | 		VPRINTK("QUICK EXIT 3\n"); | 
 | 488 | 		return IRQ_NONE; | 
 | 489 | 	} | 
 | 490 |  | 
 | 491 | 	spin_lock(&host_set->lock); | 
 | 492 |  | 
 | 493 | 	writel(mask, mmio_base + PDC_INT_SEQMASK); | 
 | 494 |  | 
 | 495 | 	for (i = 0; i < host_set->n_ports; i++) { | 
 | 496 | 		VPRINTK("port %u\n", i); | 
 | 497 | 		ap = host_set->ports[i]; | 
 | 498 | 		tmp = mask & (1 << (i + 1)); | 
| Tejun Heo | c138950 | 2005-08-22 14:59:24 +0900 | [diff] [blame] | 499 | 		if (tmp && ap && | 
 | 500 | 		    !(ap->flags & (ATA_FLAG_PORT_DISABLED | ATA_FLAG_NOINTR))) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 501 | 			struct ata_queued_cmd *qc; | 
 | 502 |  | 
 | 503 | 			qc = ata_qc_from_tag(ap, ap->active_tag); | 
 | 504 | 			if (qc && (!(qc->tf.ctl & ATA_NIEN))) | 
 | 505 | 				handled += pdc_host_intr(ap, qc); | 
 | 506 | 		} | 
 | 507 | 	} | 
 | 508 |  | 
 | 509 |         spin_unlock(&host_set->lock); | 
 | 510 |  | 
 | 511 | 	VPRINTK("EXIT\n"); | 
 | 512 |  | 
 | 513 | 	return IRQ_RETVAL(handled); | 
 | 514 | } | 
 | 515 |  | 
 | 516 | static inline void pdc_packet_start(struct ata_queued_cmd *qc) | 
 | 517 | { | 
 | 518 | 	struct ata_port *ap = qc->ap; | 
 | 519 | 	struct pdc_port_priv *pp = ap->private_data; | 
 | 520 | 	unsigned int port_no = ap->port_no; | 
 | 521 | 	u8 seq = (u8) (port_no + 1); | 
 | 522 |  | 
 | 523 | 	VPRINTK("ENTER, ap %p\n", ap); | 
 | 524 |  | 
 | 525 | 	writel(0x00000001, ap->host_set->mmio_base + (seq * 4)); | 
 | 526 | 	readl(ap->host_set->mmio_base + (seq * 4));	/* flush */ | 
 | 527 |  | 
 | 528 | 	pp->pkt[2] = seq; | 
 | 529 | 	wmb();			/* flush PRD, pkt writes */ | 
| Al Viro | b181d3b | 2005-10-21 06:46:02 +0100 | [diff] [blame] | 530 | 	writel(pp->pkt_dma, (void __iomem *) ap->ioaddr.cmd_addr + PDC_PKT_SUBMIT); | 
 | 531 | 	readl((void __iomem *) ap->ioaddr.cmd_addr + PDC_PKT_SUBMIT); /* flush */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 532 | } | 
 | 533 |  | 
 | 534 | static int pdc_qc_issue_prot(struct ata_queued_cmd *qc) | 
 | 535 | { | 
 | 536 | 	switch (qc->tf.protocol) { | 
 | 537 | 	case ATA_PROT_DMA: | 
 | 538 | 	case ATA_PROT_NODATA: | 
 | 539 | 		pdc_packet_start(qc); | 
 | 540 | 		return 0; | 
 | 541 |  | 
 | 542 | 	case ATA_PROT_ATAPI_DMA: | 
 | 543 | 		BUG(); | 
 | 544 | 		break; | 
 | 545 |  | 
 | 546 | 	default: | 
 | 547 | 		break; | 
 | 548 | 	} | 
 | 549 |  | 
 | 550 | 	return ata_qc_issue_prot(qc); | 
 | 551 | } | 
 | 552 |  | 
| Jeff Garzik | 057ace5 | 2005-10-22 14:27:05 -0400 | [diff] [blame] | 553 | static void pdc_tf_load_mmio(struct ata_port *ap, const struct ata_taskfile *tf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 554 | { | 
 | 555 | 	WARN_ON (tf->protocol == ATA_PROT_DMA || | 
 | 556 | 		 tf->protocol == ATA_PROT_NODATA); | 
 | 557 | 	ata_tf_load(ap, tf); | 
 | 558 | } | 
 | 559 |  | 
 | 560 |  | 
| Jeff Garzik | 057ace5 | 2005-10-22 14:27:05 -0400 | [diff] [blame] | 561 | static void pdc_exec_command_mmio(struct ata_port *ap, const struct ata_taskfile *tf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 562 | { | 
 | 563 | 	WARN_ON (tf->protocol == ATA_PROT_DMA || | 
 | 564 | 		 tf->protocol == ATA_PROT_NODATA); | 
 | 565 | 	ata_exec_command(ap, tf); | 
 | 566 | } | 
 | 567 |  | 
 | 568 |  | 
 | 569 | static void pdc_ata_setup_port(struct ata_ioports *port, unsigned long base) | 
 | 570 | { | 
 | 571 | 	port->cmd_addr		= base; | 
 | 572 | 	port->data_addr		= base; | 
 | 573 | 	port->feature_addr	= | 
 | 574 | 	port->error_addr	= base + 0x4; | 
 | 575 | 	port->nsect_addr	= base + 0x8; | 
 | 576 | 	port->lbal_addr		= base + 0xc; | 
 | 577 | 	port->lbam_addr		= base + 0x10; | 
 | 578 | 	port->lbah_addr		= base + 0x14; | 
 | 579 | 	port->device_addr	= base + 0x18; | 
 | 580 | 	port->command_addr	= | 
 | 581 | 	port->status_addr	= base + 0x1c; | 
 | 582 | 	port->altstatus_addr	= | 
 | 583 | 	port->ctl_addr		= base + 0x38; | 
 | 584 | } | 
 | 585 |  | 
 | 586 |  | 
 | 587 | static void pdc_host_init(unsigned int chip_id, struct ata_probe_ent *pe) | 
 | 588 | { | 
| Jeff Garzik | ea6ba10 | 2005-08-30 05:18:18 -0400 | [diff] [blame] | 589 | 	void __iomem *mmio = pe->mmio_base; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 590 | 	u32 tmp; | 
 | 591 |  | 
 | 592 | 	/* | 
 | 593 | 	 * Except for the hotplug stuff, this is voodoo from the | 
 | 594 | 	 * Promise driver.  Label this entire section | 
 | 595 | 	 * "TODO: figure out why we do this" | 
 | 596 | 	 */ | 
 | 597 |  | 
 | 598 | 	/* change FIFO_SHD to 8 dwords, enable BMR_BURST */ | 
 | 599 | 	tmp = readl(mmio + PDC_FLASH_CTL); | 
 | 600 | 	tmp |= 0x12000;	/* bit 16 (fifo 8 dw) and 13 (bmr burst?) */ | 
 | 601 | 	writel(tmp, mmio + PDC_FLASH_CTL); | 
 | 602 |  | 
 | 603 | 	/* clear plug/unplug flags for all ports */ | 
 | 604 | 	tmp = readl(mmio + PDC_SATA_PLUG_CSR); | 
 | 605 | 	writel(tmp | 0xff, mmio + PDC_SATA_PLUG_CSR); | 
 | 606 |  | 
 | 607 | 	/* mask plug/unplug ints */ | 
 | 608 | 	tmp = readl(mmio + PDC_SATA_PLUG_CSR); | 
 | 609 | 	writel(tmp | 0xff0000, mmio + PDC_SATA_PLUG_CSR); | 
 | 610 |  | 
 | 611 | 	/* reduce TBG clock to 133 Mhz. */ | 
 | 612 | 	tmp = readl(mmio + PDC_TBG_MODE); | 
 | 613 | 	tmp &= ~0x30000; /* clear bit 17, 16*/ | 
 | 614 | 	tmp |= 0x10000;  /* set bit 17:16 = 0:1 */ | 
 | 615 | 	writel(tmp, mmio + PDC_TBG_MODE); | 
 | 616 |  | 
 | 617 | 	readl(mmio + PDC_TBG_MODE);	/* flush */ | 
 | 618 | 	msleep(10); | 
 | 619 |  | 
 | 620 | 	/* adjust slew rate control register. */ | 
 | 621 | 	tmp = readl(mmio + PDC_SLEW_CTL); | 
 | 622 | 	tmp &= 0xFFFFF03F; /* clear bit 11 ~ 6 */ | 
 | 623 | 	tmp  |= 0x00000900; /* set bit 11-9 = 100b , bit 8-6 = 100 */ | 
 | 624 | 	writel(tmp, mmio + PDC_SLEW_CTL); | 
 | 625 | } | 
 | 626 |  | 
 | 627 | static int pdc_ata_init_one (struct pci_dev *pdev, const struct pci_device_id *ent) | 
 | 628 | { | 
 | 629 | 	static int printed_version; | 
 | 630 | 	struct ata_probe_ent *probe_ent = NULL; | 
 | 631 | 	unsigned long base; | 
| Jeff Garzik | ea6ba10 | 2005-08-30 05:18:18 -0400 | [diff] [blame] | 632 | 	void __iomem *mmio_base; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 633 | 	unsigned int board_idx = (unsigned int) ent->driver_data; | 
 | 634 | 	int pci_dev_busy = 0; | 
 | 635 | 	int rc; | 
 | 636 |  | 
 | 637 | 	if (!printed_version++) | 
| Jeff Garzik | a9524a7 | 2005-10-30 14:39:11 -0500 | [diff] [blame] | 638 | 		dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 639 |  | 
 | 640 | 	/* | 
 | 641 | 	 * If this driver happens to only be useful on Apple's K2, then | 
 | 642 | 	 * we should check that here as it has a normal Serverworks ID | 
 | 643 | 	 */ | 
 | 644 | 	rc = pci_enable_device(pdev); | 
 | 645 | 	if (rc) | 
 | 646 | 		return rc; | 
 | 647 |  | 
 | 648 | 	rc = pci_request_regions(pdev, DRV_NAME); | 
 | 649 | 	if (rc) { | 
 | 650 | 		pci_dev_busy = 1; | 
 | 651 | 		goto err_out; | 
 | 652 | 	} | 
 | 653 |  | 
 | 654 | 	rc = pci_set_dma_mask(pdev, ATA_DMA_MASK); | 
 | 655 | 	if (rc) | 
 | 656 | 		goto err_out_regions; | 
 | 657 | 	rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK); | 
 | 658 | 	if (rc) | 
 | 659 | 		goto err_out_regions; | 
 | 660 |  | 
 | 661 | 	probe_ent = kmalloc(sizeof(*probe_ent), GFP_KERNEL); | 
 | 662 | 	if (probe_ent == NULL) { | 
 | 663 | 		rc = -ENOMEM; | 
 | 664 | 		goto err_out_regions; | 
 | 665 | 	} | 
 | 666 |  | 
 | 667 | 	memset(probe_ent, 0, sizeof(*probe_ent)); | 
 | 668 | 	probe_ent->dev = pci_dev_to_dev(pdev); | 
 | 669 | 	INIT_LIST_HEAD(&probe_ent->node); | 
 | 670 |  | 
| Jeff Garzik | 374b187 | 2005-08-30 05:42:52 -0400 | [diff] [blame] | 671 | 	mmio_base = pci_iomap(pdev, 3, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 672 | 	if (mmio_base == NULL) { | 
 | 673 | 		rc = -ENOMEM; | 
 | 674 | 		goto err_out_free_ent; | 
 | 675 | 	} | 
 | 676 | 	base = (unsigned long) mmio_base; | 
 | 677 |  | 
 | 678 | 	probe_ent->sht		= pdc_port_info[board_idx].sht; | 
 | 679 | 	probe_ent->host_flags	= pdc_port_info[board_idx].host_flags; | 
 | 680 | 	probe_ent->pio_mask	= pdc_port_info[board_idx].pio_mask; | 
 | 681 | 	probe_ent->mwdma_mask	= pdc_port_info[board_idx].mwdma_mask; | 
 | 682 | 	probe_ent->udma_mask	= pdc_port_info[board_idx].udma_mask; | 
 | 683 | 	probe_ent->port_ops	= pdc_port_info[board_idx].port_ops; | 
 | 684 |  | 
 | 685 |        	probe_ent->irq = pdev->irq; | 
 | 686 |        	probe_ent->irq_flags = SA_SHIRQ; | 
 | 687 | 	probe_ent->mmio_base = mmio_base; | 
 | 688 |  | 
 | 689 | 	pdc_ata_setup_port(&probe_ent->port[0], base + 0x200); | 
 | 690 | 	pdc_ata_setup_port(&probe_ent->port[1], base + 0x280); | 
 | 691 |  | 
 | 692 | 	probe_ent->port[0].scr_addr = base + 0x400; | 
 | 693 | 	probe_ent->port[1].scr_addr = base + 0x500; | 
 | 694 |  | 
 | 695 | 	/* notice 4-port boards */ | 
 | 696 | 	switch (board_idx) { | 
 | 697 | 	case board_20319: | 
 | 698 |        		probe_ent->n_ports = 4; | 
 | 699 |  | 
 | 700 | 		pdc_ata_setup_port(&probe_ent->port[2], base + 0x300); | 
 | 701 | 		pdc_ata_setup_port(&probe_ent->port[3], base + 0x380); | 
 | 702 |  | 
 | 703 | 		probe_ent->port[2].scr_addr = base + 0x600; | 
 | 704 | 		probe_ent->port[3].scr_addr = base + 0x700; | 
 | 705 | 		break; | 
 | 706 | 	case board_2037x: | 
| Jeff Garzik | 6c9e5eb | 2005-11-30 16:42:55 -0500 | [diff] [blame] | 707 | 		probe_ent->n_ports = 2; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 708 | 		break; | 
| Tobias Lorenz | f497ba7 | 2005-05-12 15:51:01 -0400 | [diff] [blame] | 709 | 	case board_20619: | 
 | 710 | 		probe_ent->n_ports = 4; | 
 | 711 |  | 
 | 712 | 		pdc_ata_setup_port(&probe_ent->port[2], base + 0x300); | 
 | 713 | 		pdc_ata_setup_port(&probe_ent->port[3], base + 0x380); | 
 | 714 |  | 
 | 715 | 		probe_ent->port[2].scr_addr = base + 0x600; | 
 | 716 | 		probe_ent->port[3].scr_addr = base + 0x700; | 
| Jeff Garzik | 6c9e5eb | 2005-11-30 16:42:55 -0500 | [diff] [blame] | 717 | 		break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 718 | 	default: | 
 | 719 | 		BUG(); | 
 | 720 | 		break; | 
 | 721 | 	} | 
 | 722 |  | 
 | 723 | 	pci_set_master(pdev); | 
 | 724 |  | 
 | 725 | 	/* initialize adapter */ | 
 | 726 | 	pdc_host_init(board_idx, probe_ent); | 
 | 727 |  | 
 | 728 | 	/* FIXME: check ata_device_add return value */ | 
 | 729 | 	ata_device_add(probe_ent); | 
 | 730 | 	kfree(probe_ent); | 
 | 731 |  | 
 | 732 | 	return 0; | 
 | 733 |  | 
 | 734 | err_out_free_ent: | 
 | 735 | 	kfree(probe_ent); | 
 | 736 | err_out_regions: | 
 | 737 | 	pci_release_regions(pdev); | 
 | 738 | err_out: | 
 | 739 | 	if (!pci_dev_busy) | 
 | 740 | 		pci_disable_device(pdev); | 
 | 741 | 	return rc; | 
 | 742 | } | 
 | 743 |  | 
 | 744 |  | 
 | 745 | static int __init pdc_ata_init(void) | 
 | 746 | { | 
 | 747 | 	return pci_module_init(&pdc_ata_pci_driver); | 
 | 748 | } | 
 | 749 |  | 
 | 750 |  | 
 | 751 | static void __exit pdc_ata_exit(void) | 
 | 752 | { | 
 | 753 | 	pci_unregister_driver(&pdc_ata_pci_driver); | 
 | 754 | } | 
 | 755 |  | 
 | 756 |  | 
 | 757 | MODULE_AUTHOR("Jeff Garzik"); | 
| Tobias Lorenz | f497ba7 | 2005-05-12 15:51:01 -0400 | [diff] [blame] | 758 | MODULE_DESCRIPTION("Promise ATA TX2/TX4/TX4000 low-level driver"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 759 | MODULE_LICENSE("GPL"); | 
 | 760 | MODULE_DEVICE_TABLE(pci, pdc_ata_pci_tbl); | 
 | 761 | MODULE_VERSION(DRV_VERSION); | 
 | 762 |  | 
 | 763 | module_init(pdc_ata_init); | 
 | 764 | module_exit(pdc_ata_exit); |