@@ -23,11 +23,13 @@
#include <linux/fec.h>
#include <linux/delay.h>
#include <linux/gpio.h>
+#include <linux/ahci_platform.h>
#include <mach/common.h>
#include <mach/hardware.h>
#include <mach/imx-uart.h>
#include <mach/iomux-mx53.h>
+#include <mach/ahci_sata.h>
#include <asm/mach-types.h>
#include <asm/mach/arch.h>
@@ -203,6 +205,81 @@ static const struct imxi2c_platform_data mx53_loco_i2c_data __initconst = {
.bitrate = 100000,
};
+/* HW Initialization, if return 0, initialization is successful. */
+static int sata_init(struct device *dev, void __iomem *addr)
+{
+ int ret = 0;
+ u32 tmpdata;
+ struct clk *clk;
+ struct ahci_platform_data *pdata = dev->platform_data;
+
+ pdata->sata_clk = clk_get(dev, NULL);
+ if (IS_ERR(pdata->sata_clk)) {
+ dev_err(dev, "IMX AHCI can't get sata clock.\n");
+ return PTR_ERR(pdata->sata_clk);
+ }
+ ret = clk_enable(pdata->sata_clk);
+ if (ret) {
+ dev_err(dev, "IMX AHCI can't enable sata clock.\n");
+ clk_put(pdata->sata_clk);
+ return ret;
+ }
+
+ /* FSL IMX AHCI SATA uses the internal usb phy1 clk on loco */
+ if (internal_clk_initialization(dev))
+ goto release_sata_clk;
+
+ /* Get the AHB clock rate, and configure the TIMER1MS reg later */
+ clk = clk_get(NULL, "ahb");
+ if (IS_ERR(clk)) {
+ dev_err(dev, "IMX AHCI can't get AHB clock.\n");
+ ret = PTR_ERR(clk);
+ goto release_sata_ref_clk;
+ }
+
+ tmpdata = readl(addr + HOST_CAP);
+ if (!(tmpdata & HOST_CAP_SSS)) {
+ tmpdata |= HOST_CAP_SSS;
+ writel(tmpdata, addr + HOST_CAP);
+ }
+
+ if (!(readl(addr + HOST_PORTS_IMPL) & 0x1))
+ writel((readl(addr + HOST_PORTS_IMPL) | 0x1),
+ addr + HOST_PORTS_IMPL);
+
+ tmpdata = clk_get_rate(clk) / 1000;
+ clk_put(clk);
+ writel(tmpdata, addr + HOST_TIMER1MS);
+
+ clk = NULL;
+ return ret;
+
+release_sata_ref_clk:
+ internal_clk_release(dev);
+
+release_sata_clk:
+ clk_disable(pdata->sata_clk);
+ clk_put(pdata->sata_clk);
+
+ clk = NULL;
+ return ret;
+}
+
+static void sata_exit(struct device *dev)
+{
+ struct ahci_platform_data *pdata = dev->platform_data;
+
+ internal_clk_release(dev);
+
+ clk_disable(pdata->sata_clk);
+ clk_put(pdata->sata_clk);
+}
+
+static struct ahci_platform_data sata_data = {
+ .init = sata_init,
+ .exit = sata_exit,
+};
+
static void __init mx53_loco_board_init(void)
{
mxc_iomux_v3_setup_multiple_pads(mx53_loco_pads,
@@ -215,6 +292,7 @@ static void __init mx53_loco_board_init(void)
imx53_add_imx_i2c(1, &mx53_loco_i2c_data);
imx53_add_sdhci_esdhc_imx(0, NULL);
imx53_add_sdhci_esdhc_imx(2, NULL);
+ imx53_add_ahci_imx(0, &sata_data);
}
static void __init mx53_loco_timer_init(void)
Signed-off-by: Richard Zhu <Hong-Xing.Zhu@freescale.com> --- arch/arm/mach-mx5/board-mx53_loco.c | 78 +++++++++++++++++++++++++++++++++++ 1 files changed, 78 insertions(+), 0 deletions(-)