1
2
3
4
5
6
7
8
9
10
11#include <linux/kernel.h>
12#include <linux/module.h>
13#include <linux/pci.h>
14#include <linux/init.h>
15#include <linux/blkdev.h>
16#include <linux/delay.h>
17#include <linux/device.h>
18#include <scsi/scsi_host.h>
19#include <linux/libata.h>
20#include <linux/ata.h>
21
22#define DRV_NAME "pata_marvell"
23#define DRV_VERSION "0.1.6"
24
25
26
27
28
29
30
31
32
33static int marvell_pata_active(struct pci_dev *pdev)
34{
35 int i;
36 u32 devices;
37 void __iomem *barp;
38
39
40 if (pdev->device != 0x6145)
41 return 1;
42
43 barp = pci_iomap(pdev, 5, 0x10);
44 if (barp == NULL)
45 return -ENOMEM;
46
47 printk("BAR5:");
48 for(i = 0; i <= 0x0F; i++)
49 printk("%02X:%02X ", i, ioread8(barp + i));
50 printk("\n");
51
52 devices = ioread32(barp + 0x0C);
53 pci_iounmap(pdev, barp);
54
55 if (devices & 0x10)
56 return 1;
57 return 0;
58}
59
60
61
62
63
64
65
66
67
68static int marvell_pre_reset(struct ata_link *link, unsigned long deadline)
69{
70 struct ata_port *ap = link->ap;
71 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
72
73 if (pdev->device == 0x6145 && ap->port_no == 0 &&
74 !marvell_pata_active(pdev))
75 return -ENOENT;
76
77 return ata_sff_prereset(link, deadline);
78}
79
80static int marvell_cable_detect(struct ata_port *ap)
81{
82
83 switch(ap->port_no)
84 {
85 case 0:
86 if (ioread8(ap->ioaddr.bmdma_addr + 1) & 1)
87 return ATA_CBL_PATA40;
88 return ATA_CBL_PATA80;
89 case 1:
90 return ATA_CBL_SATA;
91 }
92
93 BUG();
94 return 0;
95}
96
97
98
99static struct scsi_host_template marvell_sht = {
100 ATA_BMDMA_SHT(DRV_NAME),
101};
102
103static struct ata_port_operations marvell_ops = {
104 .inherits = &ata_bmdma_port_ops,
105 .cable_detect = marvell_cable_detect,
106 .prereset = marvell_pre_reset,
107};
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124static int marvell_init_one (struct pci_dev *pdev, const struct pci_device_id *id)
125{
126 static const struct ata_port_info info = {
127 .flags = ATA_FLAG_SLAVE_POSS,
128
129 .pio_mask = ATA_PIO4,
130 .mwdma_mask = ATA_MWDMA2,
131 .udma_mask = ATA_UDMA5,
132
133 .port_ops = &marvell_ops,
134 };
135 static const struct ata_port_info info_sata = {
136
137 .flags = ATA_FLAG_SLAVE_POSS,
138
139 .pio_mask = ATA_PIO4,
140 .mwdma_mask = ATA_MWDMA2,
141 .udma_mask = ATA_UDMA6,
142
143 .port_ops = &marvell_ops,
144 };
145 const struct ata_port_info *ppi[] = { &info, &info_sata };
146
147 if (pdev->device == 0x6101)
148 ppi[1] = &ata_dummy_port_info;
149
150#if defined(CONFIG_SATA_AHCI) || defined(CONFIG_SATA_AHCI_MODULE)
151 if (!marvell_pata_active(pdev)) {
152 printk(KERN_INFO DRV_NAME ": PATA port not active, deferring to AHCI driver.\n");
153 return -ENODEV;
154 }
155#endif
156 return ata_pci_bmdma_init_one(pdev, ppi, &marvell_sht, NULL, 0);
157}
158
159static const struct pci_device_id marvell_pci_tbl[] = {
160 { PCI_DEVICE(0x11AB, 0x6101), },
161 { PCI_DEVICE(0x11AB, 0x6121), },
162 { PCI_DEVICE(0x11AB, 0x6123), },
163 { PCI_DEVICE(0x11AB, 0x6145), },
164 { PCI_DEVICE(0x1B4B, 0x91A0), },
165 { PCI_DEVICE(0x1B4B, 0x91A4), },
166
167 { }
168};
169
170static struct pci_driver marvell_pci_driver = {
171 .name = DRV_NAME,
172 .id_table = marvell_pci_tbl,
173 .probe = marvell_init_one,
174 .remove = ata_pci_remove_one,
175#ifdef CONFIG_PM
176 .suspend = ata_pci_device_suspend,
177 .resume = ata_pci_device_resume,
178#endif
179};
180
181module_pci_driver(marvell_pci_driver);
182
183MODULE_AUTHOR("Alan Cox");
184MODULE_DESCRIPTION("SCSI low-level driver for Marvell ATA in legacy mode");
185MODULE_LICENSE("GPL");
186MODULE_DEVICE_TABLE(pci, marvell_pci_tbl);
187MODULE_VERSION(DRV_VERSION);
188