1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/kernel.h>
15#include <linux/module.h>
16#include <linux/pci.h>
17#include <linux/blkdev.h>
18#include <linux/delay.h>
19#include <scsi/scsi_host.h>
20#include <linux/libata.h>
21
22#define DRV_NAME "pata_rz1000"
23#define DRV_VERSION "0.2.4"
24
25
26
27
28
29
30
31
32
33
34
35
36static int rz1000_set_mode(struct ata_link *link, struct ata_device **unused)
37{
38 struct ata_device *dev;
39
40 ata_for_each_dev(dev, link, ENABLED) {
41
42 dev->pio_mode = XFER_PIO_0;
43 dev->xfer_mode = XFER_PIO_0;
44 dev->xfer_shift = ATA_SHIFT_PIO;
45 dev->flags |= ATA_DFLAG_PIO;
46 ata_dev_info(dev, "configured for PIO\n");
47 }
48 return 0;
49}
50
51
52static struct scsi_host_template rz1000_sht = {
53 ATA_PIO_SHT(DRV_NAME),
54};
55
56static struct ata_port_operations rz1000_port_ops = {
57 .inherits = &ata_sff_port_ops,
58 .cable_detect = ata_cable_40wire,
59 .set_mode = rz1000_set_mode,
60};
61
62static int rz1000_fifo_disable(struct pci_dev *pdev)
63{
64 u16 reg;
65
66 if (pci_read_config_word(pdev, 0x40, ®) != 0)
67 return -1;
68 reg &= 0xDFFF;
69 if (pci_write_config_word(pdev, 0x40, reg) != 0)
70 return -1;
71 printk(KERN_INFO DRV_NAME ": disabled chipset readahead.\n");
72 return 0;
73}
74
75
76
77
78
79
80
81
82
83
84
85static int rz1000_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
86{
87 static const struct ata_port_info info = {
88 .flags = ATA_FLAG_SLAVE_POSS,
89 .pio_mask = ATA_PIO4,
90 .port_ops = &rz1000_port_ops
91 };
92 const struct ata_port_info *ppi[] = { &info, NULL };
93
94 ata_print_version_once(&pdev->dev, DRV_VERSION);
95
96 if (rz1000_fifo_disable(pdev) == 0)
97 return ata_pci_sff_init_one(pdev, ppi, &rz1000_sht, NULL, 0);
98
99 printk(KERN_ERR DRV_NAME ": failed to disable read-ahead on chipset..\n");
100
101 return -ENODEV;
102}
103
104#ifdef CONFIG_PM_SLEEP
105static int rz1000_reinit_one(struct pci_dev *pdev)
106{
107 struct ata_host *host = pci_get_drvdata(pdev);
108 int rc;
109
110 rc = ata_pci_device_do_resume(pdev);
111 if (rc)
112 return rc;
113
114
115
116 if (rz1000_fifo_disable(pdev))
117 panic("rz1000 fifo");
118
119 ata_host_resume(host);
120 return 0;
121}
122#endif
123
124static const struct pci_device_id pata_rz1000[] = {
125 { PCI_VDEVICE(PCTECH, PCI_DEVICE_ID_PCTECH_RZ1000), },
126 { PCI_VDEVICE(PCTECH, PCI_DEVICE_ID_PCTECH_RZ1001), },
127
128 { },
129};
130
131static struct pci_driver rz1000_pci_driver = {
132 .name = DRV_NAME,
133 .id_table = pata_rz1000,
134 .probe = rz1000_init_one,
135 .remove = ata_pci_remove_one,
136#ifdef CONFIG_PM_SLEEP
137 .suspend = ata_pci_device_suspend,
138 .resume = rz1000_reinit_one,
139#endif
140};
141
142module_pci_driver(rz1000_pci_driver);
143
144MODULE_AUTHOR("Alan Cox");
145MODULE_DESCRIPTION("low-level driver for RZ1000 PCI ATA");
146MODULE_LICENSE("GPL");
147MODULE_DEVICE_TABLE(pci, pata_rz1000);
148MODULE_VERSION(DRV_VERSION);
149