[PATCH 3/3] ahci: st: Add support for ST's SATA IP

From: Lee Jones
Date: Mon Feb 17 2014 - 07:57:28 EST


Cc: Tejun Heo <tj@xxxxxxxxxx>
Cc: linux-ide@xxxxxxxxxxxxxxx
Signed-off-by: Lee Jones <lee.jones@xxxxxxxxxx>
---
drivers/ata/Kconfig | 9 ++
drivers/ata/Makefile | 1 +
drivers/ata/ahci_st.c | 275 ++++++++++++++++++++++++++++++++++++++++++++++++++
3 files changed, 285 insertions(+)
create mode 100644 drivers/ata/ahci_st.c

diff --git a/drivers/ata/Kconfig b/drivers/ata/Kconfig
index 4e73772..a0798f3 100644
--- a/drivers/ata/Kconfig
+++ b/drivers/ata/Kconfig
@@ -97,6 +97,15 @@ config SATA_AHCI_PLATFORM

If unsure, say N.

+config SATA_AHCI_ST
+ tristate "ST SATA support"
+ depends on SATA_AHCI_PLATFORM
+ select GENERIC_PHY
+ help
+ This option enables support for ST SATA controller.
+
+ If unsure, say N.
+
config AHCI_IMX
tristate "Freescale i.MX AHCI SATA support"
depends on SATA_AHCI_PLATFORM && MFD_SYSCON
diff --git a/drivers/ata/Makefile b/drivers/ata/Makefile
index 46518c6..3379a7d 100644
--- a/drivers/ata/Makefile
+++ b/drivers/ata/Makefile
@@ -5,6 +5,7 @@ obj-$(CONFIG_ATA) += libata.o
obj-$(CONFIG_SATA_AHCI) += ahci.o libahci.o
obj-$(CONFIG_SATA_ACARD_AHCI) += acard-ahci.o libahci.o
obj-$(CONFIG_SATA_AHCI_PLATFORM) += ahci_platform.o libahci.o
+obj-$(CONFIG_SATA_AHCI_ST) += ahci_st.o
obj-$(CONFIG_SATA_FSL) += sata_fsl.o
obj-$(CONFIG_SATA_INIC162X) += sata_inic162x.o
obj-$(CONFIG_SATA_SIL24) += sata_sil24.o
diff --git a/drivers/ata/ahci_st.c b/drivers/ata/ahci_st.c
new file mode 100644
index 0000000..23342bf
--- /dev/null
+++ b/drivers/ata/ahci_st.c
@@ -0,0 +1,275 @@
+/*
+ * Copyright (C) 2012 STMicroelectronics Limited
+ *
+ * Authors: Francesco Virlinzi <francesco.virlinzi@xxxxxx>
+ * Alexandre Torgue <alexandre.torgue@xxxxxx>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/export.h>
+#include <linux/platform_device.h>
+#include <linux/clk.h>
+#include <linux/of.h>
+#include <linux/ahci_platform.h>
+#include <linux/phy/phy.h>
+#include <linux/reset.h>
+#include <linux/io.h>
+#include <linux/dma-mapping.h>
+
+#define AHCI_OOBR 0xbc
+#define AHCI_OOBR_WE BIT(31)
+#define AHCI_OOBR_CWMIN_SHIFT 24
+#define AHCI_OOBR_CWMAX_SHIFT 16
+#define AHCI_OOBR_CIMIN_SHIFT 8
+#define AHCI_OOBR_CIMAX_SHIFT 0
+
+struct ahci_st_drv_data {
+ struct platform_device *ahci;
+ struct phy *phy;
+ struct reset_control *pwr;
+ struct reset_control *sw_rst;
+ struct reset_control *pwr_rst;
+ void __iomem *mmio;
+ struct clk *clk;
+};
+
+static void ahci_st_configure_oob(void __iomem *mmio)
+{
+ unsigned long old_val, new_val;
+
+ new_val = (0x02 << AHCI_OOBR_CWMIN_SHIFT) |
+ (0x04 << AHCI_OOBR_CWMAX_SHIFT) |
+ (0x08 << AHCI_OOBR_CIMIN_SHIFT) |
+ (0x0C << AHCI_OOBR_CIMAX_SHIFT);
+
+ old_val = readl(mmio + AHCI_OOBR);
+ writel(old_val | AHCI_OOBR_WE, mmio + AHCI_OOBR);
+ writel(new_val | AHCI_OOBR_WE, mmio + AHCI_OOBR);
+ writel(new_val, mmio + AHCI_OOBR);
+}
+
+static int ahci_st_probe_resets(struct platform_device *pdev,
+ struct ahci_st_drv_data *ahci_dev)
+{
+ int err;
+
+ ahci_dev->pwr = devm_reset_control_get(&pdev->dev, "pwr-dwn");
+ if (IS_ERR(ahci_dev->pwr)) {
+ dev_info(&pdev->dev, "power reset control not defined\n");
+ } else {
+ err = reset_control_deassert(ahci_dev->pwr);
+ if (err) {
+ dev_err(&pdev->dev, "unable to bring out of pwrdwn\n");
+ return err;
+ }
+ }
+
+ ahci_dev->sw_rst = devm_reset_control_get(&pdev->dev, "sw-rst");
+ if (IS_ERR(ahci_dev->sw_rst)) {
+ dev_info(&pdev->dev, "soft reset control not defined\n");
+ } else {
+ err = reset_control_deassert(ahci_dev->sw_rst);
+ if (err) {
+ dev_err(&pdev->dev, "unable to bring out of reset\n");
+ return err;
+ }
+ }
+
+ ahci_dev->pwr_rst = devm_reset_control_get(&pdev->dev, "pwr-rst");
+ if (IS_ERR(ahci_dev->pwr_rst))
+ dev_dbg(&pdev->dev, "power soft reset control not defined\n");
+ else {
+ err = reset_control_deassert(ahci_dev->pwr_rst);
+ if (err) {
+ dev_err(&pdev->dev, "unable to bring out of reset\n");
+ return err;
+ }
+ }
+
+ return 0;
+}
+
+static int ahci_st_init(struct device *ahci_dev, void __iomem *mmio)
+{
+ struct platform_device *pdev = to_platform_device(ahci_dev->parent);
+ struct ahci_st_drv_data *drv_data = platform_get_drvdata(pdev);
+ int ret;
+
+ ret = clk_prepare_enable(drv_data->clk);
+ if (ret)
+ return ret;
+
+ ret = phy_init(drv_data->phy);
+ if (ret) {
+ clk_disable_unprepare(drv_data->clk);
+ return ret;
+ }
+
+ drv_data->mmio = mmio;
+ ahci_st_configure_oob(mmio);
+
+ return 0;
+}
+
+static void ahci_st_exit(struct device *ahci_dev)
+{
+ struct platform_device *pdev = to_platform_device(ahci_dev->parent);
+ struct ahci_st_drv_data *drv_data = platform_get_drvdata(pdev);
+ int ret;
+
+ if (drv_data->pwr) {
+ ret = reset_control_assert(drv_data->pwr);
+ if (ret)
+ dev_err(&pdev->dev, "unable to bring out of pwrdwn\n");
+ }
+
+ clk_disable_unprepare(drv_data->clk);
+}
+
+#ifdef CONFIG_PM_SLEEP
+static int ahci_st_suspend(struct device *ahci_dev)
+{
+ struct platform_device *pdev = to_platform_device(ahci_dev->parent);
+ struct ahci_st_drv_data *drv_data = platform_get_drvdata(pdev);
+ int ret;
+
+ if (drv_data->pwr) {
+ ret = reset_control_assert(drv_data->pwr);
+ if (ret) {
+ dev_err(&pdev->dev, "unable to pwrdwn");
+ return ret;
+ }
+ }
+
+ clk_disable_unprepare(drv_data->clk);
+
+ return 0;
+}
+
+static int ahci_st_resume(struct device *ahci_dev)
+{
+ struct platform_device *pdev = to_platform_device(ahci_dev->parent);
+ struct ahci_st_drv_data *drv_data = platform_get_drvdata(pdev);
+ int ret;
+
+ clk_prepare_enable(drv_data->clk);
+
+ if (drv_data->pwr) {
+ ret = reset_control_deassert(drv_data->pwr);
+ if (ret) {
+ dev_err(&pdev->dev, "unable to bring out of pwrdwn\n");
+ return ret;
+ }
+ }
+
+ ahci_st_configure_oob(drv_data->mmio);
+
+ ret = phy_init(drv_data->phy);
+ if (ret)
+ return ret;
+
+ if (drv_data->sw_rst) {
+ ret = reset_control_deassert(drv_data->sw_rst);
+ if (ret) {
+ dev_err(&pdev->dev, "unable to bring out of sw-rst\n");
+ return ret;
+ }
+ }
+
+ if (drv_data->pwr_rst) {
+ ret = reset_control_deassert(drv_data->pwr_rst);
+ if (ret) {
+ dev_err(&pdev->dev, "unable to bring out of pwr-rst\n");
+ return ret;
+ }
+ }
+
+ return 0;
+}
+#endif
+
+static struct ahci_platform_data ahci_st_platform_data = {
+ .init = ahci_st_init,
+ .exit = ahci_st_exit,
+#ifdef CONFIG_PM_SLEEP
+ .suspend = ahci_st_suspend,
+ .resume = ahci_st_resume,
+#endif
+};
+
+static int ahci_st_driver_probe(struct platform_device *pdev)
+{
+ int err, id;
+ struct ahci_st_drv_data *drv_data;
+ struct device *dev = &pdev->dev;
+ struct device_node *np = dev->of_node;
+ struct platform_device_info ahci_info = {
+ .parent = dev,
+ .name = "ahci",
+ .id = pdev->id,
+ .res = pdev->resource,
+ .num_res = pdev->num_resources,
+ .data = &ahci_st_platform_data,
+ .size_data = sizeof(ahci_st_platform_data),
+ };
+
+ if (np) {
+ id = of_alias_get_id(dev->of_node, "sata");
+ if (id > 0)
+ ahci_info.id = id;
+
+ ahci_info.dma_mask = DMA_BIT_MASK(32);
+ }
+
+ drv_data = devm_kzalloc(dev, sizeof(*drv_data), GFP_KERNEL);
+ if (!drv_data)
+ return -ENOMEM;
+
+ err = ahci_st_probe_resets(pdev, drv_data);
+ if (err)
+ return err;
+
+ drv_data->clk = devm_clk_get(&pdev->dev, "ahci_clk");
+ if (IS_ERR(drv_data->clk)) {
+ dev_err(&pdev->dev, "ahci_clk clk not found\n");
+ return PTR_ERR(drv_data->clk);
+ }
+
+ drv_data->phy = devm_phy_get(&pdev->dev, "ahci_phy");
+ if (IS_ERR(drv_data->phy)) {
+ dev_err(&pdev->dev, "no PHY configured\n");
+ return PTR_ERR(drv_data->phy);
+ }
+
+ platform_set_drvdata(pdev, drv_data);
+
+ drv_data->ahci = platform_device_register_full(&ahci_info);
+
+ return PTR_ERR_OR_ZERO(drv_data->ahci);
+}
+
+static struct of_device_id st_ahci_match[] = {
+ { .compatible = "st,ahci", },
+ {},
+};
+MODULE_DEVICE_TABLE(of, st_ahci_match);
+
+static struct platform_driver ahci_st_driver = {
+ .driver = {
+ .name = "ahci_st",
+ .owner = THIS_MODULE,
+ .of_match_table = of_match_ptr(st_ahci_match),
+ },
+ .probe = ahci_st_driver_probe,
+};
+module_platform_driver(ahci_st_driver);
+
+MODULE_AUTHOR("Alexandre Torgue <alexandre.torgue@xxxxxx>");
+MODULE_AUTHOR("Francesco Virlinzi <francesco.virlinzi@xxxxxx>");
+MODULE_DESCRIPTION("STMicroelectronics Sata Ahci driver");
+MODULE_LICENSE("GPL v2");
--
1.8.3.2

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
Please read the FAQ at http://www.tux.org/lkml/