1
2
3
4
5
6
7
8
9#include <linux/ahci_platform.h>
10#include <linux/kernel.h>
11#include <linux/libata.h>
12#include <linux/module.h>
13#include <linux/of_device.h>
14#include <linux/platform_device.h>
15#include <linux/reset.h>
16#include "ahci.h"
17
18
19#define AHCI_VEND_PCFG 0xA4
20#define AHCI_VEND_PPCFG 0xA8
21#define AHCI_VEND_PP2C 0xAC
22#define AHCI_VEND_PP3C 0xB0
23#define AHCI_VEND_PP4C 0xB4
24#define AHCI_VEND_PP5C 0xB8
25#define AHCI_VEND_AXICC 0xBC
26#define AHCI_VEND_PAXIC 0xC0
27#define AHCI_VEND_PTC 0xC8
28
29
30#define PAXIC_ADBW_BW64 0x1
31#define PAXIC_MAWID(i) (((i) * 2) << 4)
32#define PAXIC_MARID(i) (((i) * 2) << 12)
33#define PAXIC_MARIDD(i) ((((i) * 2) + 1) << 16)
34#define PAXIC_MAWIDD(i) ((((i) * 2) + 1) << 8)
35#define PAXIC_OTL (0x4 << 20)
36
37
38#define AXICC_ARCA_VAL (0xF << 0)
39#define AXICC_ARCF_VAL (0xF << 4)
40#define AXICC_ARCH_VAL (0xF << 8)
41#define AXICC_ARCP_VAL (0xF << 12)
42#define AXICC_AWCFD_VAL (0xF << 16)
43#define AXICC_AWCD_VAL (0xF << 20)
44#define AXICC_AWCF_VAL (0xF << 24)
45
46#define PCFG_TPSS_VAL (0x32 << 16)
47#define PCFG_TPRS_VAL (0x2 << 12)
48#define PCFG_PAD_VAL 0x2
49
50#define PPCFG_TTA 0x1FFFE
51#define PPCFG_PSSO_EN (1 << 28)
52#define PPCFG_PSS_EN (1 << 29)
53#define PPCFG_ESDF_EN (1 << 31)
54
55#define PP5C_RIT 0x60216
56#define PP5C_RCT (0x7f0 << 20)
57
58#define PTC_RX_WM_VAL 0x40
59#define PTC_RSVD (1 << 27)
60
61#define PORT0_BASE 0x100
62#define PORT1_BASE 0x180
63
64
65#define PORT_SCTL_SPD_GEN3 (0x3 << 4)
66#define PORT_SCTL_SPD_GEN2 (0x2 << 4)
67#define PORT_SCTL_SPD_GEN1 (0x1 << 4)
68#define PORT_SCTL_IPM (0x3 << 8)
69
70#define PORT_BASE 0x100
71#define PORT_OFFSET 0x80
72#define NR_PORTS 2
73#define DRV_NAME "ahci-ceva"
74#define CEVA_FLAG_BROKEN_GEN2 1
75
76static unsigned int rx_watermark = PTC_RX_WM_VAL;
77module_param(rx_watermark, uint, 0644);
78MODULE_PARM_DESC(rx_watermark, "RxWaterMark value (0 - 0x80)");
79
80struct ceva_ahci_priv {
81 struct platform_device *ahci_pdev;
82
83 u32 pp2c[NR_PORTS];
84 u32 pp3c[NR_PORTS];
85 u32 pp4c[NR_PORTS];
86 u32 pp5c[NR_PORTS];
87
88 u32 axicc;
89 bool is_cci_enabled;
90 int flags;
91 struct reset_control *rst;
92};
93
94static unsigned int ceva_ahci_read_id(struct ata_device *dev,
95 struct ata_taskfile *tf, u16 *id)
96{
97 u32 err_mask;
98
99 err_mask = ata_do_dev_read_id(dev, tf, id);
100 if (err_mask)
101 return err_mask;
102
103
104
105
106 id[ATA_ID_FEATURE_SUPP] &= cpu_to_le16(~(1 << 8));
107
108 return 0;
109}
110
111static struct ata_port_operations ahci_ceva_ops = {
112 .inherits = &ahci_platform_ops,
113 .read_id = ceva_ahci_read_id,
114};
115
116static const struct ata_port_info ahci_ceva_port_info = {
117 .flags = AHCI_FLAG_COMMON,
118 .pio_mask = ATA_PIO4,
119 .udma_mask = ATA_UDMA6,
120 .port_ops = &ahci_ceva_ops,
121};
122
123static void ahci_ceva_setup(struct ahci_host_priv *hpriv)
124{
125 void __iomem *mmio = hpriv->mmio;
126 struct ceva_ahci_priv *cevapriv = hpriv->plat_data;
127 u32 tmp;
128 int i;
129
130
131 tmp = readl(mmio + HOST_CTL);
132 tmp |= HOST_AHCI_EN;
133 writel(tmp, mmio + HOST_CTL);
134
135 for (i = 0; i < NR_PORTS; i++) {
136
137 tmp = PCFG_TPSS_VAL | PCFG_TPRS_VAL | (PCFG_PAD_VAL + i);
138 writel(tmp, mmio + AHCI_VEND_PCFG);
139
140
141
142
143
144
145
146 tmp = PAXIC_ADBW_BW64 | PAXIC_MAWIDD(i) | PAXIC_MARIDD(i) |
147 PAXIC_MAWID(i) | PAXIC_MARID(i) | PAXIC_OTL;
148 writel(tmp, mmio + AHCI_VEND_PAXIC);
149
150
151 if (cevapriv->is_cci_enabled) {
152 tmp = readl(mmio + AHCI_VEND_AXICC);
153 tmp |= AXICC_ARCA_VAL | AXICC_ARCF_VAL |
154 AXICC_ARCH_VAL | AXICC_ARCP_VAL |
155 AXICC_AWCFD_VAL | AXICC_AWCD_VAL |
156 AXICC_AWCF_VAL;
157 writel(tmp, mmio + AHCI_VEND_AXICC);
158 }
159
160
161 tmp = PPCFG_TTA | PPCFG_PSS_EN | PPCFG_ESDF_EN;
162 writel(tmp, mmio + AHCI_VEND_PPCFG);
163
164
165 writel(cevapriv->pp2c[i], mmio + AHCI_VEND_PP2C);
166
167
168 writel(cevapriv->pp3c[i], mmio + AHCI_VEND_PP3C);
169
170
171 writel(cevapriv->pp4c[i], mmio + AHCI_VEND_PP4C);
172
173
174 writel(cevapriv->pp5c[i], mmio + AHCI_VEND_PP5C);
175
176
177 tmp = rx_watermark | PTC_RSVD;
178 writel(tmp, mmio + AHCI_VEND_PTC);
179
180
181 tmp = PORT_SCTL_SPD_GEN3 | PORT_SCTL_IPM;
182 if (cevapriv->flags & CEVA_FLAG_BROKEN_GEN2)
183 tmp = PORT_SCTL_SPD_GEN1 | PORT_SCTL_IPM;
184 writel(tmp, mmio + PORT_SCR_CTL + PORT_BASE + PORT_OFFSET * i);
185 }
186}
187
188static struct scsi_host_template ahci_platform_sht = {
189 AHCI_SHT(DRV_NAME),
190};
191
192static int ceva_ahci_probe(struct platform_device *pdev)
193{
194 struct device_node *np = pdev->dev.of_node;
195 struct device *dev = &pdev->dev;
196 struct ahci_host_priv *hpriv;
197 struct ceva_ahci_priv *cevapriv;
198 enum dev_dma_attr attr;
199 int rc;
200
201 cevapriv = devm_kzalloc(dev, sizeof(*cevapriv), GFP_KERNEL);
202 if (!cevapriv)
203 return -ENOMEM;
204
205 cevapriv->ahci_pdev = pdev;
206
207 cevapriv->rst = devm_reset_control_get_optional_exclusive(&pdev->dev,
208 NULL);
209 if (IS_ERR(cevapriv->rst))
210 dev_err_probe(&pdev->dev, PTR_ERR(cevapriv->rst),
211 "failed to get reset\n");
212
213 hpriv = ahci_platform_get_resources(pdev, 0);
214 if (IS_ERR(hpriv))
215 return PTR_ERR(hpriv);
216
217 if (!cevapriv->rst) {
218 rc = ahci_platform_enable_resources(hpriv);
219 if (rc)
220 return rc;
221 } else {
222 int i;
223
224 rc = ahci_platform_enable_clks(hpriv);
225 if (rc)
226 return rc;
227
228 reset_control_assert(cevapriv->rst);
229
230 for (i = 0; i < hpriv->nports; i++) {
231 rc = phy_init(hpriv->phys[i]);
232 if (rc)
233 return rc;
234 }
235
236
237 reset_control_deassert(cevapriv->rst);
238
239 for (i = 0; i < hpriv->nports; i++) {
240 rc = phy_power_on(hpriv->phys[i]);
241 if (rc) {
242 phy_exit(hpriv->phys[i]);
243 return rc;
244 }
245 }
246 }
247
248 if (of_property_read_bool(np, "ceva,broken-gen2"))
249 cevapriv->flags = CEVA_FLAG_BROKEN_GEN2;
250
251
252 if (of_property_read_u8_array(np, "ceva,p0-cominit-params",
253 (u8 *)&cevapriv->pp2c[0], 4) < 0) {
254 dev_warn(dev, "ceva,p0-cominit-params property not defined\n");
255 return -EINVAL;
256 }
257
258 if (of_property_read_u8_array(np, "ceva,p1-cominit-params",
259 (u8 *)&cevapriv->pp2c[1], 4) < 0) {
260 dev_warn(dev, "ceva,p1-cominit-params property not defined\n");
261 return -EINVAL;
262 }
263
264
265 if (of_property_read_u8_array(np, "ceva,p0-comwake-params",
266 (u8 *)&cevapriv->pp3c[0], 4) < 0) {
267 dev_warn(dev, "ceva,p0-comwake-params property not defined\n");
268 return -EINVAL;
269 }
270
271 if (of_property_read_u8_array(np, "ceva,p1-comwake-params",
272 (u8 *)&cevapriv->pp3c[1], 4) < 0) {
273 dev_warn(dev, "ceva,p1-comwake-params property not defined\n");
274 return -EINVAL;
275 }
276
277
278 if (of_property_read_u8_array(np, "ceva,p0-burst-params",
279 (u8 *)&cevapriv->pp4c[0], 4) < 0) {
280 dev_warn(dev, "ceva,p0-burst-params property not defined\n");
281 return -EINVAL;
282 }
283
284 if (of_property_read_u8_array(np, "ceva,p1-burst-params",
285 (u8 *)&cevapriv->pp4c[1], 4) < 0) {
286 dev_warn(dev, "ceva,p1-burst-params property not defined\n");
287 return -EINVAL;
288 }
289
290
291 if (of_property_read_u16_array(np, "ceva,p0-retry-params",
292 (u16 *)&cevapriv->pp5c[0], 2) < 0) {
293 dev_warn(dev, "ceva,p0-retry-params property not defined\n");
294 return -EINVAL;
295 }
296
297 if (of_property_read_u16_array(np, "ceva,p1-retry-params",
298 (u16 *)&cevapriv->pp5c[1], 2) < 0) {
299 dev_warn(dev, "ceva,p1-retry-params property not defined\n");
300 return -EINVAL;
301 }
302
303
304
305
306
307 attr = device_get_dma_attr(dev);
308 cevapriv->is_cci_enabled = (attr == DEV_DMA_COHERENT);
309
310 hpriv->plat_data = cevapriv;
311
312
313 ahci_ceva_setup(hpriv);
314
315 rc = ahci_platform_init_host(pdev, hpriv, &ahci_ceva_port_info,
316 &ahci_platform_sht);
317 if (rc)
318 goto disable_resources;
319
320 return 0;
321
322disable_resources:
323 ahci_platform_disable_resources(hpriv);
324 return rc;
325}
326
327static int __maybe_unused ceva_ahci_suspend(struct device *dev)
328{
329 return ahci_platform_suspend(dev);
330}
331
332static int __maybe_unused ceva_ahci_resume(struct device *dev)
333{
334 struct ata_host *host = dev_get_drvdata(dev);
335 struct ahci_host_priv *hpriv = host->private_data;
336 int rc;
337
338 rc = ahci_platform_enable_resources(hpriv);
339 if (rc)
340 return rc;
341
342
343 ahci_ceva_setup(hpriv);
344
345 rc = ahci_platform_resume_host(dev);
346 if (rc)
347 goto disable_resources;
348
349
350 pm_runtime_disable(dev);
351 pm_runtime_set_active(dev);
352 pm_runtime_enable(dev);
353
354 return 0;
355
356disable_resources:
357 ahci_platform_disable_resources(hpriv);
358
359 return rc;
360}
361
362static SIMPLE_DEV_PM_OPS(ahci_ceva_pm_ops, ceva_ahci_suspend, ceva_ahci_resume);
363
364static const struct of_device_id ceva_ahci_of_match[] = {
365 { .compatible = "ceva,ahci-1v84" },
366 {},
367};
368MODULE_DEVICE_TABLE(of, ceva_ahci_of_match);
369
370static struct platform_driver ceva_ahci_driver = {
371 .probe = ceva_ahci_probe,
372 .remove = ata_platform_remove_one,
373 .driver = {
374 .name = DRV_NAME,
375 .of_match_table = ceva_ahci_of_match,
376 .pm = &ahci_ceva_pm_ops,
377 },
378};
379module_platform_driver(ceva_ahci_driver);
380
381MODULE_DESCRIPTION("CEVA AHCI SATA platform driver");
382MODULE_AUTHOR("Xilinx Inc.");
383MODULE_LICENSE("GPL v2");
384