Blame view
drivers/ata/pata_cs5536.c
7.5 KB
3957df616 pata_cs5536: ATA ... |
1 2 3 |
/* * pata_cs5536.c - CS5536 PATA for new ATA layer * (C) 2007 Martin K. Petersen <mkp@mkp.net> |
d63e94a44 pata_cs5536: forw... |
4 |
* (C) 2011 Bartlomiej Zolnierkiewicz |
3957df616 pata_cs5536: ATA ... |
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 |
* * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA * * Documentation: * Available from AMD web site. * * The IDE timing registers for the CS5536 live in the Geode Machine * Specific Register file and not PCI config space. Most BIOSes * virtualize the PCI registers so the chip looks like a standard IDE * controller. Unfortunately not all implementations get this right. * In particular some have problems with unaligned accesses to the * virtualized PCI registers. This driver always does full dword * writes to work around the issue. Also, in case of a bad BIOS this * driver can be loaded with the "msr=1" parameter which forces using * the Machine Specific Registers to configure the device. */ #include <linux/kernel.h> #include <linux/module.h> #include <linux/pci.h> |
3957df616 pata_cs5536: ATA ... |
36 37 38 39 |
#include <linux/blkdev.h> #include <linux/delay.h> #include <linux/libata.h> #include <scsi/scsi_host.h> |
abf8f2b87 pata_cs5536: add ... |
40 |
#include <linux/dmi.h> |
9272dcc23 pata_cs5536: Add ... |
41 42 |
#ifdef CONFIG_X86_32 |
3957df616 pata_cs5536: ATA ... |
43 |
#include <asm/msr.h> |
9272dcc23 pata_cs5536: Add ... |
44 45 46 47 |
static int use_msr; module_param_named(msr, use_msr, int, 0644); MODULE_PARM_DESC(msr, "Force using MSR to configure IDE function (Default: 0)"); #else |
ff5dd32b9 pata_cs5536: avoi... |
48 49 |
#undef rdmsr /* avoid accidental MSR usage on, e.g. x86-64 */ #undef wrmsr |
9272dcc23 pata_cs5536: Add ... |
50 51 52 53 |
#define rdmsr(x, y, z) do { } while (0) #define wrmsr(x, y, z) do { } while (0) #define use_msr 0 #endif |
3957df616 pata_cs5536: ATA ... |
54 55 |
#define DRV_NAME "pata_cs5536" |
9272dcc23 pata_cs5536: Add ... |
56 |
#define DRV_VERSION "0.0.8" |
3957df616 pata_cs5536: ATA ... |
57 58 |
enum { |
d63e94a44 pata_cs5536: forw... |
59 |
MSR_IDE_CFG = 0x51300010, |
3957df616 pata_cs5536: ATA ... |
60 |
PCI_IDE_CFG = 0x40, |
3957df616 pata_cs5536: ATA ... |
61 |
|
d63e94a44 pata_cs5536: forw... |
62 63 64 65 66 67 68 |
CFG = 0, DTC = 2, CAST = 3, ETC = 4, IDE_CFG_CHANEN = (1 << 1), IDE_CFG_CABLE = (1 << 17) | (1 << 16), |
3957df616 pata_cs5536: ATA ... |
69 70 71 72 73 74 75 76 77 78 |
IDE_D0_SHIFT = 24, IDE_D1_SHIFT = 16, IDE_DRV_MASK = 0xff, IDE_CAST_D0_SHIFT = 6, IDE_CAST_D1_SHIFT = 4, IDE_CAST_DRV_MASK = 0x3, IDE_CAST_CMD_MASK = 0xff, IDE_CAST_CMD_SHIFT = 24, |
d63e94a44 pata_cs5536: forw... |
79 |
IDE_ETC_UDMA_MASK = 0xc0, |
3957df616 pata_cs5536: ATA ... |
80 |
}; |
abf8f2b87 pata_cs5536: add ... |
81 82 83 84 85 86 87 88 89 90 91 92 93 94 |
/* Some Bachmann OT200 devices have a non working UDMA support due a * missing resistor. */ static const struct dmi_system_id udma_quirk_dmi_table[] = { { .ident = "Bachmann electronic OT200", .matches = { DMI_MATCH(DMI_SYS_VENDOR, "Bachmann electronic"), DMI_MATCH(DMI_PRODUCT_NAME, "OT200"), DMI_MATCH(DMI_PRODUCT_VERSION, "1") }, }, { } }; |
d63e94a44 pata_cs5536: forw... |
95 |
static int cs5536_read(struct pci_dev *pdev, int reg, u32 *val) |
3957df616 pata_cs5536: ATA ... |
96 97 |
{ if (unlikely(use_msr)) { |
9272dcc23 pata_cs5536: Add ... |
98 |
u32 dummy __maybe_unused; |
3957df616 pata_cs5536: ATA ... |
99 |
|
d63e94a44 pata_cs5536: forw... |
100 |
rdmsr(MSR_IDE_CFG + reg, *val, dummy); |
3957df616 pata_cs5536: ATA ... |
101 102 |
return 0; } |
d63e94a44 pata_cs5536: forw... |
103 |
return pci_read_config_dword(pdev, PCI_IDE_CFG + reg * 4, val); |
3957df616 pata_cs5536: ATA ... |
104 |
} |
d63e94a44 pata_cs5536: forw... |
105 |
static int cs5536_write(struct pci_dev *pdev, int reg, int val) |
3957df616 pata_cs5536: ATA ... |
106 107 |
{ if (unlikely(use_msr)) { |
d63e94a44 pata_cs5536: forw... |
108 |
wrmsr(MSR_IDE_CFG + reg, val, 0); |
3957df616 pata_cs5536: ATA ... |
109 110 |
return 0; } |
d63e94a44 pata_cs5536: forw... |
111 112 113 114 115 116 117 118 119 120 121 122 123 |
return pci_write_config_dword(pdev, PCI_IDE_CFG + reg * 4, val); } static void cs5536_program_dtc(struct ata_device *adev, u8 tim) { struct pci_dev *pdev = to_pci_dev(adev->link->ap->host->dev); int dshift = adev->devno ? IDE_D1_SHIFT : IDE_D0_SHIFT; u32 dtc; cs5536_read(pdev, DTC, &dtc); dtc &= ~(IDE_DRV_MASK << dshift); dtc |= tim << dshift; cs5536_write(pdev, DTC, dtc); |
3957df616 pata_cs5536: ATA ... |
124 125 126 127 128 |
} /** * cs5536_cable_detect - detect cable type * @ap: Port to detect on |
3957df616 pata_cs5536: ATA ... |
129 |
* |
d63e94a44 pata_cs5536: forw... |
130 131 132 |
* Perform cable detection for ATA66 capable cable. * * Returns a cable type. |
3957df616 pata_cs5536: ATA ... |
133 134 135 136 137 138 139 140 |
*/ static int cs5536_cable_detect(struct ata_port *ap) { struct pci_dev *pdev = to_pci_dev(ap->host->dev); u32 cfg; cs5536_read(pdev, CFG, &cfg); |
d63e94a44 pata_cs5536: forw... |
141 |
if (cfg & IDE_CFG_CABLE) |
3957df616 pata_cs5536: ATA ... |
142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 |
return ATA_CBL_PATA80; else return ATA_CBL_PATA40; } /** * cs5536_set_piomode - PIO setup * @ap: ATA interface * @adev: device on the interface */ static void cs5536_set_piomode(struct ata_port *ap, struct ata_device *adev) { static const u8 drv_timings[5] = { 0x98, 0x55, 0x32, 0x21, 0x20, }; static const u8 addr_timings[5] = { 0x2, 0x1, 0x0, 0x0, 0x0, }; static const u8 cmd_timings[5] = { 0x99, 0x92, 0x90, 0x22, 0x20, }; struct pci_dev *pdev = to_pci_dev(ap->host->dev); struct ata_device *pair = ata_dev_pair(adev); int mode = adev->pio_mode - XFER_PIO_0; int cmdmode = mode; |
b6966a61a pata_cs5536.c bugfix |
171 |
int cshift = adev->devno ? IDE_CAST_D1_SHIFT : IDE_CAST_D0_SHIFT; |
d63e94a44 pata_cs5536: forw... |
172 |
u32 cast; |
3957df616 pata_cs5536: ATA ... |
173 174 175 |
if (pair) cmdmode = min(mode, pair->pio_mode - XFER_PIO_0); |
d63e94a44 pata_cs5536: forw... |
176 |
cs5536_program_dtc(adev, drv_timings[mode]); |
3957df616 pata_cs5536: ATA ... |
177 |
|
d63e94a44 pata_cs5536: forw... |
178 |
cs5536_read(pdev, CAST, &cast); |
3957df616 pata_cs5536: ATA ... |
179 180 181 182 183 184 |
cast &= ~(IDE_CAST_DRV_MASK << cshift); cast |= addr_timings[mode] << cshift; cast &= ~(IDE_CAST_CMD_MASK << IDE_CAST_CMD_SHIFT); cast |= cmd_timings[cmdmode] << IDE_CAST_CMD_SHIFT; |
3957df616 pata_cs5536: ATA ... |
185 |
cs5536_write(pdev, CAST, cast); |
3957df616 pata_cs5536: ATA ... |
186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 |
} /** * cs5536_set_dmamode - DMA timing setup * @ap: ATA interface * @adev: Device being configured * */ static void cs5536_set_dmamode(struct ata_port *ap, struct ata_device *adev) { static const u8 udma_timings[6] = { 0xc2, 0xc1, 0xc0, 0xc4, 0xc5, 0xc6, }; static const u8 mwdma_timings[3] = { 0x67, 0x21, 0x20, }; struct pci_dev *pdev = to_pci_dev(ap->host->dev); |
d63e94a44 pata_cs5536: forw... |
206 |
u32 etc; |
3957df616 pata_cs5536: ATA ... |
207 |
int mode = adev->dma_mode; |
b6966a61a pata_cs5536.c bugfix |
208 |
int dshift = adev->devno ? IDE_D1_SHIFT : IDE_D0_SHIFT; |
3957df616 pata_cs5536: ATA ... |
209 |
|
d63e94a44 pata_cs5536: forw... |
210 |
cs5536_read(pdev, ETC, &etc); |
3957df616 pata_cs5536: ATA ... |
211 |
|
d63e94a44 pata_cs5536: forw... |
212 |
if (mode >= XFER_UDMA_0) { |
3957df616 pata_cs5536: ATA ... |
213 214 |
etc &= ~(IDE_DRV_MASK << dshift); etc |= udma_timings[mode - XFER_UDMA_0] << dshift; |
3957df616 pata_cs5536: ATA ... |
215 |
} else { /* MWDMA */ |
d63e94a44 pata_cs5536: forw... |
216 217 |
etc &= ~(IDE_ETC_UDMA_MASK << dshift); cs5536_program_dtc(adev, mwdma_timings[mode - XFER_MW_DMA_0]); |
3957df616 pata_cs5536: ATA ... |
218 |
} |
d63e94a44 pata_cs5536: forw... |
219 220 |
cs5536_write(pdev, ETC, etc); |
3957df616 pata_cs5536: ATA ... |
221 222 223 |
} static struct scsi_host_template cs5536_sht = { |
68d1d07b5 libata: implement... |
224 |
ATA_BMDMA_SHT(DRV_NAME), |
3957df616 pata_cs5536: ATA ... |
225 226 227 |
}; static struct ata_port_operations cs5536_port_ops = { |
ba3a221ce pata_cs5536: use ... |
228 |
.inherits = &ata_bmdma32_port_ops, |
029cfd6b7 libata: implement... |
229 |
.cable_detect = cs5536_cable_detect, |
3957df616 pata_cs5536: ATA ... |
230 231 |
.set_piomode = cs5536_set_piomode, .set_dmamode = cs5536_set_dmamode, |
3957df616 pata_cs5536: ATA ... |
232 233 234 235 236 237 238 239 240 241 242 243 |
}; /** * cs5536_init_one * @dev: PCI device * @id: Entry in match table * */ static int cs5536_init_one(struct pci_dev *dev, const struct pci_device_id *id) { static const struct ata_port_info info = { |
3957df616 pata_cs5536: ATA ... |
244 |
.flags = ATA_FLAG_SLAVE_POSS, |
14bdef982 [libata] convert ... |
245 246 |
.pio_mask = ATA_PIO4, .mwdma_mask = ATA_MWDMA2, |
3957df616 pata_cs5536: ATA ... |
247 248 249 |
.udma_mask = ATA_UDMA5, .port_ops = &cs5536_port_ops, }; |
abf8f2b87 pata_cs5536: add ... |
250 251 252 253 254 255 256 257 |
static const struct ata_port_info no_udma_info = { .flags = ATA_FLAG_SLAVE_POSS, .pio_mask = ATA_PIO4, .port_ops = &cs5536_port_ops, }; const struct ata_port_info *ppi[2]; |
3957df616 pata_cs5536: ATA ... |
258 |
u32 cfg; |
abf8f2b87 pata_cs5536: add ... |
259 260 261 262 263 264 |
if (dmi_check_system(udma_quirk_dmi_table)) ppi[0] = &no_udma_info; else ppi[0] = &info; ppi[1] = &ata_dummy_port_info; |
3957df616 pata_cs5536: ATA ... |
265 266 267 268 269 270 271 272 273 274 275 |
if (use_msr) printk(KERN_ERR DRV_NAME ": Using MSR regs instead of PCI "); cs5536_read(dev, CFG, &cfg); if ((cfg & IDE_CFG_CHANEN) == 0) { printk(KERN_ERR DRV_NAME ": disabled by BIOS "); return -ENODEV; } |
1c5afdf7a libata-sff: separ... |
276 |
return ata_pci_bmdma_init_one(dev, ppi, &cs5536_sht, NULL, 0); |
3957df616 pata_cs5536: ATA ... |
277 278 279 280 281 282 283 284 285 286 287 288 |
} static const struct pci_device_id cs5536[] = { { PCI_VDEVICE(AMD, PCI_DEVICE_ID_AMD_CS5536_IDE), }, { }, }; static struct pci_driver cs5536_pci_driver = { .name = DRV_NAME, .id_table = cs5536, .probe = cs5536_init_one, .remove = ata_pci_remove_one, |
58eb8cd56 ata: use CONFIG_P... |
289 |
#ifdef CONFIG_PM_SLEEP |
3957df616 pata_cs5536: ATA ... |
290 291 292 293 |
.suspend = ata_pci_device_suspend, .resume = ata_pci_device_resume, #endif }; |
2fc75da0c ata: use module_p... |
294 |
module_pci_driver(cs5536_pci_driver); |
3957df616 pata_cs5536: ATA ... |
295 296 297 298 299 300 |
MODULE_AUTHOR("Martin K. Petersen"); MODULE_DESCRIPTION("low-level driver for the CS5536 IDE controller"); MODULE_LICENSE("GPL"); MODULE_DEVICE_TABLE(pci, cs5536); MODULE_VERSION(DRV_VERSION); |