1
2
3
4
5
6
7
8
9
10
11#include <linux/kernel.h>
12#include <linux/module.h>
13#include <linux/pm.h>
14#include <linux/device.h>
15#include <linux/of_device.h>
16#include <linux/platform_device.h>
17#include <linux/libata.h>
18#include <linux/ahci_platform.h>
19#include <linux/acpi.h>
20#include <linux/pci_ids.h>
21#include "ahci.h"
22
23
24
25
26
27
28
29
30
31
32
33
34#define ACTIVITY_BIT_POS(x) (8 + (3 * x))
35#define LOCATE_BIT_POS(x) (ACTIVITY_BIT_POS(x) + 1)
36#define FAULT_BIT_POS(x) (LOCATE_BIT_POS(x) + 1)
37
38#define ACTIVITY_MASK 0x00010000
39#define LOCATE_MASK 0x00080000
40#define FAULT_MASK 0x00400000
41
42#define DRV_NAME "ahci-seattle"
43
44static ssize_t seattle_transmit_led_message(struct ata_port *ap, u32 state,
45 ssize_t size);
46
47struct seattle_plat_data {
48 void __iomem *sgpio_ctrl;
49};
50
51static struct ata_port_operations ahci_port_ops = {
52 .inherits = &ahci_ops,
53};
54
55static const struct ata_port_info ahci_port_info = {
56 .flags = AHCI_FLAG_COMMON,
57 .pio_mask = ATA_PIO4,
58 .udma_mask = ATA_UDMA6,
59 .port_ops = &ahci_port_ops,
60};
61
62static struct ata_port_operations ahci_seattle_ops = {
63 .inherits = &ahci_ops,
64 .transmit_led_message = seattle_transmit_led_message,
65};
66
67static const struct ata_port_info ahci_port_seattle_info = {
68 .flags = AHCI_FLAG_COMMON | ATA_FLAG_EM | ATA_FLAG_SW_ACTIVITY,
69 .link_flags = ATA_LFLAG_SW_ACTIVITY,
70 .pio_mask = ATA_PIO4,
71 .udma_mask = ATA_UDMA6,
72 .port_ops = &ahci_seattle_ops,
73};
74
75static struct scsi_host_template ahci_platform_sht = {
76 AHCI_SHT(DRV_NAME),
77};
78
79static ssize_t seattle_transmit_led_message(struct ata_port *ap, u32 state,
80 ssize_t size)
81{
82 struct ahci_host_priv *hpriv = ap->host->private_data;
83 struct ahci_port_priv *pp = ap->private_data;
84 struct seattle_plat_data *plat_data = hpriv->plat_data;
85 unsigned long flags;
86 int pmp;
87 struct ahci_em_priv *emp;
88 u32 val;
89
90
91 pmp = (state & EM_MSG_LED_PMP_SLOT) >> 8;
92 if (pmp >= EM_MAX_SLOTS)
93 return -EINVAL;
94 emp = &pp->em_priv[pmp];
95
96 val = ioread32(plat_data->sgpio_ctrl);
97 if (state & ACTIVITY_MASK)
98 val |= 1 << ACTIVITY_BIT_POS((ap->port_no));
99 else
100 val &= ~(1 << ACTIVITY_BIT_POS((ap->port_no)));
101
102 if (state & LOCATE_MASK)
103 val |= 1 << LOCATE_BIT_POS((ap->port_no));
104 else
105 val &= ~(1 << LOCATE_BIT_POS((ap->port_no)));
106
107 if (state & FAULT_MASK)
108 val |= 1 << FAULT_BIT_POS((ap->port_no));
109 else
110 val &= ~(1 << FAULT_BIT_POS((ap->port_no)));
111
112 iowrite32(val, plat_data->sgpio_ctrl);
113
114 spin_lock_irqsave(ap->lock, flags);
115
116
117 emp->led_state = state;
118
119 spin_unlock_irqrestore(ap->lock, flags);
120
121 return size;
122}
123
124static const struct ata_port_info *ahci_seattle_get_port_info(
125 struct platform_device *pdev, struct ahci_host_priv *hpriv)
126{
127 struct device *dev = &pdev->dev;
128 struct seattle_plat_data *plat_data;
129 u32 val;
130
131 plat_data = devm_kzalloc(dev, sizeof(*plat_data), GFP_KERNEL);
132 if (!plat_data)
133 return &ahci_port_info;
134
135 plat_data->sgpio_ctrl = devm_ioremap_resource(dev,
136 platform_get_resource(pdev, IORESOURCE_MEM, 1));
137 if (IS_ERR(plat_data->sgpio_ctrl))
138 return &ahci_port_info;
139
140 val = ioread32(plat_data->sgpio_ctrl);
141
142 if (!(val & 0xf))
143 return &ahci_port_info;
144
145 hpriv->em_loc = 0;
146 hpriv->em_buf_sz = 4;
147 hpriv->em_msg_type = EM_MSG_TYPE_LED;
148 hpriv->plat_data = plat_data;
149
150 dev_info(dev, "SGPIO LED control is enabled.\n");
151 return &ahci_port_seattle_info;
152}
153
154static int ahci_seattle_probe(struct platform_device *pdev)
155{
156 int rc;
157 struct ahci_host_priv *hpriv;
158
159 hpriv = ahci_platform_get_resources(pdev, 0);
160 if (IS_ERR(hpriv))
161 return PTR_ERR(hpriv);
162
163 rc = ahci_platform_enable_resources(hpriv);
164 if (rc)
165 return rc;
166
167 rc = ahci_platform_init_host(pdev, hpriv,
168 ahci_seattle_get_port_info(pdev, hpriv),
169 &ahci_platform_sht);
170 if (rc)
171 goto disable_resources;
172
173 return 0;
174disable_resources:
175 ahci_platform_disable_resources(hpriv);
176 return rc;
177}
178
179static SIMPLE_DEV_PM_OPS(ahci_pm_ops, ahci_platform_suspend,
180 ahci_platform_resume);
181
182static const struct acpi_device_id ahci_acpi_match[] = {
183 { "AMDI0600", 0 },
184 {}
185};
186MODULE_DEVICE_TABLE(acpi, ahci_acpi_match);
187
188static struct platform_driver ahci_seattle_driver = {
189 .probe = ahci_seattle_probe,
190 .remove = ata_platform_remove_one,
191 .driver = {
192 .name = DRV_NAME,
193 .acpi_match_table = ahci_acpi_match,
194 .pm = &ahci_pm_ops,
195 },
196};
197module_platform_driver(ahci_seattle_driver);
198
199MODULE_DESCRIPTION("Seattle AHCI SATA platform driver");
200MODULE_AUTHOR("Brijesh Singh <brijesh.singh@amd.com>");
201MODULE_LICENSE("GPL");
202MODULE_ALIAS("platform:" DRV_NAME);
203
