mmc: sdhci-of-arasan: keep consistent with upstream
[firefly-linux-kernel-4.4.55.git] / drivers / mmc / host / sdhci-of-arasan.c
1 /*
2  * Arasan Secure Digital Host Controller Interface.
3  * Copyright (C) 2011 - 2012 Michal Simek <monstr@monstr.eu>
4  * Copyright (c) 2012 Wind River Systems, Inc.
5  * Copyright (C) 2013 Pengutronix e.K.
6  * Copyright (C) 2013 Xilinx Inc.
7  *
8  * Based on sdhci-of-esdhc.c
9  *
10  * Copyright (c) 2007 Freescale Semiconductor, Inc.
11  * Copyright (c) 2009 MontaVista Software, Inc.
12  *
13  * Authors: Xiaobo Xie <X.Xie@freescale.com>
14  *          Anton Vorontsov <avorontsov@ru.mvista.com>
15  *
16  * This program is free software; you can redistribute it and/or modify
17  * it under the terms of the GNU General Public License as published by
18  * the Free Software Foundation; either version 2 of the License, or (at
19  * your option) any later version.
20  */
21
22 #include <linux/module.h>
23 #include <linux/of_device.h>
24 #include <linux/phy/phy.h>
25 #include "sdhci-pltfm.h"
26
27 #define SDHCI_ARASAN_CLK_CTRL_OFFSET    0x2c
28
29 #define CLK_CTRL_TIMEOUT_SHIFT          16
30 #define CLK_CTRL_TIMEOUT_MASK           (0xf << CLK_CTRL_TIMEOUT_SHIFT)
31 #define CLK_CTRL_TIMEOUT_MIN_EXP        13
32
33 /**
34  * struct sdhci_arasan_data
35  * @clk_ahb:    Pointer to the AHB clock
36  * @phy: Pointer to the generic phy
37  */
38 struct sdhci_arasan_data {
39         struct clk      *clk_ahb;
40         struct phy      *phy;
41 };
42
43 static unsigned int sdhci_arasan_get_timeout_clock(struct sdhci_host *host)
44 {
45         u32 div;
46         unsigned long freq;
47         struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
48
49         div = readl(host->ioaddr + SDHCI_ARASAN_CLK_CTRL_OFFSET);
50         div = (div & CLK_CTRL_TIMEOUT_MASK) >> CLK_CTRL_TIMEOUT_SHIFT;
51
52         freq = clk_get_rate(pltfm_host->clk);
53         freq /= 1 << (CLK_CTRL_TIMEOUT_MIN_EXP + div);
54
55         return freq;
56 }
57
58 static struct sdhci_ops sdhci_arasan_ops = {
59         .set_clock = sdhci_set_clock,
60         .get_max_clock = sdhci_pltfm_clk_get_max_clock,
61         .get_timeout_clock = sdhci_arasan_get_timeout_clock,
62         .set_bus_width = sdhci_set_bus_width,
63         .reset = sdhci_reset,
64         .set_uhs_signaling = sdhci_set_uhs_signaling,
65 };
66
67 static struct sdhci_pltfm_data sdhci_arasan_pdata = {
68         .ops = &sdhci_arasan_ops,
69         .quirks = SDHCI_QUIRK_CAP_CLOCK_BASE_BROKEN,
70         .quirks2 = SDHCI_QUIRK2_PRESET_VALUE_BROKEN |
71                         SDHCI_QUIRK2_CLOCK_DIV_ZERO_BROKEN,
72 };
73
74 #ifdef CONFIG_PM_SLEEP
75 /**
76  * sdhci_arasan_suspend - Suspend method for the driver
77  * @dev:        Address of the device structure
78  * Return: 0 on success and error value on error
79  *
80  * Put the device in a low power state.
81  */
82 static int sdhci_arasan_suspend(struct device *dev)
83 {
84         struct platform_device *pdev = to_platform_device(dev);
85         struct sdhci_host *host = platform_get_drvdata(pdev);
86         struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
87         struct sdhci_arasan_data *sdhci_arasan = pltfm_host->priv;
88         int ret;
89
90         ret = sdhci_suspend_host(host);
91         if (ret)
92                 return ret;
93
94         if (!IS_ERR(sdhci_arasan->phy)) {
95                 ret = phy_power_off(sdhci_arasan->phy);
96                 if (ret) {
97                         dev_err(dev, "Cannot power off phy.\n");
98                         sdhci_resume_host(host);
99                         return ret;
100                 }
101         }
102
103         clk_disable(pltfm_host->clk);
104         clk_disable(sdhci_arasan->clk_ahb);
105
106         return 0;
107 }
108
109 /**
110  * sdhci_arasan_resume - Resume method for the driver
111  * @dev:        Address of the device structure
112  * Return: 0 on success and error value on error
113  *
114  * Resume operation after suspend
115  */
116 static int sdhci_arasan_resume(struct device *dev)
117 {
118         struct platform_device *pdev = to_platform_device(dev);
119         struct sdhci_host *host = platform_get_drvdata(pdev);
120         struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
121         struct sdhci_arasan_data *sdhci_arasan = pltfm_host->priv;
122         int ret;
123
124         ret = clk_enable(sdhci_arasan->clk_ahb);
125         if (ret) {
126                 dev_err(dev, "Cannot enable AHB clock.\n");
127                 return ret;
128         }
129
130         ret = clk_enable(pltfm_host->clk);
131         if (ret) {
132                 dev_err(dev, "Cannot enable SD clock.\n");
133                 return ret;
134         }
135
136         if (!IS_ERR(sdhci_arasan->phy)) {
137                 ret = phy_power_on(sdhci_arasan->phy);
138                 if (ret) {
139                         dev_err(dev, "Cannot power on phy.\n");
140                         return ret;
141                 }
142         }
143
144         return sdhci_resume_host(host);
145 }
146 #endif /* ! CONFIG_PM_SLEEP */
147
148 static SIMPLE_DEV_PM_OPS(sdhci_arasan_dev_pm_ops, sdhci_arasan_suspend,
149                          sdhci_arasan_resume);
150
151 static int sdhci_arasan_probe(struct platform_device *pdev)
152 {
153         int ret;
154         struct clk *clk_xin;
155         struct sdhci_host *host;
156         struct sdhci_pltfm_host *pltfm_host;
157         struct sdhci_arasan_data *sdhci_arasan;
158
159         sdhci_arasan = devm_kzalloc(&pdev->dev, sizeof(*sdhci_arasan),
160                         GFP_KERNEL);
161         if (!sdhci_arasan)
162                 return -ENOMEM;
163
164         sdhci_arasan->clk_ahb = devm_clk_get(&pdev->dev, "clk_ahb");
165         if (IS_ERR(sdhci_arasan->clk_ahb)) {
166                 dev_err(&pdev->dev, "clk_ahb clock not found.\n");
167                 ret = PTR_ERR(sdhci_arasan->clk_ahb);
168                 goto err_pltfm_free;
169         }
170
171         clk_xin = devm_clk_get(&pdev->dev, "clk_xin");
172         if (IS_ERR(clk_xin)) {
173                 dev_err(&pdev->dev, "clk_xin clock not found.\n");
174                 ret = PTR_ERR(clk_xin);
175                 goto err_pltfm_free;
176         }
177
178         ret = clk_prepare_enable(sdhci_arasan->clk_ahb);
179         if (ret) {
180                 dev_err(&pdev->dev, "Unable to enable AHB clock.\n");
181                 goto err_pltfm_free;
182         }
183
184         ret = clk_prepare_enable(clk_xin);
185         if (ret) {
186                 dev_err(&pdev->dev, "Unable to enable SD clock.\n");
187                 goto clk_dis_ahb;
188         }
189
190         host = sdhci_pltfm_init(pdev, &sdhci_arasan_pdata, 0);
191         if (IS_ERR(host)) {
192                 ret = PTR_ERR(host);
193                 goto clk_disable_all;
194         }
195
196         if (of_device_is_compatible(pdev->dev.of_node, "arasan,sdhci-4.9a")) {
197                 host->quirks |= SDHCI_QUIRK_NO_HISPD_BIT;
198                 host->quirks2 |= SDHCI_QUIRK2_HOST_NO_CMD23;
199         }
200
201         sdhci_get_of_property(pdev);
202         pltfm_host = sdhci_priv(host);
203         pltfm_host->priv = sdhci_arasan;
204         pltfm_host->clk = clk_xin;
205
206         ret = mmc_of_parse(host->mmc);
207         if (ret) {
208                 dev_err(&pdev->dev, "parsing dt failed (%u)\n", ret);
209                 goto clk_disable_all;
210         }
211
212         sdhci_arasan->phy = ERR_PTR(-ENODEV);
213         if (of_device_is_compatible(pdev->dev.of_node,
214                                     "arasan,sdhci-5.1")) {
215                 sdhci_arasan->phy = devm_phy_get(&pdev->dev,
216                                                  "phy_arasan");
217                 if (IS_ERR(sdhci_arasan->phy)) {
218                         ret = PTR_ERR(sdhci_arasan->phy);
219                         dev_err(&pdev->dev, "No phy for arasan,sdhci-5.1.\n");
220                         goto clk_disable_all;
221                 }
222
223                 ret = phy_init(sdhci_arasan->phy);
224                 if (ret < 0) {
225                         dev_err(&pdev->dev, "phy_init err.\n");
226                         goto clk_disable_all;
227                 }
228
229                 ret = phy_power_on(sdhci_arasan->phy);
230                 if (ret < 0) {
231                         dev_err(&pdev->dev, "phy_power_on err.\n");
232                         goto err_phy_power;
233                 }
234         }
235
236         ret = sdhci_add_host(host);
237         if (ret)
238                 goto err_add_host;
239
240         return 0;
241
242 err_add_host:
243         if (!IS_ERR(sdhci_arasan->phy))
244                 phy_power_off(sdhci_arasan->phy);
245 err_phy_power:
246         if (!IS_ERR(sdhci_arasan->phy))
247                 phy_exit(sdhci_arasan->phy);
248 clk_disable_all:
249         clk_disable_unprepare(clk_xin);
250 clk_dis_ahb:
251         clk_disable_unprepare(sdhci_arasan->clk_ahb);
252 err_pltfm_free:
253         sdhci_pltfm_free(pdev);
254         return ret;
255 }
256
257 static int sdhci_arasan_remove(struct platform_device *pdev)
258 {
259         int ret;
260         struct sdhci_host *host = platform_get_drvdata(pdev);
261         struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);
262         struct sdhci_arasan_data *sdhci_arasan = pltfm_host->priv;
263
264         if (!IS_ERR(sdhci_arasan->phy)) {
265                 phy_power_off(sdhci_arasan->phy);
266                 phy_exit(sdhci_arasan->phy);
267         }
268
269         ret = sdhci_pltfm_unregister(pdev);
270
271         clk_disable_unprepare(sdhci_arasan->clk_ahb);
272
273         return ret;
274 }
275
276 static const struct of_device_id sdhci_arasan_of_match[] = {
277         { .compatible = "arasan,sdhci-8.9a" },
278         { .compatible = "arasan,sdhci-5.1" },
279         { .compatible = "arasan,sdhci-4.9a" },
280         { }
281 };
282 MODULE_DEVICE_TABLE(of, sdhci_arasan_of_match);
283
284 static struct platform_driver sdhci_arasan_driver = {
285         .driver = {
286                 .name = "sdhci-arasan",
287                 .of_match_table = sdhci_arasan_of_match,
288                 .pm = &sdhci_arasan_dev_pm_ops,
289         },
290         .probe = sdhci_arasan_probe,
291         .remove = sdhci_arasan_remove,
292 };
293
294 module_platform_driver(sdhci_arasan_driver);
295
296 MODULE_DESCRIPTION("Driver for the Arasan SDHCI Controller");
297 MODULE_AUTHOR("Soeren Brinkmann <soren.brinkmann@xilinx.com>");
298 MODULE_LICENSE("GPL");