1 /* Copyright (c) 2012, The Linux Foundation. All rights reserved.
3 * This program is free software; you can redistribute it and/or modify
4 * it under the terms of the GNU General Public License version 2 and
5 * only version 2 as published by the Free Software Foundation.
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
13 #include <linux/module.h>
14 #include <linux/types.h>
15 #include <linux/err.h>
16 #include <linux/slab.h>
17 #include <linux/clk.h>
19 #include <linux/of_address.h>
20 #include <linux/of_graph.h>
21 #include <linux/of_platform.h>
22 #include <linux/platform_device.h>
23 #include <linux/amba/bus.h>
24 #include <linux/coresight.h>
25 #include <asm/smp_plat.h>
28 static int of_dev_node_match(struct device *dev, void *data)
30 return dev->of_node == data;
33 static struct device *
34 of_coresight_get_endpoint_device(struct device_node *endpoint)
36 struct device *dev = NULL;
39 * If we have a non-configuable replicator, it will be found on the
42 dev = bus_find_device(&platform_bus_type, NULL,
43 endpoint, of_dev_node_match);
48 * We have a configurable component - circle through the AMBA bus
49 * looking for the device that matches the endpoint node.
51 return bus_find_device(&amba_bustype, NULL,
52 endpoint, of_dev_node_match);
55 static struct device_node *of_get_coresight_endpoint(
56 const struct device_node *parent, struct device_node *prev)
58 struct device_node *node = of_graph_get_next_endpoint(parent, prev);
64 static void of_coresight_get_ports(struct device_node *node,
65 int *nr_inport, int *nr_outport)
67 struct device_node *ep = NULL;
71 ep = of_get_coresight_endpoint(node, ep);
75 if (of_property_read_bool(ep, "slave-mode"))
86 static int of_coresight_alloc_memory(struct device *dev,
87 struct coresight_platform_data *pdata)
89 /* List of output port on this component */
90 pdata->outports = devm_kzalloc(dev, pdata->nr_outport *
91 sizeof(*pdata->outports),
96 /* Children connected to this component via @outports */
97 pdata->child_names = devm_kzalloc(dev, pdata->nr_outport *
98 sizeof(*pdata->child_names),
100 if (!pdata->child_names)
103 /* Port number on the child this component is connected to */
104 pdata->child_ports = devm_kzalloc(dev, pdata->nr_outport *
105 sizeof(*pdata->child_ports),
107 if (!pdata->child_ports)
113 struct coresight_platform_data *of_get_coresight_platform_data(
114 struct device *dev, struct device_node *node)
117 struct coresight_platform_data *pdata;
118 struct of_endpoint endpoint, rendpoint;
120 struct device_node *dn;
121 struct device_node *ep = NULL;
122 struct device_node *rparent = NULL;
123 struct device_node *rport = NULL;
125 pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
127 return ERR_PTR(-ENOMEM);
129 /* Use device name as sysfs handle */
130 pdata->name = dev_name(dev);
132 /* Get the number of input and output port for this component */
133 of_coresight_get_ports(node, &pdata->nr_inport, &pdata->nr_outport);
135 if (pdata->nr_outport) {
136 ret = of_coresight_alloc_memory(dev, pdata);
140 /* Iterate through each port to discover topology */
142 /* Get a handle on a port */
143 ep = of_get_coresight_endpoint(node, ep);
148 * No need to deal with input ports, processing for as
149 * processing for output ports will deal with them.
151 if (of_find_property(ep, "slave-mode", NULL))
154 /* Get a handle on the local endpoint */
155 ret = of_graph_parse_endpoint(ep, &endpoint);
160 /* The local out port number */
161 pdata->outports[i] = endpoint.id;
164 * Get a handle on the remote port and parent
167 rparent = of_graph_get_remote_port_parent(ep);
168 rport = of_graph_get_remote_port(ep);
170 if (!rparent || !rport)
173 if (of_graph_parse_endpoint(rport, &rendpoint))
176 rdev = of_coresight_get_endpoint_device(rparent);
180 pdata->child_names[i] = dev_name(rdev);
181 pdata->child_ports[i] = rendpoint.id;
187 /* Affinity defaults to CPU0 */
189 dn = of_parse_phandle(node, "cpu", 0);
195 cell = of_get_property(dn, "reg", &len);
197 hwid = of_read_number(cell, of_n_addr_cells(dn));
198 index = get_logical_index(hwid);
199 if (index != -EINVAL)
206 EXPORT_SYMBOL_GPL(of_get_coresight_platform_data);