Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Interconnect framework driver for i.MX SoC
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * Copyright (c) 2019, BayLibre
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  * Copyright (c) 2019-2020, NXP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  * Author: Alexandre Bailon <abailon@baylibre.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  * Author: Leonard Crestez <leonard.crestez@nxp.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/interconnect-provider.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/of_platform.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/pm_qos.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include "imx.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) /* private icc_node data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) struct imx_icc_node {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) 	const struct imx_icc_node_desc *desc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 	struct device *qos_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 	struct dev_pm_qos_request qos_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) static int imx_icc_node_set(struct icc_node *node)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	struct device *dev = node->provider->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	struct imx_icc_node *node_data = node->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 	u64 freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	if (!node_data->qos_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 	freq = (node->avg_bw + node->peak_bw) * node_data->desc->adj->bw_mul;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 	do_div(freq, node_data->desc->adj->bw_div);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 	dev_dbg(dev, "node %s device %s avg_bw %ukBps peak_bw %ukBps min_freq %llukHz\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 		node->name, dev_name(node_data->qos_dev),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 		node->avg_bw, node->peak_bw, freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	if (freq > S32_MAX) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 		dev_err(dev, "%s can't request more than S32_MAX freq\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 				node->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 		return -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	dev_pm_qos_update_request(&node_data->qos_req, freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) static int imx_icc_set(struct icc_node *src, struct icc_node *dst)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	return imx_icc_node_set(dst);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) /* imx_icc_node_destroy() - Destroy an imx icc_node, including private data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) static void imx_icc_node_destroy(struct icc_node *node)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	struct imx_icc_node *node_data = node->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	if (dev_pm_qos_request_active(&node_data->qos_req)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 		ret = dev_pm_qos_remove_request(&node_data->qos_req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 		if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 			dev_warn(node->provider->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 				 "failed to remove qos request for %s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 				 dev_name(node_data->qos_dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	put_device(node_data->qos_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	icc_node_del(node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	icc_node_destroy(node->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) static int imx_icc_node_init_qos(struct icc_provider *provider,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 				 struct icc_node *node)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	struct imx_icc_node *node_data = node->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	const struct imx_icc_node_adj_desc *adj = node_data->desc->adj;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	struct device *dev = provider->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	struct device_node *dn = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	struct platform_device *pdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	if (adj->main_noc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 		node_data->qos_dev = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 		dev_dbg(dev, "icc node %s[%d] is main noc itself\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 			node->name, node->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 		dn = of_parse_phandle(dev->of_node, adj->phandle_name, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 		if (!dn) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 			dev_warn(dev, "Failed to parse %s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 				 adj->phandle_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 			return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 		/* Allow scaling to be disabled on a per-node basis */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 		if (!dn || !of_device_is_available(dn)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 			dev_warn(dev, "Missing property %s, skip scaling %s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 				 adj->phandle_name, node->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 			of_node_put(dn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 			return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 		pdev = of_find_device_by_node(dn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 		of_node_put(dn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 		if (!pdev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 			dev_warn(dev, "node %s[%d] missing device for %pOF\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 				 node->name, node->id, dn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 			return -EPROBE_DEFER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		node_data->qos_dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 		dev_dbg(dev, "node %s[%d] has device node %pOF\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 			node->name, node->id, dn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 	return dev_pm_qos_add_request(node_data->qos_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 				      &node_data->qos_req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 				      DEV_PM_QOS_MIN_FREQUENCY, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) static struct icc_node *imx_icc_node_add(struct icc_provider *provider,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 					 const struct imx_icc_node_desc *node_desc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	struct device *dev = provider->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	struct imx_icc_node *node_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 	struct icc_node *node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	node = icc_node_create(node_desc->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	if (IS_ERR(node)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 		dev_err(dev, "failed to create node %d\n", node_desc->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 		return node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	if (node->data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 		dev_err(dev, "already created node %s id=%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 			node_desc->name, node_desc->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 		return ERR_PTR(-EEXIST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	node_data = devm_kzalloc(dev, sizeof(*node_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	if (!node_data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 		icc_node_destroy(node->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 		return ERR_PTR(-ENOMEM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	node->name = node_desc->name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	node->data = node_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	node_data->desc = node_desc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	icc_node_add(node, provider);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	if (node_desc->adj) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 		ret = imx_icc_node_init_qos(provider, node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 		if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 			imx_icc_node_destroy(node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 			return ERR_PTR(ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	return node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) static void imx_icc_unregister_nodes(struct icc_provider *provider)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	struct icc_node *node, *tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	list_for_each_entry_safe(node, tmp, &provider->nodes, node_list)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 		imx_icc_node_destroy(node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) static int imx_icc_register_nodes(struct icc_provider *provider,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 				  const struct imx_icc_node_desc *descs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 				  int count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	struct icc_onecell_data *provider_data = provider->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	for (i = 0; i < count; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 		struct icc_node *node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 		const struct imx_icc_node_desc *node_desc = &descs[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 		size_t j;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 		node = imx_icc_node_add(provider, node_desc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 		if (IS_ERR(node)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 			ret = dev_err_probe(provider->dev, PTR_ERR(node),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 					    "failed to add %s\n", node_desc->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 			goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 		provider_data->nodes[node->id] = node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 		for (j = 0; j < node_desc->num_links; j++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 			ret = icc_link_create(node, node_desc->links[j]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 			if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 				dev_err(provider->dev, "failed to link node %d to %d: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 					node->id, node_desc->links[j], ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 				goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 	imx_icc_unregister_nodes(provider);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) static int get_max_node_id(struct imx_icc_node_desc *nodes, int nodes_count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 	int i, ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 	for (i = 0; i < nodes_count; ++i)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 		if (nodes[i].id > ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 			ret = nodes[i].id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) int imx_icc_register(struct platform_device *pdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 		     struct imx_icc_node_desc *nodes, int nodes_count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 	struct device *dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	struct icc_onecell_data *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 	struct icc_provider *provider;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	int max_node_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 	/* icc_onecell_data is indexed by node_id, unlike nodes param */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 	max_node_id = get_max_node_id(nodes, nodes_count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	data = devm_kzalloc(dev, struct_size(data, nodes, max_node_id),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 			    GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 	if (!data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	data->num_nodes = max_node_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 	provider = devm_kzalloc(dev, sizeof(*provider), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	if (!provider)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 	provider->set = imx_icc_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 	provider->aggregate = icc_std_aggregate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 	provider->xlate = of_icc_xlate_onecell;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 	provider->data = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	provider->dev = dev->parent;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 	platform_set_drvdata(pdev, provider);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	ret = icc_provider_add(provider);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 		dev_err(dev, "error adding interconnect provider: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	ret = imx_icc_register_nodes(provider, nodes, nodes_count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 		goto provider_del;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) provider_del:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	icc_provider_del(provider);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) EXPORT_SYMBOL_GPL(imx_icc_register);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) int imx_icc_unregister(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	struct icc_provider *provider = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	imx_icc_unregister_nodes(provider);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	return icc_provider_del(provider);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) EXPORT_SYMBOL_GPL(imx_icc_unregister);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) MODULE_LICENSE("GPL v2");