Blame view
drivers/ata/pata_cmd640.c
6.69 KB
b2248dac0 pata_cmd640: CMD6... |
1 2 3 |
/* * pata_cmd640.c - CMD640 PCI PATA for new ATA layer * (C) 2007 Red Hat Inc |
b2248dac0 pata_cmd640: CMD6... |
4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 |
* * Based upon * linux/drivers/ide/pci/cmd640.c Version 1.02 Sep 01, 1996 * * Copyright (C) 1995-1996 Linus Torvalds & authors (see driver) * * This drives only the PCI version of the controller. If you have a * VLB one then we have enough docs to support it but you can write * your own code. */ #include <linux/kernel.h> #include <linux/module.h> #include <linux/pci.h> #include <linux/init.h> #include <linux/blkdev.h> #include <linux/delay.h> |
5a0e3ad6a include cleanup: ... |
21 |
#include <linux/gfp.h> |
b2248dac0 pata_cmd640: CMD6... |
22 23 24 25 |
#include <scsi/scsi_host.h> #include <linux/libata.h> #define DRV_NAME "pata_cmd640" |
7938a72db pata_cmd640: Mult... |
26 |
#define DRV_VERSION "0.0.5" |
b2248dac0 pata_cmd640: CMD6... |
27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 |
struct cmd640_reg { int last; u8 reg58[ATA_MAX_DEVICES]; }; enum { CFR = 0x50, CNTRL = 0x51, CMDTIM = 0x52, ARTIM0 = 0x53, DRWTIM0 = 0x54, ARTIM23 = 0x57, DRWTIM23 = 0x58, BRST = 0x59 }; /** * cmd640_set_piomode - set initial PIO mode data |
7938a72db pata_cmd640: Mult... |
46 |
* @ap: ATA port |
b2248dac0 pata_cmd640: CMD6... |
47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 |
* @adev: ATA device * * Called to do the PIO mode setup. */ static void cmd640_set_piomode(struct ata_port *ap, struct ata_device *adev) { struct cmd640_reg *timing = ap->private_data; struct pci_dev *pdev = to_pci_dev(ap->host->dev); struct ata_timing t; const unsigned long T = 1000000 / 33; const u8 setup_data[] = { 0x40, 0x40, 0x40, 0x80, 0x00 }; u8 reg; int arttim = ARTIM0 + 2 * adev->devno; struct ata_device *pair = ata_dev_pair(adev); if (ata_timing_compute(adev, adev->pio_mode, &t, T, 0) < 0) { printk(KERN_ERR DRV_NAME ": mode computation failed. "); return; } /* The second channel has shared timings and the setup timing is messy to switch to merge it for worst case */ if (ap->port_no && pair) { struct ata_timing p; ata_timing_compute(pair, pair->pio_mode, &p, T, 1); ata_timing_merge(&p, &t, &t, ATA_TIMING_SETUP); } /* Make the timings fit */ if (t.recover > 16) { t.active += t.recover - 16; t.recover = 16; } if (t.active > 16) t.active = 16; /* Now convert the clocks into values we can actually stuff into the chip */ if (t.recover > 1) t.recover--; /* 640B only */ else t.recover = 15; if (t.setup > 4) t.setup = 0xC0; else t.setup = setup_data[t.setup]; if (ap->port_no == 0) { t.active &= 0x0F; /* 0 = 16 */ /* Load setup timing */ pci_read_config_byte(pdev, arttim, ®); reg &= 0x3F; reg |= t.setup; pci_write_config_byte(pdev, arttim, reg); /* Load active/recovery */ pci_write_config_byte(pdev, arttim + 1, (t.active << 4) | t.recover); } else { /* Save the shared timings for channel, they will be loaded |
9363c3825 libata: rename SF... |
111 112 |
by qc_issue. Reloading the setup time is expensive so we keep a merged one loaded */ |
b2248dac0 pata_cmd640: CMD6... |
113 114 115 116 117 118 119 120 121 122 |
pci_read_config_byte(pdev, ARTIM23, ®); reg &= 0x3F; reg |= t.setup; pci_write_config_byte(pdev, ARTIM23, reg); timing->reg58[adev->devno] = (t.active << 4) | t.recover; } } /** |
9363c3825 libata: rename SF... |
123 |
* cmd640_qc_issue - command preparation hook |
b2248dac0 pata_cmd640: CMD6... |
124 125 126 127 128 |
* @qc: Command to be issued * * Channel 1 has shared timings. We must reprogram the * clock each drive 2/3 switch we do. */ |
9363c3825 libata: rename SF... |
129 |
static unsigned int cmd640_qc_issue(struct ata_queued_cmd *qc) |
b2248dac0 pata_cmd640: CMD6... |
130 131 132 133 134 135 136 137 138 139 |
{ struct ata_port *ap = qc->ap; struct ata_device *adev = qc->dev; struct pci_dev *pdev = to_pci_dev(ap->host->dev); struct cmd640_reg *timing = ap->private_data; if (ap->port_no != 0 && adev->devno != timing->last) { pci_write_config_byte(pdev, DRWTIM23, timing->reg58[adev->devno]); timing->last = adev->devno; } |
9363c3825 libata: rename SF... |
140 |
return ata_sff_qc_issue(qc); |
b2248dac0 pata_cmd640: CMD6... |
141 142 143 144 145 146 147 148 149 150 151 152 153 154 |
} /** * cmd640_port_start - port setup * @ap: ATA port being set up * * The CMD640 needs to maintain private data structures so we * allocate space here. */ static int cmd640_port_start(struct ata_port *ap) { struct pci_dev *pdev = to_pci_dev(ap->host->dev); struct cmd640_reg *timing; |
b2248dac0 pata_cmd640: CMD6... |
155 156 157 158 159 |
timing = devm_kzalloc(&pdev->dev, sizeof(struct cmd640_reg), GFP_KERNEL); if (timing == NULL) return -ENOMEM; timing->last = -1; /* Force a load */ ap->private_data = timing; |
c7087652e libata-sff: clean... |
160 |
return 0; |
b2248dac0 pata_cmd640: CMD6... |
161 |
} |
c1ce90f25 pata_cmd640: impl... |
162 163 164 165 166 167 168 169 170 171 |
static bool cmd640_sff_irq_check(struct ata_port *ap) { struct pci_dev *pdev = to_pci_dev(ap->host->dev); int irq_reg = ap->port_no ? ARTIM23 : CFR; u8 irq_stat, irq_mask = ap->port_no ? 0x10 : 0x04; pci_read_config_byte(pdev, irq_reg, &irq_stat); return irq_stat & irq_mask; } |
b2248dac0 pata_cmd640: CMD6... |
172 |
static struct scsi_host_template cmd640_sht = { |
8930ff254 libata-sff: clean... |
173 |
ATA_PIO_SHT(DRV_NAME), |
b2248dac0 pata_cmd640: CMD6... |
174 175 176 |
}; static struct ata_port_operations cmd640_port_ops = { |
8930ff254 libata-sff: clean... |
177 |
.inherits = &ata_sff_port_ops, |
029cfd6b7 libata: implement... |
178 |
/* In theory xfer_noirq is not needed once we kill the prefetcher */ |
5682ed33a libata: rename SF... |
179 |
.sff_data_xfer = ata_sff_data_xfer_noirq, |
c1ce90f25 pata_cmd640: impl... |
180 |
.sff_irq_check = cmd640_sff_irq_check, |
9363c3825 libata: rename SF... |
181 |
.qc_issue = cmd640_qc_issue, |
029cfd6b7 libata: implement... |
182 183 |
.cable_detect = ata_cable_40wire, .set_piomode = cmd640_set_piomode, |
b2248dac0 pata_cmd640: CMD6... |
184 185 |
.port_start = cmd640_port_start, }; |
7938a72db pata_cmd640: Mult... |
186 |
static void cmd640_hardware_init(struct pci_dev *pdev) |
b2248dac0 pata_cmd640: CMD6... |
187 |
{ |
b2248dac0 pata_cmd640: CMD6... |
188 |
u8 ctrl; |
b2248dac0 pata_cmd640: CMD6... |
189 |
/* CMD640 detected, commiserations */ |
7938a72db pata_cmd640: Mult... |
190 |
pci_write_config_byte(pdev, 0x5B, 0x00); |
b2248dac0 pata_cmd640: CMD6... |
191 192 193 194 |
/* PIO0 command cycles */ pci_write_config_byte(pdev, CMDTIM, 0); /* 512 byte bursts (sector) */ pci_write_config_byte(pdev, BRST, 0x40); |
a617c09f6 libata: Trim trai... |
195 |
/* |
b2248dac0 pata_cmd640: CMD6... |
196 197 198 199 200 201 202 203 204 205 206 207 208 |
* A reporter a long time ago * Had problems with the data fifo * So don't run the risk * Of putting crap on the disk * For its better just to go slow */ /* Do channel 0 */ pci_read_config_byte(pdev, CNTRL, &ctrl); pci_write_config_byte(pdev, CNTRL, ctrl | 0xC0); /* Ditto for channel 1 */ pci_read_config_byte(pdev, ARTIM23, &ctrl); ctrl |= 0x0C; pci_write_config_byte(pdev, ARTIM23, ctrl); |
7938a72db pata_cmd640: Mult... |
209 210 211 212 |
} static int cmd640_init_one(struct pci_dev *pdev, const struct pci_device_id *id) { |
1626aeb88 libata: clean up ... |
213 |
static const struct ata_port_info info = { |
1d2808fd3 [libata] PATA dri... |
214 |
.flags = ATA_FLAG_SLAVE_POSS, |
14bdef982 [libata] convert ... |
215 |
.pio_mask = ATA_PIO4, |
7938a72db pata_cmd640: Mult... |
216 217 |
.port_ops = &cmd640_port_ops }; |
1626aeb88 libata: clean up ... |
218 |
const struct ata_port_info *ppi[] = { &info, NULL }; |
f08048e94 libata: PCI devic... |
219 220 221 222 223 |
int rc; rc = pcim_enable_device(pdev); if (rc) return rc; |
b2248dac0 pata_cmd640: CMD6... |
224 |
|
7938a72db pata_cmd640: Mult... |
225 |
cmd640_hardware_init(pdev); |
f08048e94 libata: PCI devic... |
226 |
|
16ea0fc98 libata: Pass host... |
227 |
return ata_pci_sff_init_one(pdev, ppi, &cmd640_sht, NULL, 0); |
b2248dac0 pata_cmd640: CMD6... |
228 |
} |
f08048e94 libata: PCI devic... |
229 |
#ifdef CONFIG_PM |
b2248dac0 pata_cmd640: CMD6... |
230 231 |
static int cmd640_reinit_one(struct pci_dev *pdev) { |
f08048e94 libata: PCI devic... |
232 233 234 235 236 237 |
struct ata_host *host = dev_get_drvdata(&pdev->dev); int rc; rc = ata_pci_device_do_resume(pdev); if (rc) return rc; |
7938a72db pata_cmd640: Mult... |
238 |
cmd640_hardware_init(pdev); |
f08048e94 libata: PCI devic... |
239 |
ata_host_resume(host); |
4b22afd74 drivers/ata/pata_... |
240 |
return 0; |
b2248dac0 pata_cmd640: CMD6... |
241 |
} |
f08048e94 libata: PCI devic... |
242 |
#endif |
b2248dac0 pata_cmd640: CMD6... |
243 244 245 246 247 248 249 250 251 252 253 |
static const struct pci_device_id cmd640[] = { { PCI_VDEVICE(CMD, 0x640), 0 }, { }, }; static struct pci_driver cmd640_pci_driver = { .name = DRV_NAME, .id_table = cmd640, .probe = cmd640_init_one, .remove = ata_pci_remove_one, |
4b22afd74 drivers/ata/pata_... |
254 |
#ifdef CONFIG_PM |
b2248dac0 pata_cmd640: CMD6... |
255 256 |
.suspend = ata_pci_device_suspend, .resume = cmd640_reinit_one, |
f08048e94 libata: PCI devic... |
257 |
#endif |
b2248dac0 pata_cmd640: CMD6... |
258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 |
}; static int __init cmd640_init(void) { return pci_register_driver(&cmd640_pci_driver); } static void __exit cmd640_exit(void) { pci_unregister_driver(&cmd640_pci_driver); } MODULE_AUTHOR("Alan Cox"); MODULE_DESCRIPTION("low-level driver for CMD640 PATA controllers"); MODULE_LICENSE("GPL"); MODULE_DEVICE_TABLE(pci, cmd640); MODULE_VERSION(DRV_VERSION); module_init(cmd640_init); module_exit(cmd640_exit); |