Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 1 | /* |
Jeff Garzik | a0fcdc0 | 2007-03-09 07:24:15 -0500 | [diff] [blame] | 2 | * pata_serverworks.c - Serverworks PATA for new ATA layer |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 3 | * (C) 2005 Red Hat Inc |
| 4 | * Alan Cox <alan@redhat.com> |
| 5 | * |
| 6 | * based upon |
| 7 | * |
| 8 | * serverworks.c |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 9 | * |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 10 | * Copyright (C) 1998-2000 Michel Aubry |
| 11 | * Copyright (C) 1998-2000 Andrzej Krzysztofowicz |
| 12 | * Copyright (C) 1998-2000 Andre Hedrick <andre@linux-ide.org> |
| 13 | * Portions copyright (c) 2001 Sun Microsystems |
| 14 | * |
| 15 | * |
| 16 | * RCC/ServerWorks IDE driver for Linux |
| 17 | * |
| 18 | * OSB4: `Open South Bridge' IDE Interface (fn 1) |
| 19 | * supports UDMA mode 2 (33 MB/s) |
| 20 | * |
| 21 | * CSB5: `Champion South Bridge' IDE Interface (fn 1) |
| 22 | * all revisions support UDMA mode 4 (66 MB/s) |
| 23 | * revision A2.0 and up support UDMA mode 5 (100 MB/s) |
| 24 | * |
| 25 | * *** The CSB5 does not provide ANY register *** |
| 26 | * *** to detect 80-conductor cable presence. *** |
| 27 | * |
| 28 | * CSB6: `Champion South Bridge' IDE Interface (optional: third channel) |
| 29 | * |
| 30 | * Documentation: |
| 31 | * Available under NDA only. Errata info very hard to get. |
| 32 | */ |
| 33 | |
| 34 | #include <linux/kernel.h> |
| 35 | #include <linux/module.h> |
| 36 | #include <linux/pci.h> |
| 37 | #include <linux/init.h> |
| 38 | #include <linux/blkdev.h> |
| 39 | #include <linux/delay.h> |
| 40 | #include <scsi/scsi_host.h> |
| 41 | #include <linux/libata.h> |
| 42 | |
| 43 | #define DRV_NAME "pata_serverworks" |
Alan Cox | 0f06978 | 2008-01-19 15:52:56 +0000 | [diff] [blame] | 44 | #define DRV_VERSION "0.4.3" |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 45 | |
| 46 | #define SVWKS_CSB5_REVISION_NEW 0x92 /* min PCI_REVISION_ID for UDMA5 (A2.0) */ |
| 47 | #define SVWKS_CSB6_REVISION 0xa0 /* min PCI_REVISION_ID for UDMA4 (A1.0) */ |
| 48 | |
| 49 | /* Seagate Barracuda ATA IV Family drives in UDMA mode 5 |
| 50 | * can overrun their FIFOs when used with the CSB5 */ |
| 51 | |
| 52 | static const char *csb_bad_ata100[] = { |
| 53 | "ST320011A", |
| 54 | "ST340016A", |
| 55 | "ST360021A", |
| 56 | "ST380021A", |
| 57 | NULL |
| 58 | }; |
| 59 | |
| 60 | /** |
| 61 | * dell_cable - Dell serverworks cable detection |
| 62 | * @ap: ATA port to do cable detect |
| 63 | * |
| 64 | * Dell hide the 40/80 pin select for their interfaces in the top two |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 65 | * bits of the subsystem ID. |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 66 | */ |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 67 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 68 | static int dell_cable(struct ata_port *ap) { |
| 69 | struct pci_dev *pdev = to_pci_dev(ap->host->dev); |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 70 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 71 | if (pdev->subsystem_device & (1 << (ap->port_no + 14))) |
| 72 | return ATA_CBL_PATA80; |
| 73 | return ATA_CBL_PATA40; |
| 74 | } |
| 75 | |
| 76 | /** |
| 77 | * sun_cable - Sun Cobalt 'Alpine' cable detection |
| 78 | * @ap: ATA port to do cable select |
| 79 | * |
| 80 | * Cobalt CSB5 IDE hides the 40/80pin in the top two bits of the |
| 81 | * subsystem ID the same as dell. We could use one function but we may |
| 82 | * need to extend the Dell one in future |
| 83 | */ |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 84 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 85 | static int sun_cable(struct ata_port *ap) { |
| 86 | struct pci_dev *pdev = to_pci_dev(ap->host->dev); |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 87 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 88 | if (pdev->subsystem_device & (1 << (ap->port_no + 14))) |
| 89 | return ATA_CBL_PATA80; |
| 90 | return ATA_CBL_PATA40; |
| 91 | } |
| 92 | |
| 93 | /** |
| 94 | * osb4_cable - OSB4 cable detect |
| 95 | * @ap: ATA port to check |
| 96 | * |
| 97 | * The OSB4 isn't UDMA66 capable so this is easy |
| 98 | */ |
| 99 | |
| 100 | static int osb4_cable(struct ata_port *ap) { |
| 101 | return ATA_CBL_PATA40; |
| 102 | } |
| 103 | |
| 104 | /** |
Alan Cox | 0f06978 | 2008-01-19 15:52:56 +0000 | [diff] [blame] | 105 | * csb_cable - CSB5/6 cable detect |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 106 | * @ap: ATA port to check |
| 107 | * |
| 108 | * Serverworks default arrangement is to use the drive side detection |
| 109 | * only. |
| 110 | */ |
| 111 | |
| 112 | static int csb_cable(struct ata_port *ap) { |
Alan Cox | 0f06978 | 2008-01-19 15:52:56 +0000 | [diff] [blame] | 113 | return ATA_CBL_PATA_UNK; |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 114 | } |
| 115 | |
| 116 | struct sv_cable_table { |
| 117 | int device; |
| 118 | int subvendor; |
| 119 | int (*cable_detect)(struct ata_port *ap); |
| 120 | }; |
| 121 | |
| 122 | /* |
| 123 | * Note that we don't copy the old serverworks code because the old |
| 124 | * code contains obvious mistakes |
| 125 | */ |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 126 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 127 | static struct sv_cable_table cable_detect[] = { |
| 128 | { PCI_DEVICE_ID_SERVERWORKS_CSB5IDE, PCI_VENDOR_ID_DELL, dell_cable }, |
| 129 | { PCI_DEVICE_ID_SERVERWORKS_CSB6IDE, PCI_VENDOR_ID_DELL, dell_cable }, |
| 130 | { PCI_DEVICE_ID_SERVERWORKS_CSB5IDE, PCI_VENDOR_ID_SUN, sun_cable }, |
Alan Cox | 68d0d7a | 2006-09-26 22:24:31 +0100 | [diff] [blame] | 131 | { PCI_DEVICE_ID_SERVERWORKS_OSB4IDE, PCI_ANY_ID, osb4_cable }, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 132 | { PCI_DEVICE_ID_SERVERWORKS_CSB5IDE, PCI_ANY_ID, csb_cable }, |
| 133 | { PCI_DEVICE_ID_SERVERWORKS_CSB6IDE, PCI_ANY_ID, csb_cable }, |
| 134 | { PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2, PCI_ANY_ID, csb_cable }, |
| 135 | { PCI_DEVICE_ID_SERVERWORKS_HT1000IDE, PCI_ANY_ID, csb_cable }, |
| 136 | { } |
| 137 | }; |
| 138 | |
| 139 | /** |
Jeff Garzik | a0fcdc0 | 2007-03-09 07:24:15 -0500 | [diff] [blame] | 140 | * serverworks_cable_detect - cable detection |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 141 | * @ap: ATA port |
Tejun Heo | d4b2bab | 2007-02-02 16:50:52 +0900 | [diff] [blame] | 142 | * @deadline: deadline jiffies for the operation |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 143 | * |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 144 | * Perform cable detection according to the device and subvendor |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 145 | * identifications |
| 146 | */ |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 147 | |
Tejun Heo | d4b2bab | 2007-02-02 16:50:52 +0900 | [diff] [blame] | 148 | static int serverworks_cable_detect(struct ata_port *ap) |
| 149 | { |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 150 | struct pci_dev *pdev = to_pci_dev(ap->host->dev); |
| 151 | struct sv_cable_table *cb = cable_detect; |
| 152 | |
| 153 | while(cb->device) { |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 154 | if (cb->device == pdev->device && |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 155 | (cb->subvendor == pdev->subsystem_vendor || |
| 156 | cb->subvendor == PCI_ANY_ID)) { |
Jeff Garzik | a0fcdc0 | 2007-03-09 07:24:15 -0500 | [diff] [blame] | 157 | return cb->cable_detect(ap); |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 158 | } |
| 159 | cb++; |
| 160 | } |
| 161 | |
| 162 | BUG(); |
| 163 | return -1; /* kill compiler warning */ |
| 164 | } |
| 165 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 166 | /** |
| 167 | * serverworks_is_csb - Check for CSB or OSB |
| 168 | * @pdev: PCI device to check |
| 169 | * |
| 170 | * Returns true if the device being checked is known to be a CSB |
| 171 | * series device. |
| 172 | */ |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 173 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 174 | static u8 serverworks_is_csb(struct pci_dev *pdev) |
| 175 | { |
| 176 | switch (pdev->device) { |
| 177 | case PCI_DEVICE_ID_SERVERWORKS_CSB5IDE: |
| 178 | case PCI_DEVICE_ID_SERVERWORKS_CSB6IDE: |
| 179 | case PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2: |
| 180 | case PCI_DEVICE_ID_SERVERWORKS_HT1000IDE: |
| 181 | return 1; |
| 182 | default: |
| 183 | break; |
| 184 | } |
| 185 | return 0; |
| 186 | } |
| 187 | |
| 188 | /** |
| 189 | * serverworks_osb4_filter - mode selection filter |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 190 | * @adev: ATA device |
Alan Cox | a76b62c | 2007-03-09 09:34:07 -0500 | [diff] [blame] | 191 | * @mask: Mask of proposed modes |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 192 | * |
| 193 | * Filter the offered modes for the device to apply controller |
| 194 | * specific rules. OSB4 requires no UDMA for disks due to a FIFO |
| 195 | * bug we hit. |
| 196 | */ |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 197 | |
Alan Cox | a76b62c | 2007-03-09 09:34:07 -0500 | [diff] [blame] | 198 | static unsigned long serverworks_osb4_filter(struct ata_device *adev, unsigned long mask) |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 199 | { |
| 200 | if (adev->class == ATA_DEV_ATA) |
| 201 | mask &= ~ATA_MASK_UDMA; |
Alan Cox | a76b62c | 2007-03-09 09:34:07 -0500 | [diff] [blame] | 202 | return ata_pci_default_filter(adev, mask); |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 203 | } |
| 204 | |
| 205 | |
| 206 | /** |
| 207 | * serverworks_csb_filter - mode selection filter |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 208 | * @adev: ATA device |
Alan Cox | a76b62c | 2007-03-09 09:34:07 -0500 | [diff] [blame] | 209 | * @mask: Mask of proposed modes |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 210 | * |
| 211 | * Check the blacklist and disable UDMA5 if matched |
| 212 | */ |
| 213 | |
Alan Cox | a76b62c | 2007-03-09 09:34:07 -0500 | [diff] [blame] | 214 | static unsigned long serverworks_csb_filter(struct ata_device *adev, unsigned long mask) |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 215 | { |
| 216 | const char *p; |
Tejun Heo | 8bfa79f | 2007-01-02 20:19:40 +0900 | [diff] [blame] | 217 | char model_num[ATA_ID_PROD_LEN + 1]; |
| 218 | int i; |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 219 | |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 220 | /* Disk, UDMA */ |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 221 | if (adev->class != ATA_DEV_ATA) |
Alan Cox | a76b62c | 2007-03-09 09:34:07 -0500 | [diff] [blame] | 222 | return ata_pci_default_filter(adev, mask); |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 223 | |
| 224 | /* Actually do need to check */ |
Tejun Heo | 8bfa79f | 2007-01-02 20:19:40 +0900 | [diff] [blame] | 225 | ata_id_c_string(adev->id, model_num, ATA_ID_PROD, sizeof(model_num)); |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 226 | |
Tejun Heo | 8bfa79f | 2007-01-02 20:19:40 +0900 | [diff] [blame] | 227 | for (i = 0; (p = csb_bad_ata100[i]) != NULL; i++) { |
| 228 | if (!strcmp(p, model_num)) |
Alan Cox | 6ddd686 | 2008-02-26 13:35:54 -0800 | [diff] [blame] | 229 | mask &= ~(0xE0 << ATA_SHIFT_UDMA); |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 230 | } |
Alan Cox | a76b62c | 2007-03-09 09:34:07 -0500 | [diff] [blame] | 231 | return ata_pci_default_filter(adev, mask); |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 232 | } |
| 233 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 234 | /** |
| 235 | * serverworks_set_piomode - set initial PIO mode data |
| 236 | * @ap: ATA interface |
| 237 | * @adev: ATA device |
| 238 | * |
| 239 | * Program the OSB4/CSB5 timing registers for PIO. The PIO register |
| 240 | * load is done as a simple lookup. |
| 241 | */ |
| 242 | static void serverworks_set_piomode(struct ata_port *ap, struct ata_device *adev) |
| 243 | { |
| 244 | static const u8 pio_mode[] = { 0x5d, 0x47, 0x34, 0x22, 0x20 }; |
Alan Cox | 0f06978 | 2008-01-19 15:52:56 +0000 | [diff] [blame] | 245 | int offset = 1 + 2 * ap->port_no - adev->devno; |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 246 | int devbits = (2 * ap->port_no + adev->devno) * 4; |
| 247 | u16 csb5_pio; |
| 248 | struct pci_dev *pdev = to_pci_dev(ap->host->dev); |
| 249 | int pio = adev->pio_mode - XFER_PIO_0; |
| 250 | |
| 251 | pci_write_config_byte(pdev, 0x40 + offset, pio_mode[pio]); |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 252 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 253 | /* The OSB4 just requires the timing but the CSB series want the |
| 254 | mode number as well */ |
| 255 | if (serverworks_is_csb(pdev)) { |
| 256 | pci_read_config_word(pdev, 0x4A, &csb5_pio); |
| 257 | csb5_pio &= ~(0x0F << devbits); |
| 258 | pci_write_config_byte(pdev, 0x4A, csb5_pio | (pio << devbits)); |
| 259 | } |
| 260 | } |
| 261 | |
| 262 | /** |
| 263 | * serverworks_set_dmamode - set initial DMA mode data |
| 264 | * @ap: ATA interface |
| 265 | * @adev: ATA device |
| 266 | * |
| 267 | * Program the MWDMA/UDMA modes for the serverworks OSB4/CSB5 |
| 268 | * chipset. The MWDMA mode values are pulled from a lookup table |
| 269 | * while the chipset uses mode number for UDMA. |
| 270 | */ |
| 271 | |
| 272 | static void serverworks_set_dmamode(struct ata_port *ap, struct ata_device *adev) |
| 273 | { |
| 274 | static const u8 dma_mode[] = { 0x77, 0x21, 0x20 }; |
| 275 | int offset = 1 + 2 * ap->port_no - adev->devno; |
Alan Cox | 36beb82 | 2007-11-05 15:04:40 +0000 | [diff] [blame] | 276 | int devbits = 2 * ap->port_no + adev->devno; |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 277 | u8 ultra; |
| 278 | u8 ultra_cfg; |
| 279 | struct pci_dev *pdev = to_pci_dev(ap->host->dev); |
| 280 | |
| 281 | pci_read_config_byte(pdev, 0x54, &ultra_cfg); |
Alan Cox | 36beb82 | 2007-11-05 15:04:40 +0000 | [diff] [blame] | 282 | pci_read_config_byte(pdev, 0x56 + ap->port_no, &ultra); |
| 283 | ultra &= ~(0x0F << (adev->devno * 4)); |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 284 | |
| 285 | if (adev->dma_mode >= XFER_UDMA_0) { |
| 286 | pci_write_config_byte(pdev, 0x44 + offset, 0x20); |
| 287 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 288 | ultra |= (adev->dma_mode - XFER_UDMA_0) |
Alan Cox | 36beb82 | 2007-11-05 15:04:40 +0000 | [diff] [blame] | 289 | << (adev->devno * 4); |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 290 | ultra_cfg |= (1 << devbits); |
| 291 | } else { |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 292 | pci_write_config_byte(pdev, 0x44 + offset, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 293 | dma_mode[adev->dma_mode - XFER_MW_DMA_0]); |
| 294 | ultra_cfg &= ~(1 << devbits); |
| 295 | } |
Alan Cox | 36beb82 | 2007-11-05 15:04:40 +0000 | [diff] [blame] | 296 | pci_write_config_byte(pdev, 0x56 + ap->port_no, ultra); |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 297 | pci_write_config_byte(pdev, 0x54, ultra_cfg); |
| 298 | } |
| 299 | |
| 300 | static struct scsi_host_template serverworks_sht = { |
| 301 | .module = THIS_MODULE, |
| 302 | .name = DRV_NAME, |
| 303 | .ioctl = ata_scsi_ioctl, |
| 304 | .queuecommand = ata_scsi_queuecmd, |
| 305 | .can_queue = ATA_DEF_QUEUE, |
| 306 | .this_id = ATA_SHT_THIS_ID, |
| 307 | .sg_tablesize = LIBATA_MAX_PRD, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 308 | .cmd_per_lun = ATA_SHT_CMD_PER_LUN, |
| 309 | .emulated = ATA_SHT_EMULATED, |
| 310 | .use_clustering = ATA_SHT_USE_CLUSTERING, |
| 311 | .proc_name = DRV_NAME, |
| 312 | .dma_boundary = ATA_DMA_BOUNDARY, |
| 313 | .slave_configure = ata_scsi_slave_config, |
Tejun Heo | afdfe89 | 2006-11-29 11:26:47 +0900 | [diff] [blame] | 314 | .slave_destroy = ata_scsi_slave_destroy, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 315 | .bios_param = ata_std_bios_param, |
| 316 | }; |
| 317 | |
| 318 | static struct ata_port_operations serverworks_osb4_port_ops = { |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 319 | .set_piomode = serverworks_set_piomode, |
| 320 | .set_dmamode = serverworks_set_dmamode, |
| 321 | .mode_filter = serverworks_osb4_filter, |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 322 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 323 | .tf_load = ata_tf_load, |
| 324 | .tf_read = ata_tf_read, |
| 325 | .check_status = ata_check_status, |
| 326 | .exec_command = ata_exec_command, |
| 327 | .dev_select = ata_std_dev_select, |
| 328 | |
| 329 | .freeze = ata_bmdma_freeze, |
| 330 | .thaw = ata_bmdma_thaw, |
Jeff Garzik | a0fcdc0 | 2007-03-09 07:24:15 -0500 | [diff] [blame] | 331 | .error_handler = ata_bmdma_error_handler, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 332 | .post_internal_cmd = ata_bmdma_post_internal_cmd, |
Jeff Garzik | a0fcdc0 | 2007-03-09 07:24:15 -0500 | [diff] [blame] | 333 | .cable_detect = serverworks_cable_detect, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 334 | |
| 335 | .bmdma_setup = ata_bmdma_setup, |
| 336 | .bmdma_start = ata_bmdma_start, |
| 337 | .bmdma_stop = ata_bmdma_stop, |
| 338 | .bmdma_status = ata_bmdma_status, |
| 339 | |
| 340 | .qc_prep = ata_qc_prep, |
| 341 | .qc_issue = ata_qc_issue_prot, |
Jeff Garzik | bda3028 | 2006-09-27 05:41:13 -0400 | [diff] [blame] | 342 | |
Tejun Heo | 0d5ff56 | 2007-02-01 15:06:36 +0900 | [diff] [blame] | 343 | .data_xfer = ata_data_xfer, |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 344 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 345 | .irq_handler = ata_interrupt, |
Jeff Garzik | efbf3f1 | 2006-09-26 17:10:53 -0400 | [diff] [blame] | 346 | .irq_clear = ata_bmdma_irq_clear, |
Akira Iguchi | 246ce3b | 2007-01-26 16:27:58 +0900 | [diff] [blame] | 347 | .irq_on = ata_irq_on, |
Jeff Garzik | efbf3f1 | 2006-09-26 17:10:53 -0400 | [diff] [blame] | 348 | |
Alan Cox | 81ad183 | 2007-08-22 22:55:41 +0100 | [diff] [blame] | 349 | .port_start = ata_sff_port_start, |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 350 | }; |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 351 | |
| 352 | static struct ata_port_operations serverworks_csb_port_ops = { |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 353 | .set_piomode = serverworks_set_piomode, |
| 354 | .set_dmamode = serverworks_set_dmamode, |
| 355 | .mode_filter = serverworks_csb_filter, |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 356 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 357 | .tf_load = ata_tf_load, |
| 358 | .tf_read = ata_tf_read, |
| 359 | .check_status = ata_check_status, |
| 360 | .exec_command = ata_exec_command, |
| 361 | .dev_select = ata_std_dev_select, |
| 362 | |
| 363 | .freeze = ata_bmdma_freeze, |
| 364 | .thaw = ata_bmdma_thaw, |
Jeff Garzik | a0fcdc0 | 2007-03-09 07:24:15 -0500 | [diff] [blame] | 365 | .error_handler = ata_bmdma_error_handler, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 366 | .post_internal_cmd = ata_bmdma_post_internal_cmd, |
Jeff Garzik | a0fcdc0 | 2007-03-09 07:24:15 -0500 | [diff] [blame] | 367 | .cable_detect = serverworks_cable_detect, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 368 | |
| 369 | .bmdma_setup = ata_bmdma_setup, |
| 370 | .bmdma_start = ata_bmdma_start, |
| 371 | .bmdma_stop = ata_bmdma_stop, |
| 372 | .bmdma_status = ata_bmdma_status, |
| 373 | |
| 374 | .qc_prep = ata_qc_prep, |
| 375 | .qc_issue = ata_qc_issue_prot, |
Jeff Garzik | bda3028 | 2006-09-27 05:41:13 -0400 | [diff] [blame] | 376 | |
Tejun Heo | 0d5ff56 | 2007-02-01 15:06:36 +0900 | [diff] [blame] | 377 | .data_xfer = ata_data_xfer, |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 378 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 379 | .irq_handler = ata_interrupt, |
Jeff Garzik | efbf3f1 | 2006-09-26 17:10:53 -0400 | [diff] [blame] | 380 | .irq_clear = ata_bmdma_irq_clear, |
Akira Iguchi | 246ce3b | 2007-01-26 16:27:58 +0900 | [diff] [blame] | 381 | .irq_on = ata_irq_on, |
Jeff Garzik | efbf3f1 | 2006-09-26 17:10:53 -0400 | [diff] [blame] | 382 | |
Alan Cox | 81ad183 | 2007-08-22 22:55:41 +0100 | [diff] [blame] | 383 | .port_start = ata_sff_port_start, |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 384 | }; |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 385 | |
| 386 | static int serverworks_fixup_osb4(struct pci_dev *pdev) |
| 387 | { |
| 388 | u32 reg; |
| 389 | struct pci_dev *isa_dev = pci_get_device(PCI_VENDOR_ID_SERVERWORKS, |
| 390 | PCI_DEVICE_ID_SERVERWORKS_OSB4, NULL); |
| 391 | if (isa_dev) { |
| 392 | pci_read_config_dword(isa_dev, 0x64, ®); |
| 393 | reg &= ~0x00002000; /* disable 600ns interrupt mask */ |
| 394 | if (!(reg & 0x00004000)) |
| 395 | printk(KERN_DEBUG DRV_NAME ": UDMA not BIOS enabled.\n"); |
| 396 | reg |= 0x00004000; /* enable UDMA/33 support */ |
| 397 | pci_write_config_dword(isa_dev, 0x64, reg); |
| 398 | pci_dev_put(isa_dev); |
| 399 | return 0; |
| 400 | } |
| 401 | printk(KERN_WARNING "ata_serverworks: Unable to find bridge.\n"); |
| 402 | return -ENODEV; |
| 403 | } |
| 404 | |
| 405 | static int serverworks_fixup_csb(struct pci_dev *pdev) |
| 406 | { |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 407 | u8 btr; |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 408 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 409 | /* Third Channel Test */ |
| 410 | if (!(PCI_FUNC(pdev->devfn) & 1)) { |
| 411 | struct pci_dev * findev = NULL; |
| 412 | u32 reg4c = 0; |
| 413 | findev = pci_get_device(PCI_VENDOR_ID_SERVERWORKS, |
| 414 | PCI_DEVICE_ID_SERVERWORKS_CSB5, NULL); |
| 415 | if (findev) { |
| 416 | pci_read_config_dword(findev, 0x4C, ®4c); |
| 417 | reg4c &= ~0x000007FF; |
| 418 | reg4c |= 0x00000040; |
| 419 | reg4c |= 0x00000020; |
| 420 | pci_write_config_dword(findev, 0x4C, reg4c); |
| 421 | pci_dev_put(findev); |
| 422 | } |
| 423 | } else { |
| 424 | struct pci_dev * findev = NULL; |
| 425 | u8 reg41 = 0; |
| 426 | |
| 427 | findev = pci_get_device(PCI_VENDOR_ID_SERVERWORKS, |
| 428 | PCI_DEVICE_ID_SERVERWORKS_CSB6, NULL); |
| 429 | if (findev) { |
| 430 | pci_read_config_byte(findev, 0x41, ®41); |
| 431 | reg41 &= ~0x40; |
| 432 | pci_write_config_byte(findev, 0x41, reg41); |
| 433 | pci_dev_put(findev); |
| 434 | } |
| 435 | } |
| 436 | /* setup the UDMA Control register |
| 437 | * |
| 438 | * 1. clear bit 6 to enable DMA |
| 439 | * 2. enable DMA modes with bits 0-1 |
| 440 | * 00 : legacy |
| 441 | * 01 : udma2 |
| 442 | * 10 : udma2/udma4 |
| 443 | * 11 : udma2/udma4/udma5 |
| 444 | */ |
| 445 | pci_read_config_byte(pdev, 0x5A, &btr); |
| 446 | btr &= ~0x40; |
| 447 | if (!(PCI_FUNC(pdev->devfn) & 1)) |
| 448 | btr |= 0x2; |
| 449 | else |
Auke Kok | 44c1013 | 2007-06-08 15:46:36 -0700 | [diff] [blame] | 450 | btr |= (pdev->revision >= SVWKS_CSB5_REVISION_NEW) ? 0x3 : 0x2; |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 451 | pci_write_config_byte(pdev, 0x5A, btr); |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 452 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 453 | return btr; |
| 454 | } |
| 455 | |
| 456 | static void serverworks_fixup_ht1000(struct pci_dev *pdev) |
| 457 | { |
| 458 | u8 btr; |
| 459 | /* Setup HT1000 SouthBridge Controller - Single Channel Only */ |
| 460 | pci_read_config_byte(pdev, 0x5A, &btr); |
| 461 | btr &= ~0x40; |
| 462 | btr |= 0x3; |
| 463 | pci_write_config_byte(pdev, 0x5A, btr); |
| 464 | } |
| 465 | |
| 466 | |
| 467 | static int serverworks_init_one(struct pci_dev *pdev, const struct pci_device_id *id) |
| 468 | { |
Tejun Heo | 1626aeb | 2007-05-04 12:43:58 +0200 | [diff] [blame] | 469 | static const struct ata_port_info info[4] = { |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 470 | { /* OSB4 */ |
| 471 | .sht = &serverworks_sht, |
Jeff Garzik | 1d2808f | 2007-05-28 06:59:48 -0400 | [diff] [blame] | 472 | .flags = ATA_FLAG_SLAVE_POSS, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 473 | .pio_mask = 0x1f, |
| 474 | .mwdma_mask = 0x07, |
| 475 | .udma_mask = 0x07, |
| 476 | .port_ops = &serverworks_osb4_port_ops |
| 477 | }, { /* OSB4 no UDMA */ |
| 478 | .sht = &serverworks_sht, |
Jeff Garzik | 1d2808f | 2007-05-28 06:59:48 -0400 | [diff] [blame] | 479 | .flags = ATA_FLAG_SLAVE_POSS, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 480 | .pio_mask = 0x1f, |
| 481 | .mwdma_mask = 0x07, |
| 482 | .udma_mask = 0x00, |
| 483 | .port_ops = &serverworks_osb4_port_ops |
| 484 | }, { /* CSB5 */ |
| 485 | .sht = &serverworks_sht, |
Jeff Garzik | 1d2808f | 2007-05-28 06:59:48 -0400 | [diff] [blame] | 486 | .flags = ATA_FLAG_SLAVE_POSS, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 487 | .pio_mask = 0x1f, |
| 488 | .mwdma_mask = 0x07, |
Jeff Garzik | bf6263a | 2007-07-09 12:16:50 -0400 | [diff] [blame] | 489 | .udma_mask = ATA_UDMA4, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 490 | .port_ops = &serverworks_csb_port_ops |
| 491 | }, { /* CSB5 - later revisions*/ |
| 492 | .sht = &serverworks_sht, |
Jeff Garzik | 1d2808f | 2007-05-28 06:59:48 -0400 | [diff] [blame] | 493 | .flags = ATA_FLAG_SLAVE_POSS, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 494 | .pio_mask = 0x1f, |
| 495 | .mwdma_mask = 0x07, |
Jeff Garzik | bf6263a | 2007-07-09 12:16:50 -0400 | [diff] [blame] | 496 | .udma_mask = ATA_UDMA5, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 497 | .port_ops = &serverworks_csb_port_ops |
| 498 | } |
| 499 | }; |
Tejun Heo | 1626aeb | 2007-05-04 12:43:58 +0200 | [diff] [blame] | 500 | const struct ata_port_info *ppi[] = { &info[id->driver_data], NULL }; |
Tejun Heo | f08048e | 2008-03-25 12:22:47 +0900 | [diff] [blame] | 501 | int rc; |
| 502 | |
| 503 | rc = pcim_enable_device(pdev); |
| 504 | if (rc) |
| 505 | return rc; |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 506 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 507 | /* Force master latency timer to 64 PCI clocks */ |
| 508 | pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0x40); |
| 509 | |
| 510 | /* OSB4 : South Bridge and IDE */ |
| 511 | if (pdev->device == PCI_DEVICE_ID_SERVERWORKS_OSB4IDE) { |
| 512 | /* Select non UDMA capable OSB4 if we can't do fixups */ |
| 513 | if ( serverworks_fixup_osb4(pdev) < 0) |
Tejun Heo | 1626aeb | 2007-05-04 12:43:58 +0200 | [diff] [blame] | 514 | ppi[0] = &info[1]; |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 515 | } |
| 516 | /* setup CSB5/CSB6 : South Bridge and IDE option RAID */ |
| 517 | else if ((pdev->device == PCI_DEVICE_ID_SERVERWORKS_CSB5IDE) || |
| 518 | (pdev->device == PCI_DEVICE_ID_SERVERWORKS_CSB6IDE) || |
| 519 | (pdev->device == PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2)) { |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 520 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 521 | /* If the returned btr is the newer revision then |
| 522 | select the right info block */ |
| 523 | if (serverworks_fixup_csb(pdev) == 3) |
Tejun Heo | 1626aeb | 2007-05-04 12:43:58 +0200 | [diff] [blame] | 524 | ppi[0] = &info[3]; |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 525 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 526 | /* Is this the 3rd channel CSB6 IDE ? */ |
| 527 | if (pdev->device == PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2) |
Tejun Heo | 1626aeb | 2007-05-04 12:43:58 +0200 | [diff] [blame] | 528 | ppi[1] = &ata_dummy_port_info; |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 529 | } |
| 530 | /* setup HT1000E */ |
| 531 | else if (pdev->device == PCI_DEVICE_ID_SERVERWORKS_HT1000IDE) |
| 532 | serverworks_fixup_ht1000(pdev); |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 533 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 534 | if (pdev->device == PCI_DEVICE_ID_SERVERWORKS_CSB5IDE) |
| 535 | ata_pci_clear_simplex(pdev); |
Jeff Garzik | 85cd725 | 2006-08-31 00:03:49 -0400 | [diff] [blame] | 536 | |
Tejun Heo | 1626aeb | 2007-05-04 12:43:58 +0200 | [diff] [blame] | 537 | return ata_pci_init_one(pdev, ppi); |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 538 | } |
| 539 | |
Tejun Heo | 438ac6d | 2007-03-02 17:31:26 +0900 | [diff] [blame] | 540 | #ifdef CONFIG_PM |
Alan | 38e0d56 | 2006-11-27 16:16:35 +0000 | [diff] [blame] | 541 | static int serverworks_reinit_one(struct pci_dev *pdev) |
| 542 | { |
Tejun Heo | f08048e | 2008-03-25 12:22:47 +0900 | [diff] [blame] | 543 | struct ata_host *host = dev_get_drvdata(&pdev->dev); |
| 544 | int rc; |
| 545 | |
| 546 | rc = ata_pci_device_do_resume(pdev); |
| 547 | if (rc) |
| 548 | return rc; |
| 549 | |
Alan | 38e0d56 | 2006-11-27 16:16:35 +0000 | [diff] [blame] | 550 | /* Force master latency timer to 64 PCI clocks */ |
| 551 | pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0x40); |
Jeff Garzik | f20b16f | 2006-12-11 11:14:06 -0500 | [diff] [blame] | 552 | |
Tejun Heo | f08048e | 2008-03-25 12:22:47 +0900 | [diff] [blame] | 553 | switch (pdev->device) { |
Alan | 38e0d56 | 2006-11-27 16:16:35 +0000 | [diff] [blame] | 554 | case PCI_DEVICE_ID_SERVERWORKS_OSB4IDE: |
| 555 | serverworks_fixup_osb4(pdev); |
| 556 | break; |
| 557 | case PCI_DEVICE_ID_SERVERWORKS_CSB5IDE: |
| 558 | ata_pci_clear_simplex(pdev); |
| 559 | /* fall through */ |
| 560 | case PCI_DEVICE_ID_SERVERWORKS_CSB6IDE: |
| 561 | case PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2: |
| 562 | serverworks_fixup_csb(pdev); |
| 563 | break; |
| 564 | case PCI_DEVICE_ID_SERVERWORKS_HT1000IDE: |
| 565 | serverworks_fixup_ht1000(pdev); |
| 566 | break; |
| 567 | } |
Tejun Heo | f08048e | 2008-03-25 12:22:47 +0900 | [diff] [blame] | 568 | |
| 569 | ata_host_resume(host); |
| 570 | return 0; |
Alan | 38e0d56 | 2006-11-27 16:16:35 +0000 | [diff] [blame] | 571 | } |
Tejun Heo | 438ac6d | 2007-03-02 17:31:26 +0900 | [diff] [blame] | 572 | #endif |
Alan | 38e0d56 | 2006-11-27 16:16:35 +0000 | [diff] [blame] | 573 | |
Jeff Garzik | 2d2744f | 2006-09-28 20:21:59 -0400 | [diff] [blame] | 574 | static const struct pci_device_id serverworks[] = { |
| 575 | { PCI_VDEVICE(SERVERWORKS, PCI_DEVICE_ID_SERVERWORKS_OSB4IDE), 0}, |
| 576 | { PCI_VDEVICE(SERVERWORKS, PCI_DEVICE_ID_SERVERWORKS_CSB5IDE), 2}, |
| 577 | { PCI_VDEVICE(SERVERWORKS, PCI_DEVICE_ID_SERVERWORKS_CSB6IDE), 2}, |
| 578 | { PCI_VDEVICE(SERVERWORKS, PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2), 2}, |
| 579 | { PCI_VDEVICE(SERVERWORKS, PCI_DEVICE_ID_SERVERWORKS_HT1000IDE), 2}, |
| 580 | |
| 581 | { }, |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 582 | }; |
| 583 | |
| 584 | static struct pci_driver serverworks_pci_driver = { |
| 585 | .name = DRV_NAME, |
| 586 | .id_table = serverworks, |
| 587 | .probe = serverworks_init_one, |
Alan | 38e0d56 | 2006-11-27 16:16:35 +0000 | [diff] [blame] | 588 | .remove = ata_pci_remove_one, |
Tejun Heo | 438ac6d | 2007-03-02 17:31:26 +0900 | [diff] [blame] | 589 | #ifdef CONFIG_PM |
Alan | 38e0d56 | 2006-11-27 16:16:35 +0000 | [diff] [blame] | 590 | .suspend = ata_pci_device_suspend, |
| 591 | .resume = serverworks_reinit_one, |
Tejun Heo | 438ac6d | 2007-03-02 17:31:26 +0900 | [diff] [blame] | 592 | #endif |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 593 | }; |
| 594 | |
| 595 | static int __init serverworks_init(void) |
| 596 | { |
| 597 | return pci_register_driver(&serverworks_pci_driver); |
| 598 | } |
| 599 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 600 | static void __exit serverworks_exit(void) |
| 601 | { |
| 602 | pci_unregister_driver(&serverworks_pci_driver); |
| 603 | } |
| 604 | |
Jeff Garzik | 669a5db | 2006-08-29 18:12:40 -0400 | [diff] [blame] | 605 | MODULE_AUTHOR("Alan Cox"); |
| 606 | MODULE_DESCRIPTION("low-level driver for Serverworks OSB4/CSB5/CSB6"); |
| 607 | MODULE_LICENSE("GPL"); |
| 608 | MODULE_DEVICE_TABLE(pci, serverworks); |
| 609 | MODULE_VERSION(DRV_VERSION); |
| 610 | |
| 611 | module_init(serverworks_init); |
| 612 | module_exit(serverworks_exit); |