From: Todd Poynor <toddpoynor@google.com>
Date: Mon, 11 Oct 2010 22:31:42 +0000 (-0700)
Subject: tegra sdhci: Enable/disable SDCLK source in set_clock host_op
X-Git-Tag: firefly_0821_release~9833^2~126
X-Git-Url: http://demsky.eecs.uci.edu/git/?a=commitdiff_plain;h=e2e64b12d691d1031e8bd343dbc8b5d2714b6f8f;p=firefly-linux-kernel-4.4.55.git

tegra sdhci: Enable/disable SDCLK source in set_clock host_op

Change-Id: I2295a044140f0f388564ea3a63dd52445adff63b
Signed-off-by: Todd Poynor <toddpoynor@google.com>
---

diff --git a/drivers/mmc/host/sdhci-tegra.c b/drivers/mmc/host/sdhci-tegra.c
index 361c8e780683..35ec8e385db8 100644
--- a/drivers/mmc/host/sdhci-tegra.c
+++ b/drivers/mmc/host/sdhci-tegra.c
@@ -30,9 +30,12 @@
 
 #define DRIVER_NAME    "sdhci-tegra"
 
+#define SDHCI_VENDOR_CLOCK_CNTRL       0x100
+
 struct tegra_sdhci_host {
 	struct sdhci_host *sdhci;
 	struct clk *clk;
+	int clk_enabled;
 };
 
 static irqreturn_t carddetect_irq(int irq, void *data)
@@ -48,8 +51,26 @@ static int tegra_sdhci_enable_dma(struct sdhci_host *host)
 	return 0;
 }
 
+static void tegra_sdhci_set_clock(struct sdhci_host *sdhci, unsigned int clock)
+{
+	struct tegra_sdhci_host *host = sdhci_priv(sdhci);
+	pr_info("tegra sdhci clock %s %u\n",
+		mmc_hostname(sdhci->mmc), clock);
+
+	if (clock && !host->clk_enabled) {
+		clk_enable(host->clk);
+		sdhci_writeb(sdhci, 1, SDHCI_VENDOR_CLOCK_CNTRL);
+		host->clk_enabled = 1;
+	} else if (!clock && host->clk_enabled) {
+		sdhci_writeb(sdhci, 0, SDHCI_VENDOR_CLOCK_CNTRL);
+		clk_disable(host->clk);
+		host->clk_enabled = 0;
+	}
+}
+
 static struct sdhci_ops tegra_sdhci_ops = {
 	.enable_dma = tegra_sdhci_enable_dma,
+	.set_clock = tegra_sdhci_set_clock,
 };
 
 static int __devinit tegra_sdhci_probe(struct platform_device *pdev)
@@ -97,6 +118,7 @@ static int __devinit tegra_sdhci_probe(struct platform_device *pdev)
 	if (rc != 0)
 		goto err_clkput;
 
+	host->clk_enabled = 1;
 	sdhci->hw_name = "tegra";
 	sdhci->ops = &tegra_sdhci_ops;
 	sdhci->irq = irq;