Hello.
On 04/20/2012 06:38 PM, Viresh Kumar wrote:
On many architectures, drivers are supposed to prepare/unprepare&
enable/disable functional clock of device. This patch adds clock support for
ahci_platform.
Signed-off-by: Viresh Kumar<viresh.kumar@xxxxxx>
[...]
diff --git a/drivers/ata/ahci_platform.c b/drivers/ata/ahci_platform.c
index 9e419e1..730e214 100644
--- a/drivers/ata/ahci_platform.c
+++ b/drivers/ata/ahci_platform.c
@@ -12,6 +12,7 @@
* any later version.
*/
+#include<linux/clk.h>
#include<linux/kernel.h>
#include<linux/gfp.h>
#include<linux/module.h>
@@ -117,6 +118,20 @@ static int __init ahci_probe(struct platform_device *pdev)
return -ENOMEM;
}
+#ifdef CONFIG_HAVE_CLK
+ hpriv->clk = clk_get(dev, NULL);
+ if (IS_ERR(hpriv->clk)) {
+ dev_err(dev, "Clock not found\n");
+ return PTR_ERR(hpriv->clk);
+ }
+
+ rc = clk_prepare_enable(hpriv->clk);
+ if (rc) {
+ dev_err(dev, "clock prepare enable failed");
+ goto free_clk;
+ }
+#endif
+
/*
* Some platforms might need to prepare for mmio region access,
* which could be done in the following init call. So, the mmio
[...]
@@ -190,12 +205,18 @@ static int __init ahci_probe(struct platform_device *pdev)
rc = ata_host_activate(host, irq, ahci_interrupt, IRQF_SHARED,
&ahci_platform_sht);
if (rc)
- goto err0;
+ goto pdata_exit;
return 0;
-err0:
+pdata_exit:
if (pdata&& pdata->exit)
pdata->exit(dev);
+disable_unprepare_clk:
+#ifdef CONFIG_HAVE_CLK
+ clk_disable_unprepare(hpriv->clk);
+free_clk:
+ clk_put(hpriv->clk);
+#endif
return rc;
}
@@ -204,12 +225,19 @@ static int __devexit ahci_remove(struct platform_device *pdev)
struct device *dev =&pdev->dev;
struct ahci_platform_data *pdata = dev_get_platdata(dev);
struct ata_host *host = dev_get_drvdata(dev);
+#ifdef CONFIG_HAVE_CLK
+ struct ahci_host_priv *hpriv = host->private_data;
+#endif
ata_host_detach(host);
if (pdata&& pdata->exit)
pdata->exit(dev);
+#ifdef CONFIG_HAVE_CLK
+ clk_disable_unprepare(hpriv->clk);
+ clk_put(hpriv->clk);
+#endif
return 0;
}
@@ -244,6 +272,11 @@ static int ahci_suspend(struct device *dev)
if (pdata&& pdata->suspend)
return pdata->suspend(dev);
+
+#ifdef CONFIG_HAVE_CLK
+ clk_disable_unprepare(hpriv->clk);
+#endif
+
return 0;
}
@@ -253,16 +286,26 @@ static int ahci_resume(struct device *dev)
struct ata_host *host = dev_get_drvdata(dev);
int rc;
+#ifdef CONFIG_HAVE_CLK
+ struct ahci_host_priv *hpriv = host->private_data;
+
+ rc = clk_prepare_enable(hpriv->clk);
+ if (rc) {
+ dev_err(dev, "clock prepare enable failed");
+ return rc;
+ }
+#endif
+
[...]
@@ -270,6 +313,12 @@ static int ahci_resume(struct device *dev)
ata_host_resume(host);
return 0;
+
+disable_unprepare_clk:
+#ifdef CONFIG_HAVE_CLK
+ clk_disable_unprepare(hpriv->clk);
+#endif
Can't we have empty inlines for !defined(CONFIG_HAVE_CLK) case in
<linux/clk.h>. Otherwise there's too much uglye #ifdef'ery.
MBR, Sergei
--
To unsubscribe from this list: send the line "unsubscribe linux-ide" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
