From mboxrd@z Thu Jan 1 00:00:00 1970 From: Richard Zhu Subject: [PATCH V1 3/3] MX53 Enable the AHCI SATA on MX53 LOCO Date: Thu, 17 Mar 2011 15:11:00 +0800 Message-ID: <1300345860-16574-3-git-send-email-Hong-Xing.Zhu@freescale.com> References: <1300345860-16574-1-git-send-email-Hong-Xing.Zhu@freescale.com> Mime-Version: 1.0 Content-Type: text/plain Return-path: Received: from ch1outboundpool.messaging.microsoft.com ([216.32.181.185]:12237 "EHLO ch1outboundpool.messaging.microsoft.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1750845Ab1CQHLV (ORCPT ); Thu, 17 Mar 2011 03:11:21 -0400 In-Reply-To: <1300345860-16574-1-git-send-email-Hong-Xing.Zhu@freescale.com> Sender: linux-ide-owner@vger.kernel.org List-Id: linux-ide@vger.kernel.org To: linux-arm-kernel@lists.infradead.org Cc: jgarzik@pobox.com, kernel@pengutronix.de, linux-ide@vger.kernel.org, avorontsov@ru.mvista.com, eric@eukrea.com, eric.miao@linaro.org, Richard Zhu Signed-off-by: Richard Zhu --- arch/arm/mach-mx5/board-mx53_loco.c | 78 +++++++++++++++++++++++++++++++++++ 1 files changed, 78 insertions(+), 0 deletions(-) diff --git a/arch/arm/mach-mx5/board-mx53_loco.c b/arch/arm/mach-mx5/board-mx53_loco.c index 0a18f8d..4c00033 100644 --- a/arch/arm/mach-mx5/board-mx53_loco.c +++ b/arch/arm/mach-mx5/board-mx53_loco.c @@ -23,11 +23,13 @@ #include #include #include +#include #include #include #include #include +#include #include #include @@ -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) -- 1.7.1