1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27#include <linux/kernel.h>
28#include <linux/module.h>
29#include <linux/pci.h>
30#include <linux/blkdev.h>
31#include <linux/delay.h>
32#include <linux/device.h>
33#include <scsi/scsi_host.h>
34#include <linux/libata.h>
35#include <linux/dmi.h>
36
37#define DRV_NAME "pata_sch"
38#define DRV_VERSION "0.2"
39
40
41enum {
42 D0TIM = 0x80,
43 D1TIM = 0x84,
44 PM = 0x07,
45 MDM = (0x03 << 8),
46 UDM = (0x07 << 16),
47 PPE = (1 << 30),
48 USD = (1 << 31),
49};
50
51static int sch_init_one(struct pci_dev *pdev,
52 const struct pci_device_id *ent);
53static void sch_set_piomode(struct ata_port *ap, struct ata_device *adev);
54static void sch_set_dmamode(struct ata_port *ap, struct ata_device *adev);
55
56static const struct pci_device_id sch_pci_tbl[] = {
57
58 { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_SCH_IDE), 0 },
59 { }
60};
61
62static struct pci_driver sch_pci_driver = {
63 .name = DRV_NAME,
64 .id_table = sch_pci_tbl,
65 .probe = sch_init_one,
66 .remove = ata_pci_remove_one,
67#ifdef CONFIG_PM_SLEEP
68 .suspend = ata_pci_device_suspend,
69 .resume = ata_pci_device_resume,
70#endif
71};
72
73static struct scsi_host_template sch_sht = {
74 ATA_BMDMA_SHT(DRV_NAME),
75};
76
77static struct ata_port_operations sch_pata_ops = {
78 .inherits = &ata_bmdma_port_ops,
79 .cable_detect = ata_cable_unknown,
80 .set_piomode = sch_set_piomode,
81 .set_dmamode = sch_set_dmamode,
82};
83
84static const struct ata_port_info sch_port_info = {
85 .flags = ATA_FLAG_SLAVE_POSS,
86 .pio_mask = ATA_PIO4,
87 .mwdma_mask = ATA_MWDMA2,
88 .udma_mask = ATA_UDMA5,
89 .port_ops = &sch_pata_ops,
90};
91
92MODULE_AUTHOR("Alek Du <alek.du@intel.com>");
93MODULE_DESCRIPTION("SCSI low-level driver for Intel SCH PATA controllers");
94MODULE_LICENSE("GPL");
95MODULE_DEVICE_TABLE(pci, sch_pci_tbl);
96MODULE_VERSION(DRV_VERSION);
97
98
99
100
101
102
103
104
105
106
107
108
109static void sch_set_piomode(struct ata_port *ap, struct ata_device *adev)
110{
111 unsigned int pio = adev->pio_mode - XFER_PIO_0;
112 struct pci_dev *dev = to_pci_dev(ap->host->dev);
113 unsigned int port = adev->devno ? D1TIM : D0TIM;
114 unsigned int data;
115
116 pci_read_config_dword(dev, port, &data);
117
118
119 data &= ~(PM | PPE);
120 data |= pio;
121
122 if (adev->class == ATA_DEV_ATA)
123 data |= PPE;
124 pci_write_config_dword(dev, port, data);
125}
126
127
128
129
130
131
132
133
134
135
136
137
138static void sch_set_dmamode(struct ata_port *ap, struct ata_device *adev)
139{
140 unsigned int dma_mode = adev->dma_mode;
141 struct pci_dev *dev = to_pci_dev(ap->host->dev);
142 unsigned int port = adev->devno ? D1TIM : D0TIM;
143 unsigned int data;
144
145 pci_read_config_dword(dev, port, &data);
146
147 if (dma_mode >= XFER_UDMA_0) {
148
149 data |= USD;
150 data &= ~UDM;
151 data |= (dma_mode - XFER_UDMA_0) << 16;
152 } else {
153 data &= ~(USD | MDM);
154 data |= (dma_mode - XFER_MW_DMA_0) << 8;
155 }
156 pci_write_config_dword(dev, port, data);
157}
158
159
160
161
162
163
164
165
166
167
168
169
170
171static int sch_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
172{
173 const struct ata_port_info *ppi[] = { &sch_port_info, NULL };
174
175 ata_print_version_once(&pdev->dev, DRV_VERSION);
176
177 return ata_pci_bmdma_init_one(pdev, ppi, &sch_sht, NULL, 0);
178}
179
180module_pci_driver(sch_pci_driver);
181