Commit | Line | Data |
---|---|---|
3e0a4e85 | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
766a2d97 BN |
2 | /* |
3 | * Broadcom SATA3 AHCI Controller Driver | |
4 | * | |
5 | * Copyright © 2009-2015 Broadcom Corporation | |
766a2d97 BN |
6 | */ |
7 | ||
8 | #include <linux/ahci_platform.h> | |
9 | #include <linux/compiler.h> | |
10 | #include <linux/device.h> | |
11 | #include <linux/init.h> | |
12 | #include <linux/interrupt.h> | |
13 | #include <linux/io.h> | |
14 | #include <linux/kernel.h> | |
15 | #include <linux/libata.h> | |
16 | #include <linux/module.h> | |
17 | #include <linux/of.h> | |
18 | #include <linux/platform_device.h> | |
2b2c47d9 | 19 | #include <linux/reset.h> |
766a2d97 BN |
20 | #include <linux/string.h> |
21 | ||
22 | #include "ahci.h" | |
23 | ||
24 | #define DRV_NAME "brcm-ahci" | |
25 | ||
26 | #define SATA_TOP_CTRL_VERSION 0x0 | |
27 | #define SATA_TOP_CTRL_BUS_CTRL 0x4 | |
28 | #define MMIO_ENDIAN_SHIFT 0 /* CPU->AHCI */ | |
29 | #define DMADESC_ENDIAN_SHIFT 2 /* AHCI->DDR */ | |
30 | #define DMADATA_ENDIAN_SHIFT 4 /* AHCI->DDR */ | |
31 | #define PIODATA_ENDIAN_SHIFT 6 | |
32 | #define ENDIAN_SWAP_NONE 0 | |
33 | #define ENDIAN_SWAP_FULL 2 | |
766a2d97 BN |
34 | #define SATA_TOP_CTRL_TP_CTRL 0x8 |
35 | #define SATA_TOP_CTRL_PHY_CTRL 0xc | |
36 | #define SATA_TOP_CTRL_PHY_CTRL_1 0x0 | |
37 | #define SATA_TOP_CTRL_1_PHY_DEFAULT_POWER_STATE BIT(14) | |
38 | #define SATA_TOP_CTRL_PHY_CTRL_2 0x4 | |
39 | #define SATA_TOP_CTRL_2_SW_RST_MDIOREG BIT(0) | |
40 | #define SATA_TOP_CTRL_2_SW_RST_OOB BIT(1) | |
41 | #define SATA_TOP_CTRL_2_SW_RST_RX BIT(2) | |
42 | #define SATA_TOP_CTRL_2_SW_RST_TX BIT(3) | |
43 | #define SATA_TOP_CTRL_2_PHY_GLOBAL_RESET BIT(14) | |
44 | #define SATA_TOP_CTRL_PHY_OFFS 0x8 | |
45 | #define SATA_TOP_MAX_PHYS 2 | |
766a2d97 | 46 | |
6863caaf DP |
47 | #define SATA_FIRST_PORT_CTRL 0x700 |
48 | #define SATA_NEXT_PORT_CTRL_OFFSET 0x80 | |
49 | #define SATA_PORT_PCTRL6(reg_base) (reg_base + 0x18) | |
50 | ||
766a2d97 BN |
51 | /* On big-endian MIPS, buses are reversed to big endian, so switch them back */ |
52 | #if defined(CONFIG_MIPS) && defined(__BIG_ENDIAN) | |
53 | #define DATA_ENDIAN 2 /* AHCI->DDR inbound accesses */ | |
54 | #define MMIO_ENDIAN 2 /* CPU->AHCI outbound accesses */ | |
55 | #else | |
56 | #define DATA_ENDIAN 0 | |
57 | #define MMIO_ENDIAN 0 | |
58 | #endif | |
59 | ||
60 | #define BUS_CTRL_ENDIAN_CONF \ | |
61 | ((DATA_ENDIAN << DMADATA_ENDIAN_SHIFT) | \ | |
62 | (DATA_ENDIAN << DMADESC_ENDIAN_SHIFT) | \ | |
63 | (MMIO_ENDIAN << MMIO_ENDIAN_SHIFT)) | |
64 | ||
36fffd6a FF |
65 | #define BUS_CTRL_ENDIAN_NSP_CONF \ |
66 | (0x02 << DMADATA_ENDIAN_SHIFT | 0x02 << DMADESC_ENDIAN_SHIFT) | |
67 | ||
68 | #define BUS_CTRL_ENDIAN_CONF_MASK \ | |
69 | (0x3 << MMIO_ENDIAN_SHIFT | 0x3 << DMADESC_ENDIAN_SHIFT | \ | |
70 | 0x3 << DMADATA_ENDIAN_SHIFT | 0x3 << PIODATA_ENDIAN_SHIFT) | |
71 | ||
3ee2e6dc YRDR |
72 | enum brcm_ahci_version { |
73 | BRCM_SATA_BCM7425 = 1, | |
74 | BRCM_SATA_BCM7445, | |
75 | BRCM_SATA_NSP, | |
c345ec6a | 76 | BRCM_SATA_BCM7216, |
3ee2e6dc YRDR |
77 | }; |
78 | ||
7de32445 | 79 | enum brcm_ahci_quirks { |
1a3d78cb | 80 | BRCM_AHCI_QUIRK_SKIP_PHY_ENABLE = BIT(0), |
7de32445 JS |
81 | }; |
82 | ||
766a2d97 BN |
83 | struct brcm_ahci_priv { |
84 | struct device *dev; | |
85 | void __iomem *top_ctrl; | |
86 | u32 port_mask; | |
7de32445 | 87 | u32 quirks; |
3ee2e6dc | 88 | enum brcm_ahci_version version; |
2b2c47d9 | 89 | struct reset_control *rcdev; |
766a2d97 BN |
90 | }; |
91 | ||
766a2d97 BN |
92 | static inline u32 brcm_sata_readreg(void __iomem *addr) |
93 | { | |
94 | /* | |
95 | * MIPS endianness is configured by boot strap, which also reverses all | |
96 | * bus endianness (i.e., big-endian CPU + big endian bus ==> native | |
97 | * endian I/O). | |
98 | * | |
99 | * Other architectures (e.g., ARM) either do not support big endian, or | |
100 | * else leave I/O in little endian mode. | |
101 | */ | |
f9114d35 | 102 | if (IS_ENABLED(CONFIG_MIPS) && IS_ENABLED(CONFIG_CPU_BIG_ENDIAN)) |
766a2d97 BN |
103 | return __raw_readl(addr); |
104 | else | |
105 | return readl_relaxed(addr); | |
106 | } | |
107 | ||
108 | static inline void brcm_sata_writereg(u32 val, void __iomem *addr) | |
109 | { | |
110 | /* See brcm_sata_readreg() comments */ | |
f9114d35 | 111 | if (IS_ENABLED(CONFIG_MIPS) && IS_ENABLED(CONFIG_CPU_BIG_ENDIAN)) |
766a2d97 BN |
112 | __raw_writel(val, addr); |
113 | else | |
114 | writel_relaxed(val, addr); | |
115 | } | |
116 | ||
6863caaf DP |
117 | static void brcm_sata_alpm_init(struct ahci_host_priv *hpriv) |
118 | { | |
119 | struct brcm_ahci_priv *priv = hpriv->plat_data; | |
da8fa9cc | 120 | u32 port_ctrl, host_caps; |
6863caaf DP |
121 | int i; |
122 | ||
123 | /* Enable support for ALPM */ | |
6863caaf | 124 | host_caps = readl(hpriv->mmio + HOST_CAP); |
da8fa9cc DB |
125 | if (!(host_caps & HOST_CAP_ALPM)) |
126 | hpriv->flags |= AHCI_HFLAG_YES_ALPM; | |
6863caaf DP |
127 | |
128 | /* | |
129 | * Adjust timeout to allow PLL sufficient time to lock while waking | |
130 | * up from slumber mode. | |
131 | */ | |
132 | for (i = 0, port_ctrl = SATA_FIRST_PORT_CTRL; | |
133 | i < SATA_TOP_MAX_PHYS; | |
134 | i++, port_ctrl += SATA_NEXT_PORT_CTRL_OFFSET) { | |
135 | if (priv->port_mask & BIT(i)) | |
136 | writel(0xff1003fc, | |
137 | hpriv->mmio + SATA_PORT_PCTRL6(port_ctrl)); | |
138 | } | |
139 | } | |
140 | ||
766a2d97 BN |
141 | static void brcm_sata_phy_enable(struct brcm_ahci_priv *priv, int port) |
142 | { | |
143 | void __iomem *phyctrl = priv->top_ctrl + SATA_TOP_CTRL_PHY_CTRL + | |
144 | (port * SATA_TOP_CTRL_PHY_OFFS); | |
145 | void __iomem *p; | |
146 | u32 reg; | |
147 | ||
b46f79bc JS |
148 | if (priv->quirks & BRCM_AHCI_QUIRK_SKIP_PHY_ENABLE) |
149 | return; | |
150 | ||
766a2d97 BN |
151 | /* clear PHY_DEFAULT_POWER_STATE */ |
152 | p = phyctrl + SATA_TOP_CTRL_PHY_CTRL_1; | |
153 | reg = brcm_sata_readreg(p); | |
154 | reg &= ~SATA_TOP_CTRL_1_PHY_DEFAULT_POWER_STATE; | |
155 | brcm_sata_writereg(reg, p); | |
156 | ||
157 | /* reset the PHY digital logic */ | |
158 | p = phyctrl + SATA_TOP_CTRL_PHY_CTRL_2; | |
159 | reg = brcm_sata_readreg(p); | |
160 | reg &= ~(SATA_TOP_CTRL_2_SW_RST_MDIOREG | SATA_TOP_CTRL_2_SW_RST_OOB | | |
161 | SATA_TOP_CTRL_2_SW_RST_RX); | |
162 | reg |= SATA_TOP_CTRL_2_SW_RST_TX; | |
163 | brcm_sata_writereg(reg, p); | |
164 | reg = brcm_sata_readreg(p); | |
165 | reg |= SATA_TOP_CTRL_2_PHY_GLOBAL_RESET; | |
166 | brcm_sata_writereg(reg, p); | |
167 | reg = brcm_sata_readreg(p); | |
168 | reg &= ~SATA_TOP_CTRL_2_PHY_GLOBAL_RESET; | |
169 | brcm_sata_writereg(reg, p); | |
170 | (void)brcm_sata_readreg(p); | |
171 | } | |
172 | ||
173 | static void brcm_sata_phy_disable(struct brcm_ahci_priv *priv, int port) | |
174 | { | |
175 | void __iomem *phyctrl = priv->top_ctrl + SATA_TOP_CTRL_PHY_CTRL + | |
176 | (port * SATA_TOP_CTRL_PHY_OFFS); | |
177 | void __iomem *p; | |
178 | u32 reg; | |
179 | ||
b46f79bc JS |
180 | if (priv->quirks & BRCM_AHCI_QUIRK_SKIP_PHY_ENABLE) |
181 | return; | |
182 | ||
766a2d97 BN |
183 | /* power-off the PHY digital logic */ |
184 | p = phyctrl + SATA_TOP_CTRL_PHY_CTRL_2; | |
185 | reg = brcm_sata_readreg(p); | |
186 | reg |= (SATA_TOP_CTRL_2_SW_RST_MDIOREG | SATA_TOP_CTRL_2_SW_RST_OOB | | |
187 | SATA_TOP_CTRL_2_SW_RST_RX | SATA_TOP_CTRL_2_SW_RST_TX | | |
188 | SATA_TOP_CTRL_2_PHY_GLOBAL_RESET); | |
189 | brcm_sata_writereg(reg, p); | |
190 | ||
191 | /* set PHY_DEFAULT_POWER_STATE */ | |
192 | p = phyctrl + SATA_TOP_CTRL_PHY_CTRL_1; | |
193 | reg = brcm_sata_readreg(p); | |
194 | reg |= SATA_TOP_CTRL_1_PHY_DEFAULT_POWER_STATE; | |
195 | brcm_sata_writereg(reg, p); | |
196 | } | |
197 | ||
198 | static void brcm_sata_phys_enable(struct brcm_ahci_priv *priv) | |
199 | { | |
200 | int i; | |
201 | ||
202 | for (i = 0; i < SATA_TOP_MAX_PHYS; i++) | |
203 | if (priv->port_mask & BIT(i)) | |
204 | brcm_sata_phy_enable(priv, i); | |
205 | } | |
206 | ||
207 | static void brcm_sata_phys_disable(struct brcm_ahci_priv *priv) | |
208 | { | |
209 | int i; | |
210 | ||
211 | for (i = 0; i < SATA_TOP_MAX_PHYS; i++) | |
212 | if (priv->port_mask & BIT(i)) | |
213 | brcm_sata_phy_disable(priv, i); | |
214 | } | |
215 | ||
c0cdf2ac | 216 | static u32 brcm_ahci_get_portmask(struct ahci_host_priv *hpriv, |
766a2d97 BN |
217 | struct brcm_ahci_priv *priv) |
218 | { | |
766a2d97 BN |
219 | u32 impl; |
220 | ||
c0cdf2ac | 221 | impl = readl(hpriv->mmio + HOST_PORTS_IMPL); |
766a2d97 BN |
222 | |
223 | if (fls(impl) > SATA_TOP_MAX_PHYS) | |
224 | dev_warn(priv->dev, "warning: more ports than PHYs (%#x)\n", | |
225 | impl); | |
226 | else if (!impl) | |
227 | dev_info(priv->dev, "no ports found\n"); | |
228 | ||
766a2d97 BN |
229 | return impl; |
230 | } | |
231 | ||
232 | static void brcm_sata_init(struct brcm_ahci_priv *priv) | |
233 | { | |
3ee2e6dc | 234 | void __iomem *ctrl = priv->top_ctrl + SATA_TOP_CTRL_BUS_CTRL; |
36fffd6a | 235 | u32 data; |
3ee2e6dc | 236 | |
766a2d97 | 237 | /* Configure endianness */ |
36fffd6a FF |
238 | data = brcm_sata_readreg(ctrl); |
239 | data &= ~BUS_CTRL_ENDIAN_CONF_MASK; | |
240 | if (priv->version == BRCM_SATA_NSP) | |
241 | data |= BUS_CTRL_ENDIAN_NSP_CONF; | |
242 | else | |
243 | data |= BUS_CTRL_ENDIAN_CONF; | |
244 | brcm_sata_writereg(data, ctrl); | |
766a2d97 BN |
245 | } |
246 | ||
eb73390a FF |
247 | static unsigned int brcm_ahci_read_id(struct ata_device *dev, |
248 | struct ata_taskfile *tf, u16 *id) | |
249 | { | |
250 | struct ata_port *ap = dev->link->ap; | |
251 | struct ata_host *host = ap->host; | |
252 | struct ahci_host_priv *hpriv = host->private_data; | |
253 | struct brcm_ahci_priv *priv = hpriv->plat_data; | |
254 | void __iomem *mmio = hpriv->mmio; | |
255 | unsigned int err_mask; | |
256 | unsigned long flags; | |
257 | int i, rc; | |
258 | u32 ctl; | |
259 | ||
260 | /* Try to read the device ID and, if this fails, proceed with the | |
261 | * recovery sequence below | |
262 | */ | |
263 | err_mask = ata_do_dev_read_id(dev, tf, id); | |
264 | if (likely(!err_mask)) | |
265 | return err_mask; | |
266 | ||
267 | /* Disable host interrupts */ | |
268 | spin_lock_irqsave(&host->lock, flags); | |
269 | ctl = readl(mmio + HOST_CTL); | |
270 | ctl &= ~HOST_IRQ_EN; | |
271 | writel(ctl, mmio + HOST_CTL); | |
272 | readl(mmio + HOST_CTL); /* flush */ | |
273 | spin_unlock_irqrestore(&host->lock, flags); | |
274 | ||
275 | /* Perform the SATA PHY reset sequence */ | |
276 | brcm_sata_phy_disable(priv, ap->port_no); | |
277 | ||
bf0e5013 FF |
278 | /* Reset the SATA clock */ |
279 | ahci_platform_disable_clks(hpriv); | |
280 | msleep(10); | |
281 | ||
282 | ahci_platform_enable_clks(hpriv); | |
283 | msleep(10); | |
284 | ||
eb73390a FF |
285 | /* Bring the PHY back on */ |
286 | brcm_sata_phy_enable(priv, ap->port_no); | |
287 | ||
288 | /* Re-initialize and calibrate the PHY */ | |
289 | for (i = 0; i < hpriv->nports; i++) { | |
290 | rc = phy_init(hpriv->phys[i]); | |
291 | if (rc) | |
292 | goto disable_phys; | |
293 | ||
294 | rc = phy_calibrate(hpriv->phys[i]); | |
295 | if (rc) { | |
296 | phy_exit(hpriv->phys[i]); | |
297 | goto disable_phys; | |
298 | } | |
299 | } | |
300 | ||
301 | /* Re-enable host interrupts */ | |
302 | spin_lock_irqsave(&host->lock, flags); | |
303 | ctl = readl(mmio + HOST_CTL); | |
304 | ctl |= HOST_IRQ_EN; | |
305 | writel(ctl, mmio + HOST_CTL); | |
306 | readl(mmio + HOST_CTL); /* flush */ | |
307 | spin_unlock_irqrestore(&host->lock, flags); | |
308 | ||
309 | return ata_do_dev_read_id(dev, tf, id); | |
310 | ||
311 | disable_phys: | |
312 | while (--i >= 0) { | |
313 | phy_power_off(hpriv->phys[i]); | |
314 | phy_exit(hpriv->phys[i]); | |
315 | } | |
316 | ||
317 | return AC_ERR_OTHER; | |
318 | } | |
319 | ||
320 | static void brcm_ahci_host_stop(struct ata_host *host) | |
321 | { | |
322 | struct ahci_host_priv *hpriv = host->private_data; | |
323 | ||
324 | ahci_platform_disable_resources(hpriv); | |
325 | } | |
326 | ||
327 | static struct ata_port_operations ahci_brcm_platform_ops = { | |
328 | .inherits = &ahci_ops, | |
329 | .host_stop = brcm_ahci_host_stop, | |
330 | .read_id = brcm_ahci_read_id, | |
331 | }; | |
332 | ||
333 | static const struct ata_port_info ahci_brcm_port_info = { | |
334 | .flags = AHCI_FLAG_COMMON | ATA_FLAG_NO_DIPM, | |
335 | .link_flags = ATA_LFLAG_NO_DB_DELAY, | |
336 | .pio_mask = ATA_PIO4, | |
337 | .udma_mask = ATA_UDMA6, | |
338 | .port_ops = &ahci_brcm_platform_ops, | |
339 | }; | |
340 | ||
766a2d97 BN |
341 | static int brcm_ahci_suspend(struct device *dev) |
342 | { | |
343 | struct ata_host *host = dev_get_drvdata(dev); | |
344 | struct ahci_host_priv *hpriv = host->private_data; | |
345 | struct brcm_ahci_priv *priv = hpriv->plat_data; | |
3c696ac4 | 346 | int ret; |
766a2d97 | 347 | |
766a2d97 | 348 | brcm_sata_phys_disable(priv); |
c0cdf2ac | 349 | |
ed87ad19 AB |
350 | if (IS_ENABLED(CONFIG_PM_SLEEP)) |
351 | ret = ahci_platform_suspend(dev); | |
352 | else | |
353 | ret = 0; | |
3c696ac4 | 354 | |
272ecd60 FF |
355 | if (priv->version != BRCM_SATA_BCM7216) |
356 | reset_control_assert(priv->rcdev); | |
3c696ac4 FF |
357 | |
358 | return ret; | |
766a2d97 BN |
359 | } |
360 | ||
ed87ad19 | 361 | static int __maybe_unused brcm_ahci_resume(struct device *dev) |
766a2d97 BN |
362 | { |
363 | struct ata_host *host = dev_get_drvdata(dev); | |
364 | struct ahci_host_priv *hpriv = host->private_data; | |
365 | struct brcm_ahci_priv *priv = hpriv->plat_data; | |
3c696ac4 FF |
366 | int ret = 0; |
367 | ||
272ecd60 FF |
368 | if (priv->version == BRCM_SATA_BCM7216) |
369 | ret = reset_control_reset(priv->rcdev); | |
370 | else | |
371 | ret = reset_control_deassert(priv->rcdev); | |
3c696ac4 FF |
372 | if (ret) |
373 | return ret; | |
c0cdf2ac FF |
374 | |
375 | /* Make sure clocks are turned on before re-configuration */ | |
376 | ret = ahci_platform_enable_clks(hpriv); | |
377 | if (ret) | |
378 | return ret; | |
766a2d97 | 379 | |
10340f8d FF |
380 | ret = ahci_platform_enable_regulators(hpriv); |
381 | if (ret) | |
382 | goto out_disable_clks; | |
383 | ||
766a2d97 BN |
384 | brcm_sata_init(priv); |
385 | brcm_sata_phys_enable(priv); | |
6863caaf | 386 | brcm_sata_alpm_init(hpriv); |
c0cdf2ac FF |
387 | |
388 | /* Since we had to enable clocks earlier on, we cannot use | |
389 | * ahci_platform_resume() as-is since a second call to | |
390 | * ahci_platform_enable_resources() would bump up the resources | |
391 | * (regulators, clocks, PHYs) count artificially so we copy the part | |
392 | * after ahci_platform_enable_resources(). | |
393 | */ | |
394 | ret = ahci_platform_enable_phys(hpriv); | |
395 | if (ret) | |
396 | goto out_disable_phys; | |
397 | ||
398 | ret = ahci_platform_resume_host(dev); | |
399 | if (ret) | |
400 | goto out_disable_platform_phys; | |
401 | ||
402 | /* We resumed so update PM runtime state */ | |
403 | pm_runtime_disable(dev); | |
404 | pm_runtime_set_active(dev); | |
405 | pm_runtime_enable(dev); | |
406 | ||
407 | return 0; | |
408 | ||
409 | out_disable_platform_phys: | |
410 | ahci_platform_disable_phys(hpriv); | |
411 | out_disable_phys: | |
412 | brcm_sata_phys_disable(priv); | |
10340f8d FF |
413 | ahci_platform_disable_regulators(hpriv); |
414 | out_disable_clks: | |
c0cdf2ac FF |
415 | ahci_platform_disable_clks(hpriv); |
416 | return ret; | |
766a2d97 BN |
417 | } |
418 | ||
419 | static struct scsi_host_template ahci_platform_sht = { | |
420 | AHCI_SHT(DRV_NAME), | |
421 | }; | |
422 | ||
3ee2e6dc YRDR |
423 | static const struct of_device_id ahci_of_match[] = { |
424 | {.compatible = "brcm,bcm7425-ahci", .data = (void *)BRCM_SATA_BCM7425}, | |
425 | {.compatible = "brcm,bcm7445-ahci", .data = (void *)BRCM_SATA_BCM7445}, | |
fb8506f1 | 426 | {.compatible = "brcm,bcm63138-ahci", .data = (void *)BRCM_SATA_BCM7445}, |
3ee2e6dc | 427 | {.compatible = "brcm,bcm-nsp-ahci", .data = (void *)BRCM_SATA_NSP}, |
c345ec6a | 428 | {.compatible = "brcm,bcm7216-ahci", .data = (void *)BRCM_SATA_BCM7216}, |
3ee2e6dc YRDR |
429 | {}, |
430 | }; | |
431 | MODULE_DEVICE_TABLE(of, ahci_of_match); | |
432 | ||
766a2d97 BN |
433 | static int brcm_ahci_probe(struct platform_device *pdev) |
434 | { | |
3ee2e6dc | 435 | const struct of_device_id *of_id; |
766a2d97 | 436 | struct device *dev = &pdev->dev; |
c345ec6a | 437 | const char *reset_name = NULL; |
766a2d97 BN |
438 | struct brcm_ahci_priv *priv; |
439 | struct ahci_host_priv *hpriv; | |
440 | struct resource *res; | |
441 | int ret; | |
442 | ||
443 | priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); | |
444 | if (!priv) | |
445 | return -ENOMEM; | |
3ee2e6dc YRDR |
446 | |
447 | of_id = of_match_node(ahci_of_match, pdev->dev.of_node); | |
448 | if (!of_id) | |
449 | return -ENODEV; | |
450 | ||
451 | priv->version = (enum brcm_ahci_version)of_id->data; | |
766a2d97 BN |
452 | priv->dev = dev; |
453 | ||
454 | res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "top-ctrl"); | |
455 | priv->top_ctrl = devm_ioremap_resource(dev, res); | |
456 | if (IS_ERR(priv->top_ctrl)) | |
457 | return PTR_ERR(priv->top_ctrl); | |
458 | ||
c345ec6a FF |
459 | /* Reset is optional depending on platform and named differently */ |
460 | if (priv->version == BRCM_SATA_BCM7216) | |
461 | reset_name = "rescal"; | |
462 | else | |
463 | reset_name = "ahci"; | |
464 | ||
6fedae3c AB |
465 | priv->rcdev = devm_reset_control_get_optional(&pdev->dev, reset_name); |
466 | if (IS_ERR(priv->rcdev)) | |
467 | return PTR_ERR(priv->rcdev); | |
468 | ||
c0cdf2ac | 469 | hpriv = ahci_platform_get_resources(pdev, 0); |
1a0600d1 FF |
470 | if (IS_ERR(hpriv)) |
471 | return PTR_ERR(hpriv); | |
c0cdf2ac | 472 | |
1a3d78cb FF |
473 | hpriv->plat_data = priv; |
474 | hpriv->flags = AHCI_HFLAG_WAKE_BEFORE_STOP | AHCI_HFLAG_NO_WRITE_TO_RO; | |
475 | ||
476 | switch (priv->version) { | |
477 | case BRCM_SATA_BCM7425: | |
478 | hpriv->flags |= AHCI_HFLAG_DELAY_ENGINE; | |
df561f66 | 479 | fallthrough; |
1a3d78cb FF |
480 | case BRCM_SATA_NSP: |
481 | hpriv->flags |= AHCI_HFLAG_NO_NCQ; | |
482 | priv->quirks |= BRCM_AHCI_QUIRK_SKIP_PHY_ENABLE; | |
483 | break; | |
484 | default: | |
485 | break; | |
486 | } | |
487 | ||
272ecd60 FF |
488 | if (priv->version == BRCM_SATA_BCM7216) |
489 | ret = reset_control_reset(priv->rcdev); | |
490 | else | |
491 | ret = reset_control_deassert(priv->rcdev); | |
1a0600d1 FF |
492 | if (ret) |
493 | return ret; | |
494 | ||
c0cdf2ac FF |
495 | ret = ahci_platform_enable_clks(hpriv); |
496 | if (ret) | |
497 | goto out_reset; | |
498 | ||
10340f8d FF |
499 | ret = ahci_platform_enable_regulators(hpriv); |
500 | if (ret) | |
501 | goto out_disable_clks; | |
502 | ||
c0cdf2ac FF |
503 | /* Must be first so as to configure endianness including that |
504 | * of the standard AHCI register space. | |
505 | */ | |
766a2d97 BN |
506 | brcm_sata_init(priv); |
507 | ||
c0cdf2ac FF |
508 | /* Initializes priv->port_mask which is used below */ |
509 | priv->port_mask = brcm_ahci_get_portmask(hpriv, priv); | |
510 | if (!priv->port_mask) { | |
511 | ret = -ENODEV; | |
10340f8d | 512 | goto out_disable_regulators; |
c0cdf2ac | 513 | } |
766a2d97 | 514 | |
c0cdf2ac | 515 | /* Must be done before ahci_platform_enable_phys() */ |
766a2d97 BN |
516 | brcm_sata_phys_enable(priv); |
517 | ||
6863caaf DP |
518 | brcm_sata_alpm_init(hpriv); |
519 | ||
c0cdf2ac FF |
520 | ret = ahci_platform_enable_phys(hpriv); |
521 | if (ret) | |
522 | goto out_disable_phys; | |
523 | ||
766a2d97 BN |
524 | ret = ahci_platform_init_host(pdev, hpriv, &ahci_brcm_port_info, |
525 | &ahci_platform_sht); | |
526 | if (ret) | |
c0cdf2ac | 527 | goto out_disable_platform_phys; |
766a2d97 BN |
528 | |
529 | dev_info(dev, "Broadcom AHCI SATA3 registered\n"); | |
530 | ||
531 | return 0; | |
c0cdf2ac FF |
532 | |
533 | out_disable_platform_phys: | |
534 | ahci_platform_disable_phys(hpriv); | |
535 | out_disable_phys: | |
536 | brcm_sata_phys_disable(priv); | |
10340f8d FF |
537 | out_disable_regulators: |
538 | ahci_platform_disable_regulators(hpriv); | |
c0cdf2ac FF |
539 | out_disable_clks: |
540 | ahci_platform_disable_clks(hpriv); | |
541 | out_reset: | |
272ecd60 FF |
542 | if (priv->version != BRCM_SATA_BCM7216) |
543 | reset_control_assert(priv->rcdev); | |
c0cdf2ac | 544 | return ret; |
766a2d97 BN |
545 | } |
546 | ||
547 | static int brcm_ahci_remove(struct platform_device *pdev) | |
548 | { | |
549 | struct ata_host *host = dev_get_drvdata(&pdev->dev); | |
550 | struct ahci_host_priv *hpriv = host->private_data; | |
551 | struct brcm_ahci_priv *priv = hpriv->plat_data; | |
552 | int ret; | |
553 | ||
c0cdf2ac FF |
554 | brcm_sata_phys_disable(priv); |
555 | ||
766a2d97 BN |
556 | ret = ata_platform_remove_one(pdev); |
557 | if (ret) | |
558 | return ret; | |
559 | ||
766a2d97 BN |
560 | return 0; |
561 | } | |
562 | ||
7de9b168 FF |
563 | static void brcm_ahci_shutdown(struct platform_device *pdev) |
564 | { | |
565 | int ret; | |
566 | ||
567 | /* All resources releasing happens via devres, but our device, unlike a | |
568 | * proper remove is not disappearing, therefore using | |
569 | * brcm_ahci_suspend() here which does explicit power management is | |
570 | * appropriate. | |
571 | */ | |
572 | ret = brcm_ahci_suspend(&pdev->dev); | |
573 | if (ret) | |
574 | dev_err(&pdev->dev, "failed to shutdown\n"); | |
575 | } | |
576 | ||
766a2d97 BN |
577 | static SIMPLE_DEV_PM_OPS(ahci_brcm_pm_ops, brcm_ahci_suspend, brcm_ahci_resume); |
578 | ||
579 | static struct platform_driver brcm_ahci_driver = { | |
580 | .probe = brcm_ahci_probe, | |
581 | .remove = brcm_ahci_remove, | |
7de9b168 | 582 | .shutdown = brcm_ahci_shutdown, |
766a2d97 BN |
583 | .driver = { |
584 | .name = DRV_NAME, | |
585 | .of_match_table = ahci_of_match, | |
586 | .pm = &ahci_brcm_pm_ops, | |
587 | }, | |
588 | }; | |
589 | module_platform_driver(brcm_ahci_driver); | |
590 | ||
591 | MODULE_DESCRIPTION("Broadcom SATA3 AHCI Controller Driver"); | |
592 | MODULE_AUTHOR("Brian Norris"); | |
593 | MODULE_LICENSE("GPL"); | |
594 | MODULE_ALIAS("platform:sata-brcmstb"); |