From: Alexandre Bailon <[email protected]>
The goal of this patchset is to use the interconnect framework
for iMX7ULP SoC.
This is sent as a RFC because I think the driver could be more generic,
and, I had some issues with the clocks and I know the way I dealt with
it is probably not the best one.
In addition, this patchset has been written and tested on older kernel
(4.9), and I don't expect it to applies / works on upstream kernel
(the support of SoC itself is still not there).
There are two interconnects, NIC0 and NIC1:
//==============================\\
|| -------------------- ||
\\=|m0 s0|= ||
=|m1 s1|===\\ ||
=|m2 NIC0 s2|= || ||
=|m3 | || ||
=|m4 | || ||
-------------------- || ||
//=================// ||
|| -------------------- ||
\\==|m0 s0|=//
=|m1 s1|=
=|m2 NIC1 s2|=
=|m3 s4|=
=|m4 s5|=
=|m5 |
--------------------
------- -------
NIC0 | DIV | NIC0 DIV | DIV | NIC1 DIV
-----| |----------| |---------
------- -------
Although NIC0 and NIC1 are interconnected, some requests could apply to
only one of them. This could cause some issues with clock.
Basically, scaling the frequency of NIC0 will also scale the frequency of
NIC1, so we have to update both of them.
Simillarly, updating the frequency of NIC1 may also require to change NIC0
frequency.
In order to easily deal with it, the driver create only one device for the
two interconnects, and update clock frequency of both interconnects at same
time, when the last node is reached.
Ideally, we would have two device, which would make the driver more
generic, but currently, I'm not sure how to make sure that the clocks are
always at the expected frequency. Doing that would give us the possiblity to
use the driver for other iMX SoC (would just require to add the bus topology
for that SoC).
Alexandre Bailon (2):
Add support of imx7ulp to interconnect framework
dt-bindings: interconnect: Document imx7ulp interconnect bindings
.../bindings/interconnect/imx7ulp.txt | 17 +
drivers/interconnect/Kconfig | 1 +
drivers/interconnect/Makefile | 1 +
drivers/interconnect/imx/Kconfig | 9 +
drivers/interconnect/imx/Makefile | 1 +
drivers/interconnect/imx/imx7ulp.c | 369 ++++++++++++++++++
6 files changed, 398 insertions(+)
create mode 100644 Documentation/devicetree/bindings/interconnect/imx7ulp.txt
create mode 100644 drivers/interconnect/imx/Kconfig
create mode 100644 drivers/interconnect/imx/Makefile
create mode 100644 drivers/interconnect/imx/imx7ulp.c
--
2.18.1
From: Alexandre Bailon <[email protected]>
This is a PoC of interconnect driver for the imx7ulp.
This scales the clock of nic0 and nic1 (the two interconnects).
In order too solve some issue with clocks (I will give more details
later in code), the bus topology described in the driver differ a little
from the one in the datasheet.
In addition, the driver manages nic0 and nic1 as an unique
interconnect. It would have been better to manage them separately but
it was harder to do it because of the clocks (again).
Later, I will add third clock for the MMDC endpoint, which is the
DDR controller. This will be used to scale the DDR in addition of
interconnect.
Signed-off-by: Alexandre Bailon <[email protected]>
---
drivers/interconnect/Kconfig | 1 +
drivers/interconnect/Makefile | 1 +
drivers/interconnect/imx/Kconfig | 9 +
drivers/interconnect/imx/Makefile | 1 +
drivers/interconnect/imx/imx7ulp.c | 369 +++++++++++++++++++++++++++++
5 files changed, 381 insertions(+)
create mode 100644 drivers/interconnect/imx/Kconfig
create mode 100644 drivers/interconnect/imx/Makefile
create mode 100644 drivers/interconnect/imx/imx7ulp.c
diff --git a/drivers/interconnect/Kconfig b/drivers/interconnect/Kconfig
index 07a8276fa35a..99955906bea8 100644
--- a/drivers/interconnect/Kconfig
+++ b/drivers/interconnect/Kconfig
@@ -11,5 +11,6 @@ menuconfig INTERCONNECT
if INTERCONNECT
source "drivers/interconnect/qcom/Kconfig"
+source "drivers/interconnect/imx/Kconfig"
endif
diff --git a/drivers/interconnect/Makefile b/drivers/interconnect/Makefile
index 7944cbca0527..4c8814fc2b4b 100644
--- a/drivers/interconnect/Makefile
+++ b/drivers/interconnect/Makefile
@@ -1,3 +1,4 @@
# SPDX-License-Identifier: GPL-2.0
obj-$(CONFIG_INTERCONNECT) += core.o
obj-$(CONFIG_INTERCONNECT_QCOM) += qcom/
+obj-$(CONFIG_INTERCONNECT_IMX) += imx/
diff --git a/drivers/interconnect/imx/Kconfig b/drivers/interconnect/imx/Kconfig
new file mode 100644
index 000000000000..5eb88eafc1fd
--- /dev/null
+++ b/drivers/interconnect/imx/Kconfig
@@ -0,0 +1,9 @@
+config INTERCONNECT_IMX
+ bool "IMX Network-on-Chip interconnect drivers"
+ depends on INTERCONNECT
+ depends on ARCH_MXC
+ default y
+
+config INTERCONNECT_IMX7ULP
+ tristate "i.MX7ULP NIC-301 interconnect driver"
+ depends on INTERCONNECT_IMX
diff --git a/drivers/interconnect/imx/Makefile b/drivers/interconnect/imx/Makefile
new file mode 100644
index 000000000000..61d994b8fe2c
--- /dev/null
+++ b/drivers/interconnect/imx/Makefile
@@ -0,0 +1 @@
+obj-$(CONFIG_INTERCONNECT_IMX7ULP) += imx7ulp.o
diff --git a/drivers/interconnect/imx/imx7ulp.c b/drivers/interconnect/imx/imx7ulp.c
new file mode 100644
index 000000000000..7715198ad151
--- /dev/null
+++ b/drivers/interconnect/imx/imx7ulp.c
@@ -0,0 +1,369 @@
+#include <linux/clk.h>
+#include <linux/device.h>
+#include <linux/io.h>
+#include <linux/interconnect-provider.h>
+#include <linux/module.h>
+#include <linux/of_device.h>
+#include <linux/of_platform.h>
+#include <linux/platform_device.h>
+#include <linux/slab.h>
+
+#define IMX7ULP_MAX_LINKS 32
+
+/**
+ * Clock property of node
+ * @name: The name of the clock
+ * @clk: A pointer to the clock
+ * @rate: The rate to use, when the clock frequency is updated
+ */
+struct imx7ulp_bus_clock {
+ char *name;
+ struct clk *clk;
+ u64 rate;
+};
+
+/**
+ * IMX7ULP specific interconnect nodes
+ * @name: the node name used in debugfs
+ * @id: a unique node identifier
+ * @links: an array of nodes where we can go next while traversing
+ * @num_links: the total number of @links
+ * @buswidth: width (in bit) of the interconnect between a node and the bus
+ * @bus_clk: If not NULL, define clock properties of the node
+ * @ep: true if the node is an end point. Used to scale the frequency
+ */
+struct imx7ulp_icc_node {
+ char *name;
+ u16 id;
+ u16 links[IMX7ULP_MAX_LINKS];
+ u16 num_links;
+ u16 buswidth;
+ struct imx7ulp_bus_clock *bus_clk;
+ bool ep;
+};
+
+/**
+ * @dev: device pointer for the overall interconnect
+ * Although there are 2 interconnects, they are represented using one
+ * device.
+ * @nodes: Array of nodes
+ * @num_nodes: The total number of nodes
+ * @nic0: Clock properties for nic0 interconnect
+ * @nic1: Clock properties for nic1 interconnect
+ */
+struct imx7ulp_icc_desc {
+ struct device *dev;
+ struct imx7ulp_icc_node *nodes;
+ size_t num_nodes;
+ struct imx7ulp_bus_clock *nic0;
+ struct imx7ulp_bus_clock *nic1;
+};
+
+#define DEFINE_AXI_INTERCONNECT(_name, _id, _buswidth, _ep, _clk, \
+ _numlinks, ...) \
+ { \
+ .id = _id, \
+ .name = #_name, \
+ .buswidth = (_buswidth * 4), \
+ .num_links = _numlinks, \
+ .links = { __VA_ARGS__ }, \
+ .ep = _ep, \
+ .bus_clk = _clk, \
+ }
+
+#define DEFINE_AXI_MASTER(_name, _id, _buswidth, dest_id) \
+ DEFINE_AXI_INTERCONNECT(_name, _id, _buswidth, false, NULL, \
+ 1, dest_id)
+
+#define DEFINE_AXI_SLAVE(_name, _id, _buswidth, _numlinks, ...) \
+ DEFINE_AXI_INTERCONNECT(_name, _id, _buswidth, false, NULL, \
+ _numlinks, __VA_ARGS__)
+
+#define DEFINE_AXI_SLAVE_EP(_name, _id, _buswidth) \
+ DEFINE_AXI_INTERCONNECT(_name, _id, _buswidth, true, NULL, 0, 0)
+
+#define DEFINE_AHB_SLAVE_EP(_name, _id) \
+ DEFINE_AXI_SLAVE_EP(_name, _id, 4)
+
+static struct imx7ulp_bus_clock nic0_clock = {
+ .name = "nic0_div",
+};
+
+static struct imx7ulp_bus_clock nic1_clock = {
+ .name = "nic1_div",
+};
+
+static struct imx7ulp_icc_node imx7ulp_nodes[] = {
+ /* NIC0 Masters */
+ DEFINE_AXI_MASTER(a7, 2000, 16, 1000),
+ DEFINE_AXI_MASTER(nic1_s1, 2001, 8, 1000),
+ DEFINE_AXI_MASTER(dsi, 2002, 4, 1000),
+ DEFINE_AXI_MASTER(gpu3d, 2003, 8, 1000),
+ DEFINE_AXI_MASTER(gpu2d, 2004, 16, 1000),
+
+ /* NIC0 Slaves */
+ DEFINE_AXI_SLAVE_EP(mmdc, 2005, 16),
+ DEFINE_AXI_SLAVE_EP(sram0, 2006, 8),
+
+ /* NIC0 */
+ DEFINE_AXI_INTERCONNECT(nic0_m, 1000, 8, false, &nic0_clock, 1, 1001),
+ DEFINE_AXI_INTERCONNECT(nic0_s, 1001, 8, false, NULL, 3,
+ 2005, 2006, 1008),
+
+ /* NIC1 Masters */
+ DEFINE_AXI_MASTER(dma1_m, 2011, 8, 1008),
+ DEFINE_AXI_MASTER(caam_m, 2013, 4, 1008),
+ DEFINE_AXI_MASTER(usbotg_m, 2014, 4, 1008),
+ DEFINE_AXI_MASTER(viu_m, 2015, 8, 1008),
+ DEFINE_AXI_MASTER(usdhc0_m, 2016, 4, 1008),
+ DEFINE_AXI_MASTER(usdhc1_m, 2017, 4, 1008),
+
+ /* NIC1 Slaves */
+ DEFINE_AXI_SLAVE_EP(sram1, 2018, 8),
+ DEFINE_AXI_SLAVE_EP(secure_ram, 2020, 4),
+ DEFINE_AXI_SLAVE_EP(rom, 2023, 4), /* Also flexbus, gpu 2d and 3d */
+ DEFINE_AXI_SLAVE_EP(m4xbar, 2024, 4),
+
+ /* AHB0 */
+ DEFINE_AHB_SLAVE_EP(dma1, 8),
+ DEFINE_AHB_SLAVE_EP(dmadesc1, 9),
+ DEFINE_AHB_SLAVE_EP(rgpio2p, 15),
+ DEFINE_AHB_SLAVE_EP(flexbus, 16),
+ DEFINE_AHB_SLAVE_EP(sema42_1, 27),
+ DEFINE_AHB_SLAVE_EP(dmamux1, 33),
+ DEFINE_AHB_SLAVE_EP(mu_b, 34),
+ DEFINE_AHB_SLAVE_EP(caam, 36),
+ DEFINE_AHB_SLAVE_EP(tpm4, 37),
+ DEFINE_AHB_SLAVE_EP(tpm5, 38),
+ DEFINE_AHB_SLAVE_EP(lpit1, 39),
+ DEFINE_AHB_SLAVE_EP(lpspi2, 41),
+ DEFINE_AHB_SLAVE_EP(lpspi3, 42),
+ DEFINE_AHB_SLAVE_EP(lpi2c4, 43),
+ DEFINE_AHB_SLAVE_EP(lpi2c5, 44),
+ DEFINE_AHB_SLAVE_EP(lpuart4, 45),
+ DEFINE_AHB_SLAVE_EP(lpuart5, 46),
+ DEFINE_AHB_SLAVE_EP(flexio1, 49),
+ DEFINE_AHB_SLAVE_EP(usbotg1, 51),
+ DEFINE_AHB_SLAVE_EP(usbotg2, 52),
+ DEFINE_AHB_SLAVE_EP(usbphy, 53),
+ DEFINE_AHB_SLAVE_EP(usbpl301, 54),
+ DEFINE_AHB_SLAVE_EP(usdhc0, 55),
+ DEFINE_AHB_SLAVE_EP(usdhc1, 56),
+ DEFINE_AHB_SLAVE_EP(trgmux1, 59),
+ DEFINE_AHB_SLAVE_EP(wdog1, 61),
+ DEFINE_AHB_SLAVE_EP(scg1, 62),
+ DEFINE_AHB_SLAVE_EP(pcc2, 63),
+ DEFINE_AHB_SLAVE_EP(pmc1, 64),
+ DEFINE_AHB_SLAVE_EP(cmc1, 65),
+ DEFINE_AHB_SLAVE_EP(wdog2, 67),
+
+ DEFINE_AXI_SLAVE(ahb0, 2021, 4, 32,
+ 8, 9, 15, 16, 27, 33, 34, 35, 36, 37, 38, 39, 41, 42,
+ 43, 44, 45, 46, 49, 51, 52, 53, 54, 55, 56, 59, 61, 62,
+ 63, 64, 65, 67),
+
+ /* AHB1 */
+ DEFINE_AHB_SLAVE_EP(romc1, 116),
+ DEFINE_AHB_SLAVE_EP(tpm6, 133),
+ DEFINE_AHB_SLAVE_EP(tpm7, 134),
+ DEFINE_AHB_SLAVE_EP(lpi2c6, 136),
+ DEFINE_AHB_SLAVE_EP(lpi2c7, 137),
+ DEFINE_AHB_SLAVE_EP(lpuart6, 138),
+ DEFINE_AHB_SLAVE_EP(lpuart7, 139),
+ DEFINE_AHB_SLAVE_EP(viu, 140),
+ DEFINE_AHB_SLAVE_EP(dsi, 141),
+ DEFINE_AHB_SLAVE_EP(lcdif, 142),
+ DEFINE_AHB_SLAVE_EP(mmdc, 143),
+ DEFINE_AHB_SLAVE_EP(iomuxc1, 144),
+ DEFINE_AHB_SLAVE_EP(iomuxc_ddr, 145),
+ DEFINE_AHB_SLAVE_EP(pctlc, 146),
+ DEFINE_AHB_SLAVE_EP(pctld, 147),
+ DEFINE_AHB_SLAVE_EP(pctle, 148),
+ DEFINE_AHB_SLAVE_EP(pctlf, 149),
+ DEFINE_AHB_SLAVE_EP(pcc3, 151),
+
+ DEFINE_AXI_SLAVE(ahb1, 2022, 4, 19,
+ 116, 133, 134, 136, 137, 138, 139, 140, 141,
+ 142, 143, 144, 145, 146, 147, 148, 149, 151),
+
+ /* NIC1 */
+ DEFINE_AXI_INTERCONNECT(nic1_m, 1008, 8, false, &nic1_clock, 1, 1009),
+ DEFINE_AXI_INTERCONNECT(nic1_s, 1009, 8, false, NULL, 7,
+ 2018, 1000, 2020, 2021, 2022, 2023, 2024),
+};
+
+static struct imx7ulp_icc_desc icc_desc = {
+ .nodes = (struct imx7ulp_icc_node *)&imx7ulp_nodes,
+ .num_nodes = ARRAY_SIZE(imx7ulp_nodes),
+};
+
+static int imx7ulp_icc_aggregate(struct icc_node *node, u32 avg_bw,
+ u32 peak_bw, u32 *agg_avg, u32 *agg_peak)
+{
+ *agg_avg += avg_bw;
+ *agg_peak = max(*agg_peak, peak_bw);
+
+ return 0;
+}
+
+static int imx7ulp_icc_set(struct icc_node *src, struct icc_node *dst)
+{
+ int ret;
+ struct imx7ulp_icc_node *node;
+ struct imx7ulp_icc_desc *desc = src->provider->data;
+
+ /* If node has a clock, compute the new rate */
+ node = src->data;
+ if (node->bus_clk) {
+ u64 rate;
+ struct imx7ulp_bus_clock *bus_clk = node->bus_clk;
+
+ rate = (src->peak_bw / node->buswidth) * 1000;
+ rate = clk_round_rate(bus_clk->clk, rate);
+ if (rate != bus_clk->rate) {
+ dev_dbg(desc->dev, "%s: new rate = %llu\n",
+ bus_clk->name, rate);
+ bus_clk->rate = rate;
+ }
+ }
+
+ /*
+ * If the node is an endpoint, update the clock rate of nic0 and nic1
+ * nodes. nic1 clock derives from nic0, so we usually have to update
+ * both of them even if bandwidth changed only for one of the
+ * interconnect.
+ */
+ node = dst->data;
+ if (node->ep) {
+ struct imx7ulp_bus_clock *nic0_clk = desc->nic0;
+ struct imx7ulp_bus_clock *nic1_clk = desc->nic1;
+
+ if (nic1_clk->rate > nic0_clk->rate)
+ nic0_clk->rate = nic1_clk->rate;
+
+ if (clk_get_rate(nic0_clk->clk) != nic0_clk->rate) {
+ dev_dbg(desc->dev, "%s: apply rate = %llu\n",
+ nic0_clk->name, nic0_clk->rate);
+ ret = clk_set_rate(nic0_clk->clk, nic0_clk->rate);
+ if (ret)
+ dev_err(desc->dev, "Failed to set clock: %d\n",
+ ret);
+ }
+
+ if (clk_get_rate(nic1_clk->clk) != nic1_clk->rate) {
+ dev_dbg(desc->dev, "%s: apply rate = %llu\n",
+ nic1_clk->name, nic1_clk->rate);
+ ret = clk_set_rate(nic1_clk->clk, nic1_clk->rate);
+ if (ret)
+ dev_err(desc->dev, "Failed to set clock: %d\n",
+ ret);
+ }
+ }
+
+ return 0;
+}
+
+static int imx7ulp_probe(struct platform_device *pdev)
+{
+ struct imx7ulp_icc_desc *desc = &icc_desc;
+ struct icc_provider *provider;
+ size_t i;
+ int ret;
+
+ desc->dev = &pdev->dev;
+ desc->nic0 = &nic0_clock;
+ desc->nic1 = &nic1_clock;
+
+ provider = devm_kzalloc(&pdev->dev, sizeof(*provider), GFP_KERNEL);
+ provider->set = imx7ulp_icc_set;
+ provider->aggregate = imx7ulp_icc_aggregate;
+ INIT_LIST_HEAD(&provider->nodes);
+ provider->data = desc;
+
+ ret = icc_provider_add(provider);
+ if (ret) {
+ dev_err(&pdev->dev, "error adding interconnect provider\n");
+ return ret;
+ }
+
+ for (i = 0; i < desc->num_nodes; i++) {
+ struct icc_node *node;
+ int ret;
+ size_t j;
+
+ if (desc->nodes[i].bus_clk) {
+ struct imx7ulp_bus_clock *bus_clk;
+
+ bus_clk = desc->nodes[i].bus_clk;
+ bus_clk->clk = devm_clk_get(&pdev->dev, bus_clk->name);
+ if (IS_ERR(bus_clk->clk)) {
+ dev_err(&pdev->dev,
+ "Failed to get clock %s: %d\n",
+ bus_clk->name, PTR_ERR(bus_clk->clk));
+ ret = PTR_ERR(bus_clk->clk);
+ goto err;
+ }
+
+ ret = clk_prepare_enable(bus_clk->clk);
+ if (ret) {
+ dev_err(&pdev->dev,
+ "error enabling clock: %s %d\n",
+ bus_clk->name, ret);
+ goto err;
+ }
+ }
+
+ node = icc_node_create(desc->nodes[i].id);
+ if (IS_ERR(node)) {
+ ret = PTR_ERR(node);
+ dev_err(&pdev->dev, "Failed to create node %s\n",
+ desc->nodes[i].name);
+ goto err;
+ }
+
+ node->name = desc->nodes[i].name;
+ node->data = &desc->nodes[i];
+ icc_node_add(node, provider);
+
+ dev_dbg(&pdev->dev, "registered node %p %s %d\n", node,
+ desc->nodes[i].name, node->id);
+
+ for (j = 0; j < desc->nodes[i].num_links; j++)
+ if (desc->nodes[i].links[j])
+ icc_link_create(node, desc->nodes[i].links[j]);
+ }
+
+ platform_set_drvdata(pdev, provider);
+
+ return 0;
+err:
+ icc_provider_del(provider);
+ return ret;
+}
+
+static int imx7ulp_remove(struct platform_device *pdev)
+{
+ struct icc_provider *provider = platform_get_drvdata(pdev);
+
+ icc_provider_del(provider);
+
+ return 0;
+}
+
+static const struct of_device_id imx7ulp_of_match[] = {
+ { .compatible = "fsl,imx7ulp-icc" },
+ { },
+};
+MODULE_DEVICE_TABLE(of, imx7ulp_of_match);
+
+static struct platform_driver imx7ulp_driver = {
+ .probe = imx7ulp_probe,
+ .remove = imx7ulp_remove,
+ .driver = {
+ .name = "imx7ulp-icc",
+ .of_match_table = imx7ulp_of_match,
+ },
+};
+module_platform_driver(imx7ulp_driver);
+MODULE_AUTHOR("Alexandre Bailon <[email protected]>");
+MODULE_LICENSE("GPL v2");
--
2.18.1
From: Alexandre Bailon <[email protected]>
This documents the device tree bindings for the interconnects
present in the imx7ulp SoC.
Signed-off-by: Alexandre Bailon <[email protected]>
---
.../bindings/interconnect/imx7ulp.txt | 17 +++++++++++++++++
1 file changed, 17 insertions(+)
create mode 100644 Documentation/devicetree/bindings/interconnect/imx7ulp.txt
diff --git a/Documentation/devicetree/bindings/interconnect/imx7ulp.txt b/Documentation/devicetree/bindings/interconnect/imx7ulp.txt
new file mode 100644
index 000000000000..c32b7becdca7
--- /dev/null
+++ b/Documentation/devicetree/bindings/interconnect/imx7ulp.txt
@@ -0,0 +1,17 @@
+iMX7ULP interconnect driver binding
+----------------------------------------------------
+
+Required properties :
+- compatible : should be "fsl,imx7ulp-icc";
+- #interconnect-cells : should contain 1
+- clocks : list of phandles and specifiers to all interconnect bus clocks
+- clock-names : clock names should include both "nic0_div" and "nic1_div"
+
+Examples:
+ icc0: icc {
+ compatible = "fsl,imx7ulp-icc";
+ clocks = <&clks IMX7ULP_CLK_NIC0_DIV>,
+ <&clks IMX7ULP_CLK_NIC1_DIV>;
+ clock-names = "nic0_div", "nic1_div";
+ #interconnect-cells = <1>;
+ };
--
2.18.1
Hi Alexandre,
Thanks for submitting this patchset!
On 11/17/18 13:19, [email protected] wrote:
> From: Alexandre Bailon <[email protected]>
>
> This is a PoC of interconnect driver for the imx7ulp.
> This scales the clock of nic0 and nic1 (the two interconnects).
> In order too solve some issue with clocks (I will give more details
s/too/to/
> later in code), the bus topology described in the driver differ a little
> from the one in the datasheet.
Is there a public datasheet available?
> In addition, the driver manages nic0 and nic1 as an unique
> interconnect. It would have been better to manage them separately but
> it was harder to do it because of the clocks (again).
> Later, I will add third clock for the MMDC endpoint, which is the
> DDR controller. This will be used to scale the DDR in addition of
> interconnect.
>
> Signed-off-by: Alexandre Bailon <[email protected]>
s/.com.com/.com/
> ---
> drivers/interconnect/Kconfig | 1 +
> drivers/interconnect/Makefile | 1 +
> drivers/interconnect/imx/Kconfig | 9 +
> drivers/interconnect/imx/Makefile | 1 +
> drivers/interconnect/imx/imx7ulp.c | 369 +++++++++++++++++++++++++++++
> 5 files changed, 381 insertions(+)
> create mode 100644 drivers/interconnect/imx/Kconfig
> create mode 100644 drivers/interconnect/imx/Makefile
> create mode 100644 drivers/interconnect/imx/imx7ulp.c
>
> diff --git a/drivers/interconnect/Kconfig b/drivers/interconnect/Kconfig
> index 07a8276fa35a..99955906bea8 100644
> --- a/drivers/interconnect/Kconfig
> +++ b/drivers/interconnect/Kconfig
> @@ -11,5 +11,6 @@ menuconfig INTERCONNECT
> if INTERCONNECT
>
> source "drivers/interconnect/qcom/Kconfig"
> +source "drivers/interconnect/imx/Kconfig"
>
> endif
> diff --git a/drivers/interconnect/Makefile b/drivers/interconnect/Makefile
> index 7944cbca0527..4c8814fc2b4b 100644
> --- a/drivers/interconnect/Makefile
> +++ b/drivers/interconnect/Makefile
> @@ -1,3 +1,4 @@
> # SPDX-License-Identifier: GPL-2.0
> obj-$(CONFIG_INTERCONNECT) += core.o
> obj-$(CONFIG_INTERCONNECT_QCOM) += qcom/
> +obj-$(CONFIG_INTERCONNECT_IMX) += imx/
> diff --git a/drivers/interconnect/imx/Kconfig b/drivers/interconnect/imx/Kconfig
> new file mode 100644
> index 000000000000..5eb88eafc1fd
> --- /dev/null
> +++ b/drivers/interconnect/imx/Kconfig
> @@ -0,0 +1,9 @@
> +config INTERCONNECT_IMX
> + bool "IMX Network-on-Chip interconnect drivers"
I was wondering if this can be a module?
> + depends on INTERCONNECT
The above is redundant.
> + depends on ARCH_MXC
It would be nice if we can support COMPILE_TEST.
> + default y
> +
> +config INTERCONNECT_IMX7ULP
> + tristate "i.MX7ULP NIC-301 interconnect driver"
> + depends on INTERCONNECT_IMX
> diff --git a/drivers/interconnect/imx/Makefile b/drivers/interconnect/imx/Makefile
> new file mode 100644
> index 000000000000..61d994b8fe2c
> --- /dev/null
> +++ b/drivers/interconnect/imx/Makefile
> @@ -0,0 +1 @@
> +obj-$(CONFIG_INTERCONNECT_IMX7ULP) += imx7ulp.o
> diff --git a/drivers/interconnect/imx/imx7ulp.c b/drivers/interconnect/imx/imx7ulp.c
> new file mode 100644
> index 000000000000..7715198ad151
> --- /dev/null
> +++ b/drivers/interconnect/imx/imx7ulp.c
> @@ -0,0 +1,369 @@
Missing SPDX?
> +#include <linux/clk.h>
> +#include <linux/device.h>
> +#include <linux/io.h>
> +#include <linux/interconnect-provider.h>
Please move this above io.h to keep it sorted.
> +#include <linux/module.h>
> +#include <linux/of_device.h>
> +#include <linux/of_platform.h>
> +#include <linux/platform_device.h>
> +#include <linux/slab.h>
> +
> +#define IMX7ULP_MAX_LINKS 32
> +
> +/**
> + * Clock property of node
The format should be:
struct my_struct - short description
> + * @name: The name of the clock
> + * @clk: A pointer to the clock
> + * @rate: The rate to use, when the clock frequency is updated
> + */
> +struct imx7ulp_bus_clock {
> + char *name;
> + struct clk *clk;
> + u64 rate;
> +};
> +
> +/**
> + * IMX7ULP specific interconnect nodes
Ditto.
> + * @name: the node name used in debugfs
> + * @id: a unique node identifier
> + * @links: an array of nodes where we can go next while traversing
> + * @num_links: the total number of @links
> + * @buswidth: width (in bit) of the interconnect between a node and the bus
> + * @bus_clk: If not NULL, define clock properties of the node
> + * @ep: true if the node is an end point. Used to scale the frequency
> + */
> +struct imx7ulp_icc_node {
> + char *name;
> + u16 id;
> + u16 links[IMX7ULP_MAX_LINKS];
> + u16 num_links;
> + u16 buswidth;
> + struct imx7ulp_bus_clock *bus_clk;
> + bool ep;
> +};
> +
> +/**
Ditto.
> + * @dev: device pointer for the overall interconnect
> + * Although there are 2 interconnects, they are represented using one
> + * device.
> + * @nodes: Array of nodes
> + * @num_nodes: The total number of nodes
> + * @nic0: Clock properties for nic0 interconnect
> + * @nic1: Clock properties for nic1 interconnect
> + */
> +struct imx7ulp_icc_desc {
> + struct device *dev;
> + struct imx7ulp_icc_node *nodes;
> + size_t num_nodes;
> + struct imx7ulp_bus_clock *nic0;
> + struct imx7ulp_bus_clock *nic1;
> +};
I assume that we can be only change the rate of the interconnect clocks
and there are no other knobs? Is this correct? If that's the case, i
don't see a problem to represent it as a single device.
> +
> +#define DEFINE_AXI_INTERCONNECT(_name, _id, _buswidth, _ep, _clk, \
> + _numlinks, ...) \
> + { \
> + .id = _id, \
> + .name = #_name, \
> + .buswidth = (_buswidth * 4), \
Please put parenthesis around _buswidth or avoid potential precedence
issues.
> + .num_links = _numlinks, \
> + .links = { __VA_ARGS__ }, \
> + .ep = _ep, \
> + .bus_clk = _clk, \
> + }
> +
> +#define DEFINE_AXI_MASTER(_name, _id, _buswidth, dest_id) \
> + DEFINE_AXI_INTERCONNECT(_name, _id, _buswidth, false, NULL, \
> + 1, dest_id)
> +
> +#define DEFINE_AXI_SLAVE(_name, _id, _buswidth, _numlinks, ...) \
> + DEFINE_AXI_INTERCONNECT(_name, _id, _buswidth, false, NULL, \
> + _numlinks, __VA_ARGS__)
> +
> +#define DEFINE_AXI_SLAVE_EP(_name, _id, _buswidth) \
> + DEFINE_AXI_INTERCONNECT(_name, _id, _buswidth, true, NULL, 0, 0)
> +
> +#define DEFINE_AHB_SLAVE_EP(_name, _id) \
> + DEFINE_AXI_SLAVE_EP(_name, _id, 4)
> +
> +static struct imx7ulp_bus_clock nic0_clock = {
> + .name = "nic0_div",
> +};
> +
> +static struct imx7ulp_bus_clock nic1_clock = {
> + .name = "nic1_div",
> +};
> +
> +static struct imx7ulp_icc_node imx7ulp_nodes[] = {
> + /* NIC0 Masters */
> + DEFINE_AXI_MASTER(a7, 2000, 16, 1000),
> + DEFINE_AXI_MASTER(nic1_s1, 2001, 8, 1000),
> + DEFINE_AXI_MASTER(dsi, 2002, 4, 1000),
> + DEFINE_AXI_MASTER(gpu3d, 2003, 8, 1000),
> + DEFINE_AXI_MASTER(gpu2d, 2004, 16, 1000),
> +
> + /* NIC0 Slaves */
> + DEFINE_AXI_SLAVE_EP(mmdc, 2005, 16),
> + DEFINE_AXI_SLAVE_EP(sram0, 2006, 8),
> +
> + /* NIC0 */
> + DEFINE_AXI_INTERCONNECT(nic0_m, 1000, 8, false, &nic0_clock, 1, 1001),
> + DEFINE_AXI_INTERCONNECT(nic0_s, 1001, 8, false, NULL, 3,
> + 2005, 2006, 1008),
> +
> + /* NIC1 Masters */
> + DEFINE_AXI_MASTER(dma1_m, 2011, 8, 1008),
> + DEFINE_AXI_MASTER(caam_m, 2013, 4, 1008),
> + DEFINE_AXI_MASTER(usbotg_m, 2014, 4, 1008),
> + DEFINE_AXI_MASTER(viu_m, 2015, 8, 1008),
> + DEFINE_AXI_MASTER(usdhc0_m, 2016, 4, 1008),
> + DEFINE_AXI_MASTER(usdhc1_m, 2017, 4, 1008),
> +
> + /* NIC1 Slaves */
> + DEFINE_AXI_SLAVE_EP(sram1, 2018, 8),
> + DEFINE_AXI_SLAVE_EP(secure_ram, 2020, 4),
> + DEFINE_AXI_SLAVE_EP(rom, 2023, 4), /* Also flexbus, gpu 2d and 3d */
> + DEFINE_AXI_SLAVE_EP(m4xbar, 2024, 4),
> +
> + /* AHB0 */
> + DEFINE_AHB_SLAVE_EP(dma1, 8),
> + DEFINE_AHB_SLAVE_EP(dmadesc1, 9),
> + DEFINE_AHB_SLAVE_EP(rgpio2p, 15),
> + DEFINE_AHB_SLAVE_EP(flexbus, 16),
> + DEFINE_AHB_SLAVE_EP(sema42_1, 27),
> + DEFINE_AHB_SLAVE_EP(dmamux1, 33),
> + DEFINE_AHB_SLAVE_EP(mu_b, 34),
> + DEFINE_AHB_SLAVE_EP(caam, 36),
> + DEFINE_AHB_SLAVE_EP(tpm4, 37),
> + DEFINE_AHB_SLAVE_EP(tpm5, 38),
> + DEFINE_AHB_SLAVE_EP(lpit1, 39),
> + DEFINE_AHB_SLAVE_EP(lpspi2, 41),
> + DEFINE_AHB_SLAVE_EP(lpspi3, 42),
> + DEFINE_AHB_SLAVE_EP(lpi2c4, 43),
> + DEFINE_AHB_SLAVE_EP(lpi2c5, 44),
> + DEFINE_AHB_SLAVE_EP(lpuart4, 45),
> + DEFINE_AHB_SLAVE_EP(lpuart5, 46),
> + DEFINE_AHB_SLAVE_EP(flexio1, 49),
> + DEFINE_AHB_SLAVE_EP(usbotg1, 51),
> + DEFINE_AHB_SLAVE_EP(usbotg2, 52),
> + DEFINE_AHB_SLAVE_EP(usbphy, 53),
> + DEFINE_AHB_SLAVE_EP(usbpl301, 54),
> + DEFINE_AHB_SLAVE_EP(usdhc0, 55),
> + DEFINE_AHB_SLAVE_EP(usdhc1, 56),
> + DEFINE_AHB_SLAVE_EP(trgmux1, 59),
> + DEFINE_AHB_SLAVE_EP(wdog1, 61),
> + DEFINE_AHB_SLAVE_EP(scg1, 62),
> + DEFINE_AHB_SLAVE_EP(pcc2, 63),
> + DEFINE_AHB_SLAVE_EP(pmc1, 64),
> + DEFINE_AHB_SLAVE_EP(cmc1, 65),
> + DEFINE_AHB_SLAVE_EP(wdog2, 67),
> +
> + DEFINE_AXI_SLAVE(ahb0, 2021, 4, 32,
> + 8, 9, 15, 16, 27, 33, 34, 35, 36, 37, 38, 39, 41, 42,
> + 43, 44, 45, 46, 49, 51, 52, 53, 54, 55, 56, 59, 61, 62,
> + 63, 64, 65, 67),
> +
> + /* AHB1 */
> + DEFINE_AHB_SLAVE_EP(romc1, 116),
> + DEFINE_AHB_SLAVE_EP(tpm6, 133),
> + DEFINE_AHB_SLAVE_EP(tpm7, 134),
> + DEFINE_AHB_SLAVE_EP(lpi2c6, 136),
> + DEFINE_AHB_SLAVE_EP(lpi2c7, 137),
> + DEFINE_AHB_SLAVE_EP(lpuart6, 138),
> + DEFINE_AHB_SLAVE_EP(lpuart7, 139),
> + DEFINE_AHB_SLAVE_EP(viu, 140),
> + DEFINE_AHB_SLAVE_EP(dsi, 141),
> + DEFINE_AHB_SLAVE_EP(lcdif, 142),
> + DEFINE_AHB_SLAVE_EP(mmdc, 143),
> + DEFINE_AHB_SLAVE_EP(iomuxc1, 144),
> + DEFINE_AHB_SLAVE_EP(iomuxc_ddr, 145),
> + DEFINE_AHB_SLAVE_EP(pctlc, 146),
> + DEFINE_AHB_SLAVE_EP(pctld, 147),
> + DEFINE_AHB_SLAVE_EP(pctle, 148),
> + DEFINE_AHB_SLAVE_EP(pctlf, 149),
> + DEFINE_AHB_SLAVE_EP(pcc3, 151),
> +
> + DEFINE_AXI_SLAVE(ahb1, 2022, 4, 19,
> + 116, 133, 134, 136, 137, 138, 139, 140, 141,
> + 142, 143, 144, 145, 146, 147, 148, 149, 151),
> +
> + /* NIC1 */
> + DEFINE_AXI_INTERCONNECT(nic1_m, 1008, 8, false, &nic1_clock, 1, 1009),
> + DEFINE_AXI_INTERCONNECT(nic1_s, 1009, 8, false, NULL, 7,
> + 2018, 1000, 2020, 2021, 2022, 2023, 2024),> +};
> +
> +static struct imx7ulp_icc_desc icc_desc = {
> + .nodes = (struct imx7ulp_icc_node *)&imx7ulp_nodes,
> + .num_nodes = ARRAY_SIZE(imx7ulp_nodes),
> +};
> +
> +static int imx7ulp_icc_aggregate(struct icc_node *node, u32 avg_bw,
> + u32 peak_bw, u32 *agg_avg, u32 *agg_peak)
> +{
> + *agg_avg += avg_bw;
> + *agg_peak = max(*agg_peak, peak_bw);
> +
> + return 0;
> +}
> +
> +static int imx7ulp_icc_set(struct icc_node *src, struct icc_node *dst)
> +{
> + int ret;
> + struct imx7ulp_icc_node *node;
> + struct imx7ulp_icc_desc *desc = src->provider->data;
> +
> + /* If node has a clock, compute the new rate */
> + node = src->data;
> + if (node->bus_clk) {
> + u64 rate;
> + struct imx7ulp_bus_clock *bus_clk = node->bus_clk;
> +
> + rate = (src->peak_bw / node->buswidth) * 1000;
Maybe use do_div().
> + rate = clk_round_rate(bus_clk->clk, rate);
> + if (rate != bus_clk->rate) {
> + dev_dbg(desc->dev, "%s: new rate = %llu\n",
> + bus_clk->name, rate);
> + bus_clk->rate = rate;
> + }
> + }
> +
> + /*
> + * If the node is an endpoint, update the clock rate of nic0 and nic1
> + * nodes. nic1 clock derives from nic0, so we usually have to update
> + * both of them even if bandwidth changed only for one of the
> + * interconnect.
> + */
> + node = dst->data;
> + if (node->ep) {
> + struct imx7ulp_bus_clock *nic0_clk = desc->nic0;
> + struct imx7ulp_bus_clock *nic1_clk = desc->nic1;
> +
> + if (nic1_clk->rate > nic0_clk->rate)
> + nic0_clk->rate = nic1_clk->rate;
> +
> + if (clk_get_rate(nic0_clk->clk) != nic0_clk->rate) {
> + dev_dbg(desc->dev, "%s: apply rate = %llu\n",
> + nic0_clk->name, nic0_clk->rate);
> + ret = clk_set_rate(nic0_clk->clk, nic0_clk->rate);
> + if (ret)
> + dev_err(desc->dev, "Failed to set clock: %d\n",
> + ret);
> + }
> +
> + if (clk_get_rate(nic1_clk->clk) != nic1_clk->rate) {
> + dev_dbg(desc->dev, "%s: apply rate = %llu\n",
> + nic1_clk->name, nic1_clk->rate);
> + ret = clk_set_rate(nic1_clk->clk, nic1_clk->rate);
> + if (ret)
> + dev_err(desc->dev, "Failed to set clock: %d\n",
> + ret);
> + }
> + }
> +
> + return 0;
Just f.y.i, i recently introduced another patch that reverts to the
settings to the previous configuration if any of the requests fail, so
you can also return errors here (if it makes sense to do so on this
platform).
> +}
> +
> +static int imx7ulp_probe(struct platform_device *pdev)
> +{
> + struct imx7ulp_icc_desc *desc = &icc_desc;
> + struct icc_provider *provider;
> + size_t i;
> + int ret;
> +
> + desc->dev = &pdev->dev;
> + desc->nic0 = &nic0_clock;
> + desc->nic1 = &nic1_clock;
> +
> + provider = devm_kzalloc(&pdev->dev, sizeof(*provider), GFP_KERNEL);
> + provider->set = imx7ulp_icc_set;
> + provider->aggregate = imx7ulp_icc_aggregate;
If you want to use DT, you will need to put the endpoint IDs in some
header file and implement the xlate() function or use the generic
of_icc_xlate_onecell().
> + INIT_LIST_HEAD(&provider->nodes);
> + provider->data = desc;
> +
> + ret = icc_provider_add(provider);
> + if (ret) {
> + dev_err(&pdev->dev, "error adding interconnect provider\n");
> + return ret;
> + }
> +
> + for (i = 0; i < desc->num_nodes; i++) {
> + struct icc_node *node;
> + int ret;
> + size_t j;
> +
> + if (desc->nodes[i].bus_clk) {
> + struct imx7ulp_bus_clock *bus_clk;
> +
> + bus_clk = desc->nodes[i].bus_clk;
> + bus_clk->clk = devm_clk_get(&pdev->dev, bus_clk->name);
> + if (IS_ERR(bus_clk->clk)) {
> + dev_err(&pdev->dev,
> + "Failed to get clock %s: %d\n",
> + bus_clk->name, PTR_ERR(bus_clk->clk));
> + ret = PTR_ERR(bus_clk->clk);
> + goto err;
> + }
> +
> + ret = clk_prepare_enable(bus_clk->clk);
> + if (ret) {
> + dev_err(&pdev->dev,
> + "error enabling clock: %s %d\n",
> + bus_clk->name, ret);
> + goto err;
> + }
> + }
> +
> + node = icc_node_create(desc->nodes[i].id);
> + if (IS_ERR(node)) {
> + ret = PTR_ERR(node);
> + dev_err(&pdev->dev, "Failed to create node %s\n",
> + desc->nodes[i].name);
> + goto err;
> + }
> +
> + node->name = desc->nodes[i].name;
> + node->data = &desc->nodes[i];
> + icc_node_add(node, provider);
> +
> + dev_dbg(&pdev->dev, "registered node %p %s %d\n", node,
> + desc->nodes[i].name, node->id);
> +
> + for (j = 0; j < desc->nodes[i].num_links; j++)
> + if (desc->nodes[i].links[j])
> + icc_link_create(node, desc->nodes[i].links[j]);
> + }
> +
> + platform_set_drvdata(pdev, provider);
> +
> + return 0;
> +err:
> + icc_provider_del(provider);
First delete the nodes (if any) and then the provider.
> + return ret;
> +}
> +
> +static int imx7ulp_remove(struct platform_device *pdev)
> +{
> + struct icc_provider *provider = platform_get_drvdata(pdev);
> +
> + icc_provider_del(provider);
Ditto.
> + return 0;
> +}
> +
> +static const struct of_device_id imx7ulp_of_match[] = {
> + { .compatible = "fsl,imx7ulp-icc" },
> + { },
> +};
> +MODULE_DEVICE_TABLE(of, imx7ulp_of_match);
> +
> +static struct platform_driver imx7ulp_driver = {
> + .probe = imx7ulp_probe,
> + .remove = imx7ulp_remove,
> + .driver = {
> + .name = "imx7ulp-icc",
> + .of_match_table = imx7ulp_of_match,
> + },
> +};
> +module_platform_driver(imx7ulp_driver);
Please use builtin_platform_driver if it can't be a module.
Thank you for working on this! I am expecting the next version.
BR,
Georgi
Hi Georgi,
Sorry for the late response, I have just seen today that you have
reviewed my patch.
On 1/21/19 6:41 PM, Georgi Djakov wrote:
> Thank you for working on this! I am expecting the next version.
I'm going to send a new patchset soon.
I have rewritten pretty much everything, to handle some hardware
limitations, and to be more generic.
Anyways, most of your comments still makes sense for the new patchset so
I will fix them before to submit it.
>
> BR,
> Georgi
>
Best Regards,
Alexandre