1caab277bSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2f76ee892STomi Valkeinen /*
3f76ee892STomi Valkeinen * Copyright (C) 2014 Texas Instruments
4f76ee892STomi Valkeinen * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
5f76ee892STomi Valkeinen */
6f76ee892STomi Valkeinen
7f76ee892STomi Valkeinen /*
8f76ee892STomi Valkeinen * As omapdss panel drivers are omapdss specific, but we want to define the
9f76ee892STomi Valkeinen * DT-data in generic manner, we convert the compatible strings of the panel and
10f76ee892STomi Valkeinen * encoder nodes from "panel-foo" to "omapdss,panel-foo". This way we can have
11f76ee892STomi Valkeinen * both correct DT data and omapdss specific drivers.
12f76ee892STomi Valkeinen *
13f76ee892STomi Valkeinen * When we get generic panel drivers to the kernel, this file will be removed.
14f76ee892STomi Valkeinen */
15f76ee892STomi Valkeinen
16f76ee892STomi Valkeinen #include <linux/kernel.h>
17f76ee892STomi Valkeinen #include <linux/of.h>
18f76ee892STomi Valkeinen #include <linux/of_graph.h>
19f76ee892STomi Valkeinen #include <linux/slab.h>
20f76ee892STomi Valkeinen #include <linux/list.h>
21f76ee892STomi Valkeinen
22f76ee892STomi Valkeinen static struct list_head dss_conv_list __initdata;
23f76ee892STomi Valkeinen
24f76ee892STomi Valkeinen static const char prefix[] __initconst = "omapdss,";
25f76ee892STomi Valkeinen
26f76ee892STomi Valkeinen struct dss_conv_node {
27f76ee892STomi Valkeinen struct list_head list;
28f76ee892STomi Valkeinen struct device_node *node;
29f76ee892STomi Valkeinen bool root;
30f76ee892STomi Valkeinen };
31f76ee892STomi Valkeinen
omapdss_count_strings(const struct property * prop)32f76ee892STomi Valkeinen static int __init omapdss_count_strings(const struct property *prop)
33f76ee892STomi Valkeinen {
34f76ee892STomi Valkeinen const char *p = prop->value;
35f76ee892STomi Valkeinen int l = 0, total = 0;
36f76ee892STomi Valkeinen int i;
37f76ee892STomi Valkeinen
38f76ee892STomi Valkeinen for (i = 0; total < prop->length; total += l, p += l, i++)
39f76ee892STomi Valkeinen l = strlen(p) + 1;
40f76ee892STomi Valkeinen
41f76ee892STomi Valkeinen return i;
42f76ee892STomi Valkeinen }
43f76ee892STomi Valkeinen
omapdss_update_prop(struct device_node * node,char * compat,int len)44f76ee892STomi Valkeinen static void __init omapdss_update_prop(struct device_node *node, char *compat,
45f76ee892STomi Valkeinen int len)
46f76ee892STomi Valkeinen {
47f76ee892STomi Valkeinen struct property *prop;
48f76ee892STomi Valkeinen
49f76ee892STomi Valkeinen prop = kzalloc(sizeof(*prop), GFP_KERNEL);
50f76ee892STomi Valkeinen if (!prop)
51f76ee892STomi Valkeinen return;
52f76ee892STomi Valkeinen
53f76ee892STomi Valkeinen prop->name = "compatible";
54f76ee892STomi Valkeinen prop->value = compat;
55f76ee892STomi Valkeinen prop->length = len;
56f76ee892STomi Valkeinen
57f76ee892STomi Valkeinen of_update_property(node, prop);
58f76ee892STomi Valkeinen }
59f76ee892STomi Valkeinen
omapdss_prefix_strcpy(char * dst,int dst_len,const char * src,int src_len)60f76ee892STomi Valkeinen static void __init omapdss_prefix_strcpy(char *dst, int dst_len,
61f76ee892STomi Valkeinen const char *src, int src_len)
62f76ee892STomi Valkeinen {
63f76ee892STomi Valkeinen size_t total = 0;
64f76ee892STomi Valkeinen
65f76ee892STomi Valkeinen while (total < src_len) {
66f76ee892STomi Valkeinen size_t l = strlen(src) + 1;
67f76ee892STomi Valkeinen
68f76ee892STomi Valkeinen strcpy(dst, prefix);
69f76ee892STomi Valkeinen dst += strlen(prefix);
70f76ee892STomi Valkeinen
71f76ee892STomi Valkeinen strcpy(dst, src);
72f76ee892STomi Valkeinen dst += l;
73f76ee892STomi Valkeinen
74f76ee892STomi Valkeinen src += l;
75f76ee892STomi Valkeinen total += l;
76f76ee892STomi Valkeinen }
77f76ee892STomi Valkeinen }
78f76ee892STomi Valkeinen
79f76ee892STomi Valkeinen /* prepend compatible property strings with "omapdss," */
omapdss_omapify_node(struct device_node * node)80f76ee892STomi Valkeinen static void __init omapdss_omapify_node(struct device_node *node)
81f76ee892STomi Valkeinen {
82f76ee892STomi Valkeinen struct property *prop;
83f76ee892STomi Valkeinen char *new_compat;
84f76ee892STomi Valkeinen int num_strs;
85f76ee892STomi Valkeinen int new_len;
86f76ee892STomi Valkeinen
87f76ee892STomi Valkeinen prop = of_find_property(node, "compatible", NULL);
88f76ee892STomi Valkeinen
89f76ee892STomi Valkeinen if (!prop || !prop->value)
90f76ee892STomi Valkeinen return;
91f76ee892STomi Valkeinen
92f76ee892STomi Valkeinen if (strnlen(prop->value, prop->length) >= prop->length)
93f76ee892STomi Valkeinen return;
94f76ee892STomi Valkeinen
95f76ee892STomi Valkeinen /* is it already prefixed? */
96f76ee892STomi Valkeinen if (strncmp(prefix, prop->value, strlen(prefix)) == 0)
97f76ee892STomi Valkeinen return;
98f76ee892STomi Valkeinen
99f76ee892STomi Valkeinen num_strs = omapdss_count_strings(prop);
100f76ee892STomi Valkeinen
101f76ee892STomi Valkeinen new_len = prop->length + strlen(prefix) * num_strs;
102f76ee892STomi Valkeinen new_compat = kmalloc(new_len, GFP_KERNEL);
10331fa6e2aSAditya Pakki if (!new_compat)
10431fa6e2aSAditya Pakki return;
105f76ee892STomi Valkeinen
106f76ee892STomi Valkeinen omapdss_prefix_strcpy(new_compat, new_len, prop->value, prop->length);
107f76ee892STomi Valkeinen
108f76ee892STomi Valkeinen omapdss_update_prop(node, new_compat, new_len);
109f76ee892STomi Valkeinen }
110f76ee892STomi Valkeinen
omapdss_add_to_list(struct device_node * node,bool root)111f76ee892STomi Valkeinen static void __init omapdss_add_to_list(struct device_node *node, bool root)
112f76ee892STomi Valkeinen {
113f76ee892STomi Valkeinen struct dss_conv_node *n = kmalloc(sizeof(struct dss_conv_node),
114f76ee892STomi Valkeinen GFP_KERNEL);
115f76ee892STomi Valkeinen if (n) {
116f76ee892STomi Valkeinen n->node = node;
117f76ee892STomi Valkeinen n->root = root;
118f76ee892STomi Valkeinen list_add(&n->list, &dss_conv_list);
119f76ee892STomi Valkeinen }
120f76ee892STomi Valkeinen }
121f76ee892STomi Valkeinen
omapdss_list_contains(const struct device_node * node)122f76ee892STomi Valkeinen static bool __init omapdss_list_contains(const struct device_node *node)
123f76ee892STomi Valkeinen {
124f76ee892STomi Valkeinen struct dss_conv_node *n;
125f76ee892STomi Valkeinen
126f76ee892STomi Valkeinen list_for_each_entry(n, &dss_conv_list, list) {
127f76ee892STomi Valkeinen if (n->node == node)
128f76ee892STomi Valkeinen return true;
129f76ee892STomi Valkeinen }
130f76ee892STomi Valkeinen
131f76ee892STomi Valkeinen return false;
132f76ee892STomi Valkeinen }
133f76ee892STomi Valkeinen
omapdss_walk_device(struct device_node * node,bool root)134f76ee892STomi Valkeinen static void __init omapdss_walk_device(struct device_node *node, bool root)
135f76ee892STomi Valkeinen {
136f76ee892STomi Valkeinen struct device_node *n;
137f76ee892STomi Valkeinen
138f76ee892STomi Valkeinen omapdss_add_to_list(node, root);
139f76ee892STomi Valkeinen
140f76ee892STomi Valkeinen /*
141f76ee892STomi Valkeinen * of_graph_get_remote_port_parent() prints an error if there is no
142f76ee892STomi Valkeinen * port/ports node. To avoid that, check first that there's the node.
143f76ee892STomi Valkeinen */
144f76ee892STomi Valkeinen n = of_get_child_by_name(node, "ports");
145f76ee892STomi Valkeinen if (!n)
146f76ee892STomi Valkeinen n = of_get_child_by_name(node, "port");
147f76ee892STomi Valkeinen if (!n)
148f76ee892STomi Valkeinen return;
149f76ee892STomi Valkeinen
150f76ee892STomi Valkeinen of_node_put(n);
151f76ee892STomi Valkeinen
152f76ee892STomi Valkeinen n = NULL;
153f76ee892STomi Valkeinen while ((n = of_graph_get_next_endpoint(node, n)) != NULL) {
154f76ee892STomi Valkeinen struct device_node *pn;
155f76ee892STomi Valkeinen
156f76ee892STomi Valkeinen pn = of_graph_get_remote_port_parent(n);
157f76ee892STomi Valkeinen
158f76ee892STomi Valkeinen if (!pn)
159f76ee892STomi Valkeinen continue;
160f76ee892STomi Valkeinen
161f76ee892STomi Valkeinen if (!of_device_is_available(pn) || omapdss_list_contains(pn)) {
162f76ee892STomi Valkeinen of_node_put(pn);
163f76ee892STomi Valkeinen continue;
164f76ee892STomi Valkeinen }
165f76ee892STomi Valkeinen
166f76ee892STomi Valkeinen omapdss_walk_device(pn, false);
167f76ee892STomi Valkeinen }
168f76ee892STomi Valkeinen }
169f76ee892STomi Valkeinen
170f76ee892STomi Valkeinen static const struct of_device_id omapdss_of_match[] __initconst = {
171f76ee892STomi Valkeinen { .compatible = "ti,omap2-dss", },
172f76ee892STomi Valkeinen { .compatible = "ti,omap3-dss", },
173f76ee892STomi Valkeinen { .compatible = "ti,omap4-dss", },
174f76ee892STomi Valkeinen { .compatible = "ti,omap5-dss", },
175f76ee892STomi Valkeinen { .compatible = "ti,dra7-dss", },
176f76ee892STomi Valkeinen {},
177f76ee892STomi Valkeinen };
178f76ee892STomi Valkeinen
omapdss_boot_init(void)179f76ee892STomi Valkeinen static int __init omapdss_boot_init(void)
180f76ee892STomi Valkeinen {
181f76ee892STomi Valkeinen struct device_node *dss, *child;
182f76ee892STomi Valkeinen
183f76ee892STomi Valkeinen INIT_LIST_HEAD(&dss_conv_list);
184f76ee892STomi Valkeinen
185f76ee892STomi Valkeinen dss = of_find_matching_node(NULL, omapdss_of_match);
186f76ee892STomi Valkeinen
187787a7923SJulia Lawall if (dss == NULL || !of_device_is_available(dss)) {
188787a7923SJulia Lawall of_node_put(dss);
189f76ee892STomi Valkeinen return 0;
190787a7923SJulia Lawall }
191f76ee892STomi Valkeinen
192f76ee892STomi Valkeinen omapdss_walk_device(dss, true);
193f76ee892STomi Valkeinen
194f76ee892STomi Valkeinen for_each_available_child_of_node(dss, child) {
195*29413f05SRob Herring if (!of_property_present(child, "compatible"))
196f76ee892STomi Valkeinen continue;
197f76ee892STomi Valkeinen
198f76ee892STomi Valkeinen omapdss_walk_device(child, true);
199f76ee892STomi Valkeinen }
200f76ee892STomi Valkeinen
201f76ee892STomi Valkeinen while (!list_empty(&dss_conv_list)) {
202f76ee892STomi Valkeinen struct dss_conv_node *n;
203f76ee892STomi Valkeinen
204f76ee892STomi Valkeinen n = list_first_entry(&dss_conv_list, struct dss_conv_node,
205f76ee892STomi Valkeinen list);
206f76ee892STomi Valkeinen
207f76ee892STomi Valkeinen if (!n->root)
208f76ee892STomi Valkeinen omapdss_omapify_node(n->node);
209f76ee892STomi Valkeinen
210f76ee892STomi Valkeinen list_del(&n->list);
211f76ee892STomi Valkeinen of_node_put(n->node);
212f76ee892STomi Valkeinen kfree(n);
213f76ee892STomi Valkeinen }
214f76ee892STomi Valkeinen
215f76ee892STomi Valkeinen return 0;
216f76ee892STomi Valkeinen }
217f76ee892STomi Valkeinen
218f76ee892STomi Valkeinen subsys_initcall(omapdss_boot_init);
219