[PATCH 2/2] clk: add 74aup1g157gw 2-input multiplexer as clock driver
From: Kuninori Morimoto
Date: Tue Oct 09 2018 - 22:16:56 EST
From: Kuninori Morimoto <kuninori.morimoto.gx@xxxxxxxxxxx>
74aup1g157gw needs i0 and i1 pin as input, select and output it by
sel gpio pin. This driver adds new 74aup1g157gw as clock multiplexer.
"nxp,74aup1g157gw-clk" will select most closest input as output,
"nxp,74aup1g157gw-audio-clk" will select 48kHz/44.1kHz categorized
input as output.
Signed-off-by: Kuninori Morimoto <kuninori.morimoto.gx@xxxxxxxxxxx>
---
drivers/clk/Kconfig | 1 +
drivers/clk/Makefile | 2 +-
drivers/clk/nxp/Kconfig | 4 +
drivers/clk/nxp/Makefile | 1 +
drivers/clk/nxp/clk-74aup1g157gw.c | 213 +++++++++++++++++++++++++++++++++++++
5 files changed, 220 insertions(+), 1 deletion(-)
create mode 100644 drivers/clk/nxp/Kconfig
create mode 100644 drivers/clk/nxp/clk-74aup1g157gw.c
diff --git a/drivers/clk/Kconfig b/drivers/clk/Kconfig
index 292056b..9cfeb0e 100644
--- a/drivers/clk/Kconfig
+++ b/drivers/clk/Kconfig
@@ -299,5 +299,6 @@ source "drivers/clk/sunxi-ng/Kconfig"
source "drivers/clk/tegra/Kconfig"
source "drivers/clk/ti/Kconfig"
source "drivers/clk/uniphier/Kconfig"
+source "drivers/clk/nxp/Kconfig"
endmenu
diff --git a/drivers/clk/Makefile b/drivers/clk/Makefile
index ed344eb..fcfd42a 100644
--- a/drivers/clk/Makefile
+++ b/drivers/clk/Makefile
@@ -84,7 +84,7 @@ obj-$(CONFIG_ARCH_MMP) += mmp/
endif
obj-y += mvebu/
obj-$(CONFIG_ARCH_MXS) += mxs/
-obj-$(CONFIG_COMMON_CLK_NXP) += nxp/
+obj-y += nxp/
obj-$(CONFIG_MACH_PISTACHIO) += pistachio/
obj-$(CONFIG_COMMON_CLK_PXA) += pxa/
obj-$(CONFIG_COMMON_CLK_QCOM) += qcom/
diff --git a/drivers/clk/nxp/Kconfig b/drivers/clk/nxp/Kconfig
new file mode 100644
index 0000000..44c8fed
--- /dev/null
+++ b/drivers/clk/nxp/Kconfig
@@ -0,0 +1,4 @@
+config CLK_74AUP1G157GW
+ tristate "NXP 74AUP1G157GW Low-power 2-input multiplexer support as clock"
+ help
+ This enables NXP 74AUP1G157GW 2-input multiplexer as clock driver
diff --git a/drivers/clk/nxp/Makefile b/drivers/clk/nxp/Makefile
index d456ee6..2965bdd 100644
--- a/drivers/clk/nxp/Makefile
+++ b/drivers/clk/nxp/Makefile
@@ -2,3 +2,4 @@ obj-$(CONFIG_ARCH_LPC18XX) += clk-lpc18xx-cgu.o
obj-$(CONFIG_ARCH_LPC18XX) += clk-lpc18xx-ccu.o
obj-$(CONFIG_ARCH_LPC18XX) += clk-lpc18xx-creg.o
obj-$(CONFIG_ARCH_LPC32XX) += clk-lpc32xx.o
+obj-$(CONFIG_CLK_74AUP1G157GW) += clk-74aup1g157gw.o
diff --git a/drivers/clk/nxp/clk-74aup1g157gw.c b/drivers/clk/nxp/clk-74aup1g157gw.c
new file mode 100644
index 0000000..78199bb
--- /dev/null
+++ b/drivers/clk/nxp/clk-74aup1g157gw.c
@@ -0,0 +1,213 @@
+// SPDX-License-Identifier: GPL-2.0
+//
+// Copyright (C) 2018 Renesas Solutions Corp.
+// Kuninori Morimoto <kuninori.morimoto.gx@xxxxxxxxxxx>
+//
+#include <linux/module.h>
+#include <linux/clk.h>
+#include <linux/clk-provider.h>
+#include <linux/slab.h>
+#include <linux/err.h>
+#include <linux/gpio/consumer.h>
+#include <linux/of.h>
+#include <linux/of_device.h>
+#include <linux/platform_device.h>
+
+#define CLK_I_NUM 2
+struct clk_priv {
+ struct clk_hw hw;
+ struct device *dev;
+ struct clk *i[CLK_I_NUM];
+ struct gpio_desc *sel;
+ long (*round_rate)(struct clk_hw *hw, unsigned long rate,
+ unsigned long *parent_rate);
+};
+#define hw_to_priv(_hw) container_of(_hw, struct clk_priv, hw)
+#define priv_to_dev(priv) priv->dev
+#define for_each_iclk(i) \
+ for ((i) = 0; (i) < CLK_I_NUM; (i)++)
+
+static int clk74_set_rate(struct clk_hw *hw, unsigned long rate,
+ unsigned long parent_rate)
+{
+ struct clk_priv *priv = hw_to_priv(hw);
+ struct device *dev = priv_to_dev(priv);
+ int i;
+
+ for_each_iclk(i) {
+ if (rate == clk_get_rate(priv->i[i])) {
+ dev_dbg(dev, "set rate %lu as i%d\n", rate, i);
+ gpiod_set_value_cansleep(priv->sel, i);
+ return 0;
+ }
+ }
+
+ dev_err(dev, "unsupported rate %lu\n", rate);
+ return -EIO;
+}
+
+static long clk74_round_rate_close(struct clk_hw *hw, unsigned long rate,
+ unsigned long *parent_rate)
+{
+ struct clk_priv *priv = hw_to_priv(hw);
+ struct device *dev = priv_to_dev(priv);
+ unsigned long min = ~0;
+ unsigned long ret = 0;
+ int i;
+
+ /*
+ * select closest rate
+ */
+ for_each_iclk(i) {
+ unsigned long irate = clk_get_rate(priv->i[i]);
+ unsigned long diff = abs(rate - irate);
+
+ if (min > diff) {
+ min = diff;
+ ret = irate;
+ }
+ }
+
+ dev_dbg(dev, "(close)round rate %lu\n", ret);
+
+ return ret;
+}
+
+static long clk74_round_rate_audio(struct clk_hw *hw, unsigned long rate,
+ unsigned long *parent_rate)
+{
+ struct clk_priv *priv = hw_to_priv(hw);
+ struct device *dev = priv_to_dev(priv);
+ unsigned long ret = 0;
+ int is_8k = 0;
+ int i;
+
+ /*
+ * select 48kHz or 44.1kHz category rate
+ */
+ if (!(rate % 8000))
+ is_8k = 1;
+
+ for_each_iclk(i) {
+ unsigned long irate = clk_get_rate(priv->i[i]);
+
+ if (( is_8k && !(irate % 8000)) ||
+ (!is_8k && (irate % 8000))) {
+ ret = irate;
+ }
+ }
+
+ dev_dbg(dev, "(audio)round rate %lu\n", ret);
+
+ return ret;
+}
+
+static long clk74_round_rate(struct clk_hw *hw, unsigned long rate,
+ unsigned long *parent_rate)
+{
+ struct clk_priv *priv = hw_to_priv(hw);
+
+ return priv->round_rate(hw, rate, parent_rate);
+}
+
+static unsigned long clk74_recalc_rate(struct clk_hw *hw,
+ unsigned long parent_rate)
+{
+ struct clk_priv *priv = hw_to_priv(hw);
+ struct device *dev = priv_to_dev(priv);
+ unsigned long rate;
+ int i = gpiod_get_raw_value_cansleep(priv->sel);
+
+ rate = clk_get_rate(priv->i[i]);
+
+ dev_dbg(dev, "recalc rate %lu as i%d\n", rate, i);
+
+ return rate;
+}
+
+static u8 clk74_get_parent(struct clk_hw *hw)
+{
+ struct clk_priv *priv = hw_to_priv(hw);
+
+ return gpiod_get_raw_value_cansleep(priv->sel);
+}
+
+static const struct clk_ops clk74_ops = {
+ .set_rate = clk74_set_rate,
+ .round_rate = clk74_round_rate,
+ .recalc_rate = clk74_recalc_rate,
+ .get_parent = clk74_get_parent,
+};
+
+static const char * const clk74_in_name[CLK_I_NUM] = {
+ "i0",
+ "i1",
+};
+
+static int clk74_probe(struct platform_device *pdev)
+{
+ struct clk *clk;
+ struct clk_init_data init;
+ struct clk_priv *priv;
+ struct device *dev = &pdev->dev;
+ const char *parent_names[CLK_I_NUM];
+ int i, ret;
+
+ priv = kzalloc(sizeof(*priv), GFP_KERNEL);
+ if (!priv)
+ return -ENODEV;
+
+ for_each_iclk(i) {
+ clk = devm_clk_get(dev, clk74_in_name[i]);
+ if (IS_ERR(clk))
+ return -EPROBE_DEFER;
+ priv->i[i] = clk;
+ parent_names[i] = __clk_get_name(clk);
+ }
+
+ memset(&init, 0, sizeof(init));
+ init.name = "74aup1g157gw";
+ init.ops = &clk74_ops;
+ init.parent_names = parent_names;
+ init.num_parents = CLK_I_NUM;
+
+ priv->hw.init = &init;
+ priv->dev = dev;
+ priv->round_rate = of_device_get_match_data(dev);
+ priv->sel = devm_gpiod_get(dev, "sel", 0);
+ if (IS_ERR(priv->sel))
+ return -EPROBE_DEFER;
+
+ gpiod_direction_output(priv->sel, 0);
+
+ ret = devm_clk_hw_register(dev, &priv->hw);
+ if (ret < 0)
+ return ret;
+
+ ret = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, &priv->hw);
+ if (ret < 0)
+ return ret;
+
+ platform_set_drvdata(pdev, priv);
+
+ dev_info(dev, "probed\n");
+
+ return 0;
+}
+
+#define OF_ID(name, func) { .compatible = name, .data = func }
+static const struct of_device_id clk74_of_match[] = {
+ OF_ID("nxp,74aup1g157gw-clk", clk74_round_rate_close),
+ OF_ID("nxp,74aup1g157gw-audio-clk", clk74_round_rate_audio),
+ { }
+};
+MODULE_DEVICE_TABLE(of, clk74_of_match);
+
+static struct platform_driver clk74_driver = {
+ .driver = {
+ .name = "74aup1g157gw",
+ .of_match_table = clk74_of_match,
+ },
+ .probe = clk74_probe,
+};
+builtin_platform_driver(clk74_driver);
--
2.7.4