1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (C) 2013 Texas Instruments
4 * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
5 */
6
7 #include <linux/device.h>
8 #include <linux/err.h>
9 #include <linux/module.h>
10 #include <linux/of.h>
11 #include <linux/of_graph.h>
12 #include <linux/seq_file.h>
13
14 #include <video/omapfb_dss.h>
15
16 #include "dss.h"
17
18 struct device_node *
omapdss_of_get_next_port(const struct device_node * parent,struct device_node * prev)19 omapdss_of_get_next_port(const struct device_node *parent,
20 struct device_node *prev)
21 {
22 struct device_node *port = NULL;
23
24 if (!parent)
25 return NULL;
26
27 if (!prev) {
28 struct device_node *ports;
29 /*
30 * It's the first call, we have to find a port subnode
31 * within this node or within an optional 'ports' node.
32 */
33 ports = of_get_child_by_name(parent, "ports");
34 if (ports)
35 parent = ports;
36
37 port = of_get_child_by_name(parent, "port");
38
39 /* release the 'ports' node */
40 of_node_put(ports);
41 } else {
42 struct device_node *ports;
43
44 ports = of_get_parent(prev);
45 if (!ports)
46 return NULL;
47
48 do {
49 port = of_get_next_child(ports, prev);
50 if (!port) {
51 of_node_put(ports);
52 return NULL;
53 }
54 prev = port;
55 } while (!of_node_name_eq(port, "port"));
56
57 of_node_put(ports);
58 }
59
60 return port;
61 }
62 EXPORT_SYMBOL_GPL(omapdss_of_get_next_port);
63
64 struct device_node *
omapdss_of_get_next_endpoint(const struct device_node * parent,struct device_node * prev)65 omapdss_of_get_next_endpoint(const struct device_node *parent,
66 struct device_node *prev)
67 {
68 struct device_node *ep = NULL;
69
70 if (!parent)
71 return NULL;
72
73 do {
74 ep = of_get_next_child(parent, prev);
75 if (!ep)
76 return NULL;
77 prev = ep;
78 } while (!of_node_name_eq(ep, "endpoint"));
79
80 return ep;
81 }
82 EXPORT_SYMBOL_GPL(omapdss_of_get_next_endpoint);
83
dss_of_port_get_parent_device(struct device_node * port)84 struct device_node *dss_of_port_get_parent_device(struct device_node *port)
85 {
86 struct device_node *np;
87 int i;
88
89 if (!port)
90 return NULL;
91
92 np = of_get_parent(port);
93
94 for (i = 0; i < 2 && np; ++i) {
95 struct property *prop;
96
97 prop = of_find_property(np, "compatible", NULL);
98
99 if (prop)
100 return np;
101
102 np = of_get_next_parent(np);
103 }
104
105 of_node_put(np);
106 return NULL;
107 }
108
dss_of_port_get_port_number(struct device_node * port)109 u32 dss_of_port_get_port_number(struct device_node *port)
110 {
111 int r;
112 u32 reg;
113
114 r = of_property_read_u32(port, "reg", ®);
115 if (r)
116 reg = 0;
117
118 return reg;
119 }
120
omapdss_of_get_remote_port(const struct device_node * node)121 static struct device_node *omapdss_of_get_remote_port(const struct device_node *node)
122 {
123 struct device_node *np;
124
125 np = of_graph_get_remote_endpoint(node);
126 if (!np)
127 return NULL;
128
129 np = of_get_next_parent(np);
130
131 return np;
132 }
133
134 struct device_node *
omapdss_of_get_first_endpoint(const struct device_node * parent)135 omapdss_of_get_first_endpoint(const struct device_node *parent)
136 {
137 struct device_node *port, *ep;
138
139 port = omapdss_of_get_next_port(parent, NULL);
140
141 if (!port)
142 return NULL;
143
144 ep = omapdss_of_get_next_endpoint(port, NULL);
145
146 of_node_put(port);
147
148 return ep;
149 }
150 EXPORT_SYMBOL_GPL(omapdss_of_get_first_endpoint);
151
152 struct omap_dss_device *
omapdss_of_find_source_for_first_ep(struct device_node * node)153 omapdss_of_find_source_for_first_ep(struct device_node *node)
154 {
155 struct device_node *ep;
156 struct device_node *src_port;
157 struct omap_dss_device *src;
158
159 ep = omapdss_of_get_first_endpoint(node);
160 if (!ep)
161 return ERR_PTR(-EINVAL);
162
163 src_port = omapdss_of_get_remote_port(ep);
164 if (!src_port) {
165 of_node_put(ep);
166 return ERR_PTR(-EINVAL);
167 }
168
169 of_node_put(ep);
170
171 src = omap_dss_find_output_by_port_node(src_port);
172
173 of_node_put(src_port);
174
175 return src ? src : ERR_PTR(-EPROBE_DEFER);
176 }
177 EXPORT_SYMBOL_GPL(omapdss_of_find_source_for_first_ep);
178