Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (C) 2012 Avionic Design GmbH
4 * Copyright (C) 2012 NVIDIA CORPORATION. All rights reserved.
5 */
6
7#include <linux/i2c.h>
8#include <linux/of.h>
9
10#include <drm/drm_atomic_helper.h>
11#include <drm/drm_of.h>
12#include <drm/drm_panel.h>
13#include <drm/drm_simple_kms_helper.h>
14
15#include "drm.h"
16#include "dc.h"
17
18#include <media/cec-notifier.h>
19
20int tegra_output_connector_get_modes(struct drm_connector *connector)
21{
22 struct tegra_output *output = connector_to_output(connector);
23 struct edid *edid = NULL;
24 int err = 0;
25
26 /*
27 * If the panel provides one or more modes, use them exclusively and
28 * ignore any other means of obtaining a mode.
29 */
30 if (output->panel) {
31 err = drm_panel_get_modes(output->panel, connector);
32 if (err > 0)
33 return err;
34 }
35
36 if (output->edid)
37 edid = kmemdup(output->edid, sizeof(*edid), GFP_KERNEL);
38 else if (output->ddc)
39 edid = drm_get_edid(connector, output->ddc);
40
41 cec_notifier_set_phys_addr_from_edid(output->cec, edid);
42 drm_connector_update_edid_property(connector, edid);
43
44 if (edid) {
45 err = drm_add_edid_modes(connector, edid);
46 kfree(edid);
47 }
48
49 return err;
50}
51
52enum drm_connector_status
53tegra_output_connector_detect(struct drm_connector *connector, bool force)
54{
55 struct tegra_output *output = connector_to_output(connector);
56 enum drm_connector_status status = connector_status_unknown;
57
58 if (output->hpd_gpio) {
59 if (gpiod_get_value(output->hpd_gpio) == 0)
60 status = connector_status_disconnected;
61 else
62 status = connector_status_connected;
63 } else {
64 if (!output->panel)
65 status = connector_status_disconnected;
66 else
67 status = connector_status_connected;
68 }
69
70 if (status != connector_status_connected)
71 cec_notifier_phys_addr_invalidate(output->cec);
72
73 return status;
74}
75
76void tegra_output_connector_destroy(struct drm_connector *connector)
77{
78 struct tegra_output *output = connector_to_output(connector);
79
80 if (output->cec)
81 cec_notifier_conn_unregister(output->cec);
82
83 drm_connector_unregister(connector);
84 drm_connector_cleanup(connector);
85}
86
87static irqreturn_t hpd_irq(int irq, void *data)
88{
89 struct tegra_output *output = data;
90
91 if (output->connector.dev)
92 drm_helper_hpd_irq_event(output->connector.dev);
93
94 return IRQ_HANDLED;
95}
96
97int tegra_output_probe(struct tegra_output *output)
98{
99 struct device_node *ddc, *panel;
100 unsigned long flags;
101 int err, size;
102
103 if (!output->of_node)
104 output->of_node = output->dev->of_node;
105
106 err = drm_of_find_panel_or_bridge(output->of_node, -1, -1,
107 &output->panel, &output->bridge);
108 if (err && err != -ENODEV)
109 return err;
110
111 panel = of_parse_phandle(output->of_node, "nvidia,panel", 0);
112 if (panel) {
113 /*
114 * Don't mix nvidia,panel phandle with the graph in a
115 * device-tree.
116 */
117 WARN_ON(output->panel || output->bridge);
118
119 output->panel = of_drm_find_panel(panel);
120 of_node_put(panel);
121
122 if (IS_ERR(output->panel))
123 return PTR_ERR(output->panel);
124 }
125
126 output->edid = of_get_property(output->of_node, "nvidia,edid", &size);
127
128 ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0);
129 if (ddc) {
130 output->ddc = of_get_i2c_adapter_by_node(ddc);
131 of_node_put(ddc);
132
133 if (!output->ddc) {
134 err = -EPROBE_DEFER;
135 return err;
136 }
137 }
138
139 output->hpd_gpio = devm_fwnode_gpiod_get(output->dev,
140 of_fwnode_handle(output->of_node),
141 "nvidia,hpd",
142 GPIOD_IN,
143 "HDMI hotplug detect");
144 if (IS_ERR(output->hpd_gpio)) {
145 if (PTR_ERR(output->hpd_gpio) != -ENOENT)
146 return PTR_ERR(output->hpd_gpio);
147
148 output->hpd_gpio = NULL;
149 }
150
151 if (output->hpd_gpio) {
152 err = gpiod_to_irq(output->hpd_gpio);
153 if (err < 0) {
154 dev_err(output->dev, "gpiod_to_irq(): %d\n", err);
155 return err;
156 }
157
158 output->hpd_irq = err;
159
160 flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
161 IRQF_ONESHOT;
162
163 err = request_threaded_irq(output->hpd_irq, NULL, hpd_irq,
164 flags, "hpd", output);
165 if (err < 0) {
166 dev_err(output->dev, "failed to request IRQ#%u: %d\n",
167 output->hpd_irq, err);
168 return err;
169 }
170
171 output->connector.polled = DRM_CONNECTOR_POLL_HPD;
172
173 /*
174 * Disable the interrupt until the connector has been
175 * initialized to avoid a race in the hotplug interrupt
176 * handler.
177 */
178 disable_irq(output->hpd_irq);
179 }
180
181 return 0;
182}
183
184void tegra_output_remove(struct tegra_output *output)
185{
186 if (output->hpd_gpio)
187 free_irq(output->hpd_irq, output);
188
189 if (output->ddc)
190 i2c_put_adapter(output->ddc);
191}
192
193int tegra_output_init(struct drm_device *drm, struct tegra_output *output)
194{
195 int connector_type;
196
197 /*
198 * The connector is now registered and ready to receive hotplug events
199 * so the hotplug interrupt can be enabled.
200 */
201 if (output->hpd_gpio)
202 enable_irq(output->hpd_irq);
203
204 connector_type = output->connector.connector_type;
205 /*
206 * Create a CEC notifier for HDMI connector.
207 */
208 if (connector_type == DRM_MODE_CONNECTOR_HDMIA ||
209 connector_type == DRM_MODE_CONNECTOR_HDMIB) {
210 struct cec_connector_info conn_info;
211
212 cec_fill_conn_info_from_drm(&conn_info, &output->connector);
213 output->cec = cec_notifier_conn_register(output->dev, NULL,
214 &conn_info);
215 if (!output->cec)
216 return -ENOMEM;
217 }
218
219 return 0;
220}
221
222void tegra_output_exit(struct tegra_output *output)
223{
224 /*
225 * The connector is going away, so the interrupt must be disabled to
226 * prevent the hotplug interrupt handler from potentially crashing.
227 */
228 if (output->hpd_gpio)
229 disable_irq(output->hpd_irq);
230}
231
232void tegra_output_find_possible_crtcs(struct tegra_output *output,
233 struct drm_device *drm)
234{
235 struct device *dev = output->dev;
236 struct drm_crtc *crtc;
237 unsigned int mask = 0;
238
239 drm_for_each_crtc(crtc, drm) {
240 struct tegra_dc *dc = to_tegra_dc(crtc);
241
242 if (tegra_dc_has_output(dc, dev))
243 mask |= drm_crtc_mask(crtc);
244 }
245
246 if (mask == 0) {
247 dev_warn(dev, "missing output definition for heads in DT\n");
248 mask = 0x3;
249 }
250
251 output->encoder.possible_crtcs = mask;
252}
253
254int tegra_output_suspend(struct tegra_output *output)
255{
256 if (output->hpd_irq)
257 disable_irq(output->hpd_irq);
258
259 return 0;
260}
261
262int tegra_output_resume(struct tegra_output *output)
263{
264 if (output->hpd_irq)
265 enable_irq(output->hpd_irq);
266
267 return 0;
268}
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (C) 2012 Avionic Design GmbH
4 * Copyright (C) 2012 NVIDIA CORPORATION. All rights reserved.
5 */
6
7#include <linux/i2c.h>
8#include <linux/of.h>
9
10#include <drm/drm_atomic_helper.h>
11#include <drm/drm_edid.h>
12#include <drm/drm_of.h>
13#include <drm/drm_panel.h>
14#include <drm/drm_simple_kms_helper.h>
15
16#include "drm.h"
17#include "dc.h"
18
19#include <media/cec-notifier.h>
20
21int tegra_output_connector_get_modes(struct drm_connector *connector)
22{
23 struct tegra_output *output = connector_to_output(connector);
24 struct edid *edid = NULL;
25 int err = 0;
26
27 /*
28 * If the panel provides one or more modes, use them exclusively and
29 * ignore any other means of obtaining a mode.
30 */
31 if (output->panel) {
32 err = drm_panel_get_modes(output->panel, connector);
33 if (err > 0)
34 return err;
35 }
36
37 if (output->edid)
38 edid = kmemdup(output->edid, sizeof(*edid), GFP_KERNEL);
39 else if (output->ddc)
40 edid = drm_get_edid(connector, output->ddc);
41
42 cec_notifier_set_phys_addr_from_edid(output->cec, edid);
43 drm_connector_update_edid_property(connector, edid);
44
45 if (edid) {
46 err = drm_add_edid_modes(connector, edid);
47 kfree(edid);
48 }
49
50 return err;
51}
52
53enum drm_connector_status
54tegra_output_connector_detect(struct drm_connector *connector, bool force)
55{
56 struct tegra_output *output = connector_to_output(connector);
57 enum drm_connector_status status = connector_status_unknown;
58
59 if (output->hpd_gpio) {
60 if (gpiod_get_value(output->hpd_gpio) == 0)
61 status = connector_status_disconnected;
62 else
63 status = connector_status_connected;
64 } else {
65 if (!output->panel)
66 status = connector_status_disconnected;
67 else
68 status = connector_status_connected;
69 }
70
71 if (status != connector_status_connected)
72 cec_notifier_phys_addr_invalidate(output->cec);
73
74 return status;
75}
76
77void tegra_output_connector_destroy(struct drm_connector *connector)
78{
79 struct tegra_output *output = connector_to_output(connector);
80
81 if (output->cec)
82 cec_notifier_conn_unregister(output->cec);
83
84 drm_connector_unregister(connector);
85 drm_connector_cleanup(connector);
86}
87
88static irqreturn_t hpd_irq(int irq, void *data)
89{
90 struct tegra_output *output = data;
91
92 if (output->connector.dev)
93 drm_helper_hpd_irq_event(output->connector.dev);
94
95 return IRQ_HANDLED;
96}
97
98int tegra_output_probe(struct tegra_output *output)
99{
100 struct device_node *ddc, *panel;
101 unsigned long flags;
102 int err, size;
103
104 if (!output->of_node)
105 output->of_node = output->dev->of_node;
106
107 err = drm_of_find_panel_or_bridge(output->of_node, -1, -1,
108 &output->panel, &output->bridge);
109 if (err && err != -ENODEV)
110 return err;
111
112 panel = of_parse_phandle(output->of_node, "nvidia,panel", 0);
113 if (panel) {
114 /*
115 * Don't mix nvidia,panel phandle with the graph in a
116 * device-tree.
117 */
118 WARN_ON(output->panel || output->bridge);
119
120 output->panel = of_drm_find_panel(panel);
121 of_node_put(panel);
122
123 if (IS_ERR(output->panel))
124 return PTR_ERR(output->panel);
125 }
126
127 output->edid = of_get_property(output->of_node, "nvidia,edid", &size);
128
129 ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0);
130 if (ddc) {
131 output->ddc = of_get_i2c_adapter_by_node(ddc);
132 of_node_put(ddc);
133
134 if (!output->ddc) {
135 err = -EPROBE_DEFER;
136 return err;
137 }
138 }
139
140 output->hpd_gpio = devm_fwnode_gpiod_get(output->dev,
141 of_fwnode_handle(output->of_node),
142 "nvidia,hpd",
143 GPIOD_IN,
144 "HDMI hotplug detect");
145 if (IS_ERR(output->hpd_gpio)) {
146 if (PTR_ERR(output->hpd_gpio) != -ENOENT) {
147 err = PTR_ERR(output->hpd_gpio);
148 goto put_i2c;
149 }
150
151 output->hpd_gpio = NULL;
152 }
153
154 if (output->hpd_gpio) {
155 err = gpiod_to_irq(output->hpd_gpio);
156 if (err < 0) {
157 dev_err(output->dev, "gpiod_to_irq(): %d\n", err);
158 goto put_i2c;
159 }
160
161 output->hpd_irq = err;
162
163 flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
164 IRQF_ONESHOT;
165
166 err = request_threaded_irq(output->hpd_irq, NULL, hpd_irq,
167 flags, "hpd", output);
168 if (err < 0) {
169 dev_err(output->dev, "failed to request IRQ#%u: %d\n",
170 output->hpd_irq, err);
171 goto put_i2c;
172 }
173
174 output->connector.polled = DRM_CONNECTOR_POLL_HPD;
175
176 /*
177 * Disable the interrupt until the connector has been
178 * initialized to avoid a race in the hotplug interrupt
179 * handler.
180 */
181 disable_irq(output->hpd_irq);
182 }
183
184 return 0;
185
186put_i2c:
187 if (output->ddc)
188 i2c_put_adapter(output->ddc);
189
190 return err;
191}
192
193void tegra_output_remove(struct tegra_output *output)
194{
195 if (output->hpd_gpio)
196 free_irq(output->hpd_irq, output);
197
198 if (output->ddc)
199 i2c_put_adapter(output->ddc);
200}
201
202int tegra_output_init(struct drm_device *drm, struct tegra_output *output)
203{
204 int connector_type;
205
206 /*
207 * The connector is now registered and ready to receive hotplug events
208 * so the hotplug interrupt can be enabled.
209 */
210 if (output->hpd_gpio)
211 enable_irq(output->hpd_irq);
212
213 connector_type = output->connector.connector_type;
214 /*
215 * Create a CEC notifier for HDMI connector.
216 */
217 if (connector_type == DRM_MODE_CONNECTOR_HDMIA ||
218 connector_type == DRM_MODE_CONNECTOR_HDMIB) {
219 struct cec_connector_info conn_info;
220
221 cec_fill_conn_info_from_drm(&conn_info, &output->connector);
222 output->cec = cec_notifier_conn_register(output->dev, NULL,
223 &conn_info);
224 if (!output->cec)
225 return -ENOMEM;
226 }
227
228 return 0;
229}
230
231void tegra_output_exit(struct tegra_output *output)
232{
233 /*
234 * The connector is going away, so the interrupt must be disabled to
235 * prevent the hotplug interrupt handler from potentially crashing.
236 */
237 if (output->hpd_gpio)
238 disable_irq(output->hpd_irq);
239}
240
241void tegra_output_find_possible_crtcs(struct tegra_output *output,
242 struct drm_device *drm)
243{
244 struct device *dev = output->dev;
245 struct drm_crtc *crtc;
246 unsigned int mask = 0;
247
248 drm_for_each_crtc(crtc, drm) {
249 struct tegra_dc *dc = to_tegra_dc(crtc);
250
251 if (tegra_dc_has_output(dc, dev))
252 mask |= drm_crtc_mask(crtc);
253 }
254
255 if (mask == 0) {
256 dev_warn(dev, "missing output definition for heads in DT\n");
257 mask = 0x3;
258 }
259
260 output->encoder.possible_crtcs = mask;
261}
262
263int tegra_output_suspend(struct tegra_output *output)
264{
265 if (output->hpd_irq)
266 disable_irq(output->hpd_irq);
267
268 return 0;
269}
270
271int tegra_output_resume(struct tegra_output *output)
272{
273 if (output->hpd_irq)
274 enable_irq(output->hpd_irq);
275
276 return 0;
277}