1 files changed, 226 insertions, 0 deletions

diff --git a/arch/mips/bcm63xx/clk.c b/arch/mips/bcm63xx/clk.c
new file mode 100644
index 000000000000..2c68ee9ccee2
--- /dev/null
+++ b/arch/mips/bcm63xx/clk.c
@@ -0,0 +1,226 @@
+/*
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License.  See the file "COPYING" in the main directory of this archive
+ * for more details.
+ *
+ * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr>
+ */
+
+#include <linux/module.h>
+#include <linux/mutex.h>
+#include <linux/err.h>
+#include <linux/clk.h>
+#include <bcm63xx_cpu.h>
+#include <bcm63xx_io.h>
+#include <bcm63xx_regs.h>
+#include <bcm63xx_clk.h>
+
+static DEFINE_MUTEX(clocks_mutex);
+
+
+static void clk_enable_unlocked(struct clk *clk)
+{
+        if (clk->set && (clk->usage++) == 0)
+                clk->set(clk, 1);
+}
+
+static void clk_disable_unlocked(struct clk *clk)
+{
+        if (clk->set && (--clk->usage) == 0)
+                clk->set(clk, 0);
+}
+
+static void bcm_hwclock_set(u32 mask, int enable)
+{
+        u32 reg;
+
+        reg = bcm_perf_readl(PERF_CKCTL_REG);
+        if (enable)
+                reg |= mask;
+        else
+                reg &= ~mask;
+        bcm_perf_writel(reg, PERF_CKCTL_REG);
+}
+
+/*
+ * Ethernet MAC "misc" clock: dma clocks and main clock on 6348
+ */
+static void enet_misc_set(struct clk *clk, int enable)
+{
+        u32 mask;
+
+        if (BCMCPU_IS_6338())
+                mask = CKCTL_6338_ENET_EN;
+        else if (BCMCPU_IS_6345())
+                mask = CKCTL_6345_ENET_EN;
+        else if (BCMCPU_IS_6348())
+                mask = CKCTL_6348_ENET_EN;
+        else
+                /* BCMCPU_IS_6358 */
+                mask = CKCTL_6358_EMUSB_EN;
+        bcm_hwclock_set(mask, enable);
+}
+
+static struct clk clk_enet_misc = {
+        .set    = enet_misc_set,
+};
+
+/*
+ * Ethernet MAC clocks: only revelant on 6358, silently enable misc
+ * clocks
+ */
+static void enetx_set(struct clk *clk, int enable)
+{
+        if (enable)
+                clk_enable_unlocked(&clk_enet_misc);
+        else
+                clk_disable_unlocked(&clk_enet_misc);
+
+        if (BCMCPU_IS_6358()) {
+                u32 mask;
+
+                if (clk->id == 0)
+                        mask = CKCTL_6358_ENET0_EN;
+                else
+                        mask = CKCTL_6358_ENET1_EN;
+                bcm_hwclock_set(mask, enable);
+        }
+}
+
+static struct clk clk_enet0 = {
+        .id     = 0,
+        .set    = enetx_set,
+};
+
+static struct clk clk_enet1 = {
+        .id     = 1,
+        .set    = enetx_set,
+};
+
+/*
+ * Ethernet PHY clock
+ */
+static void ephy_set(struct clk *clk, int enable)
+{
+        if (!BCMCPU_IS_6358())
+                return;
+        bcm_hwclock_set(CKCTL_6358_EPHY_EN, enable);
+}
+
+
+static struct clk clk_ephy = {
+        .set    = ephy_set,
+};
+
+/*
+ * PCM clock
+ */
+static void pcm_set(struct clk *clk, int enable)
+{
+        if (!BCMCPU_IS_6358())
+                return;
+        bcm_hwclock_set(CKCTL_6358_PCM_EN, enable);
+}
+
+static struct clk clk_pcm = {
+        .set    = pcm_set,
+};
+
+/*
+ * USB host clock
+ */
+static void usbh_set(struct clk *clk, int enable)
+{
+        if (!BCMCPU_IS_6348())
+                return;
+        bcm_hwclock_set(CKCTL_6348_USBH_EN, enable);
+}
+
+static struct clk clk_usbh = {
+        .set    = usbh_set,
+};
+
+/*
+ * SPI clock
+ */
+static void spi_set(struct clk *clk, int enable)
+{
+        u32 mask;
+
+        if (BCMCPU_IS_6338())
+                mask = CKCTL_6338_SPI_EN;
+        else if (BCMCPU_IS_6348())
+                mask = CKCTL_6348_SPI_EN;
+        else
+                /* BCMCPU_IS_6358 */
+                mask = CKCTL_6358_SPI_EN;
+        bcm_hwclock_set(mask, enable);
+}
+
+static struct clk clk_spi = {
+        .set    = spi_set,
+};
+
+/*
+ * Internal peripheral clock
+ */
+static struct clk clk_periph = {
+        .rate   = (50 * 1000 * 1000),
+};
+
+
+/*
+ * Linux clock API implementation
+ */
+int clk_enable(struct clk *clk)
+{
+        mutex_lock(&clocks_mutex);
+        clk_enable_unlocked(clk);
+        mutex_unlock(&clocks_mutex);
+        return 0;
+}
+
+EXPORT_SYMBOL(clk_enable);
+
+void clk_disable(struct clk *clk)
+{
+        mutex_lock(&clocks_mutex);
+        clk_disable_unlocked(clk);
+        mutex_unlock(&clocks_mutex);
+}
+
+EXPORT_SYMBOL(clk_disable);
+
+unsigned long clk_get_rate(struct clk *clk)
+{
+        return clk->rate;
+}
+
+EXPORT_SYMBOL(clk_get_rate);
+
+struct clk *clk_get(struct device *dev, const char *id)
+{
+        if (!strcmp(id, "enet0"))
+                return &clk_enet0;
+        if (!strcmp(id, "enet1"))
+                return &clk_enet1;
+        if (!strcmp(id, "ephy"))
+                return &clk_ephy;
+        if (!strcmp(id, "usbh"))
+                return &clk_usbh;
+        if (!strcmp(id, "spi"))
+                return &clk_spi;
+        if (!strcmp(id, "periph"))
+                return &clk_periph;
+        if (BCMCPU_IS_6358() && !strcmp(id, "pcm"))
+                return &clk_pcm;
+        return ERR_PTR(-ENOENT);
+}
+
+EXPORT_SYMBOL(clk_get);
+
+void clk_put(struct clk *clk)
+{
+}
+
+EXPORT_SYMBOL(clk_put);