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_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 const struct drm_edid *drm_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->drm_edid)
38 drm_edid = drm_edid_dup(output->drm_edid);
39 else if (output->ddc)
40 drm_edid = drm_edid_read_ddc(connector, output->ddc);
41
42 drm_edid_connector_update(connector, drm_edid);
43 cec_notifier_set_phys_addr(output->cec,
44 connector->display_info.source_physical_address);
45
46 err = drm_edid_connector_add_modes(connector);
47 drm_edid_free(drm_edid);
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 const void *edid;
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 ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0);
128 if (ddc) {
129 output->ddc = of_get_i2c_adapter_by_node(ddc);
130 of_node_put(ddc);
131
132 if (!output->ddc) {
133 err = -EPROBE_DEFER;
134 return err;
135 }
136 }
137
138 edid = of_get_property(output->of_node, "nvidia,edid", &size);
139 output->drm_edid = drm_edid_alloc(edid, size);
140
141 output->hpd_gpio = devm_fwnode_gpiod_get(output->dev,
142 of_fwnode_handle(output->of_node),
143 "nvidia,hpd",
144 GPIOD_IN,
145 "HDMI hotplug detect");
146 if (IS_ERR(output->hpd_gpio)) {
147 if (PTR_ERR(output->hpd_gpio) != -ENOENT) {
148 err = PTR_ERR(output->hpd_gpio);
149 goto put_i2c;
150 }
151
152 output->hpd_gpio = NULL;
153 }
154
155 if (output->hpd_gpio) {
156 err = gpiod_to_irq(output->hpd_gpio);
157 if (err < 0) {
158 dev_err(output->dev, "gpiod_to_irq(): %d\n", err);
159 goto put_i2c;
160 }
161
162 output->hpd_irq = err;
163
164 flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
165 IRQF_ONESHOT;
166
167 err = request_threaded_irq(output->hpd_irq, NULL, hpd_irq,
168 flags, "hpd", output);
169 if (err < 0) {
170 dev_err(output->dev, "failed to request IRQ#%u: %d\n",
171 output->hpd_irq, err);
172 goto put_i2c;
173 }
174
175 output->connector.polled = DRM_CONNECTOR_POLL_HPD;
176
177 /*
178 * Disable the interrupt until the connector has been
179 * initialized to avoid a race in the hotplug interrupt
180 * handler.
181 */
182 disable_irq(output->hpd_irq);
183 }
184
185 return 0;
186
187put_i2c:
188 if (output->ddc)
189 i2c_put_adapter(output->ddc);
190
191 drm_edid_free(output->drm_edid);
192
193 return err;
194}
195
196void tegra_output_remove(struct tegra_output *output)
197{
198 if (output->hpd_gpio)
199 free_irq(output->hpd_irq, output);
200
201 if (output->ddc)
202 i2c_put_adapter(output->ddc);
203
204 drm_edid_free(output->drm_edid);
205}
206
207int tegra_output_init(struct drm_device *drm, struct tegra_output *output)
208{
209 int connector_type;
210
211 /*
212 * The connector is now registered and ready to receive hotplug events
213 * so the hotplug interrupt can be enabled.
214 */
215 if (output->hpd_gpio)
216 enable_irq(output->hpd_irq);
217
218 connector_type = output->connector.connector_type;
219 /*
220 * Create a CEC notifier for HDMI connector.
221 */
222 if (connector_type == DRM_MODE_CONNECTOR_HDMIA ||
223 connector_type == DRM_MODE_CONNECTOR_HDMIB) {
224 struct cec_connector_info conn_info;
225
226 cec_fill_conn_info_from_drm(&conn_info, &output->connector);
227 output->cec = cec_notifier_conn_register(output->dev, NULL,
228 &conn_info);
229 if (!output->cec)
230 return -ENOMEM;
231 }
232
233 return 0;
234}
235
236void tegra_output_exit(struct tegra_output *output)
237{
238 /*
239 * The connector is going away, so the interrupt must be disabled to
240 * prevent the hotplug interrupt handler from potentially crashing.
241 */
242 if (output->hpd_gpio)
243 disable_irq(output->hpd_irq);
244}
245
246void tegra_output_find_possible_crtcs(struct tegra_output *output,
247 struct drm_device *drm)
248{
249 struct device *dev = output->dev;
250 struct drm_crtc *crtc;
251 unsigned int mask = 0;
252
253 drm_for_each_crtc(crtc, drm) {
254 struct tegra_dc *dc = to_tegra_dc(crtc);
255
256 if (tegra_dc_has_output(dc, dev))
257 mask |= drm_crtc_mask(crtc);
258 }
259
260 if (mask == 0) {
261 dev_warn(dev, "missing output definition for heads in DT\n");
262 mask = 0x3;
263 }
264
265 output->encoder.possible_crtcs = mask;
266}
267
268int tegra_output_suspend(struct tegra_output *output)
269{
270 if (output->hpd_irq)
271 disable_irq(output->hpd_irq);
272
273 return 0;
274}
275
276int tegra_output_resume(struct tegra_output *output)
277{
278 if (output->hpd_irq)
279 enable_irq(output->hpd_irq);
280
281 return 0;
282}
1/*
2 * Copyright (C) 2012 Avionic Design GmbH
3 * Copyright (C) 2012 NVIDIA CORPORATION. All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
8 */
9
10#include <linux/of_gpio.h>
11
12#include <drm/drm_panel.h>
13#include "drm.h"
14
15static int tegra_connector_get_modes(struct drm_connector *connector)
16{
17 struct tegra_output *output = connector_to_output(connector);
18 struct edid *edid = NULL;
19 int err = 0;
20
21 /*
22 * If the panel provides one or more modes, use them exclusively and
23 * ignore any other means of obtaining a mode.
24 */
25 if (output->panel) {
26 err = output->panel->funcs->get_modes(output->panel);
27 if (err > 0)
28 return err;
29 }
30
31 if (output->edid)
32 edid = kmemdup(output->edid, sizeof(*edid), GFP_KERNEL);
33 else if (output->ddc)
34 edid = drm_get_edid(connector, output->ddc);
35
36 drm_mode_connector_update_edid_property(connector, edid);
37
38 if (edid) {
39 err = drm_add_edid_modes(connector, edid);
40 kfree(edid);
41 }
42
43 return err;
44}
45
46static int tegra_connector_mode_valid(struct drm_connector *connector,
47 struct drm_display_mode *mode)
48{
49 struct tegra_output *output = connector_to_output(connector);
50 enum drm_mode_status status = MODE_OK;
51 int err;
52
53 err = tegra_output_check_mode(output, mode, &status);
54 if (err < 0)
55 return MODE_ERROR;
56
57 return status;
58}
59
60static struct drm_encoder *
61tegra_connector_best_encoder(struct drm_connector *connector)
62{
63 struct tegra_output *output = connector_to_output(connector);
64
65 return &output->encoder;
66}
67
68static const struct drm_connector_helper_funcs connector_helper_funcs = {
69 .get_modes = tegra_connector_get_modes,
70 .mode_valid = tegra_connector_mode_valid,
71 .best_encoder = tegra_connector_best_encoder,
72};
73
74static enum drm_connector_status
75tegra_connector_detect(struct drm_connector *connector, bool force)
76{
77 struct tegra_output *output = connector_to_output(connector);
78 enum drm_connector_status status = connector_status_unknown;
79
80 if (output->ops->detect)
81 return output->ops->detect(output);
82
83 if (gpio_is_valid(output->hpd_gpio)) {
84 if (gpio_get_value(output->hpd_gpio) == 0)
85 status = connector_status_disconnected;
86 else
87 status = connector_status_connected;
88 } else {
89 if (!output->panel)
90 status = connector_status_disconnected;
91 else
92 status = connector_status_connected;
93
94 if (connector->connector_type == DRM_MODE_CONNECTOR_LVDS)
95 status = connector_status_connected;
96 }
97
98 return status;
99}
100
101static void drm_connector_clear(struct drm_connector *connector)
102{
103 memset(connector, 0, sizeof(*connector));
104}
105
106static void tegra_connector_destroy(struct drm_connector *connector)
107{
108 drm_sysfs_connector_remove(connector);
109 drm_connector_cleanup(connector);
110 drm_connector_clear(connector);
111}
112
113static const struct drm_connector_funcs connector_funcs = {
114 .dpms = drm_helper_connector_dpms,
115 .detect = tegra_connector_detect,
116 .fill_modes = drm_helper_probe_single_connector_modes,
117 .destroy = tegra_connector_destroy,
118};
119
120static void drm_encoder_clear(struct drm_encoder *encoder)
121{
122 memset(encoder, 0, sizeof(*encoder));
123}
124
125static void tegra_encoder_destroy(struct drm_encoder *encoder)
126{
127 drm_encoder_cleanup(encoder);
128 drm_encoder_clear(encoder);
129}
130
131static const struct drm_encoder_funcs encoder_funcs = {
132 .destroy = tegra_encoder_destroy,
133};
134
135static void tegra_encoder_dpms(struct drm_encoder *encoder, int mode)
136{
137 struct tegra_output *output = encoder_to_output(encoder);
138 struct drm_panel *panel = output->panel;
139
140 if (mode != DRM_MODE_DPMS_ON) {
141 drm_panel_disable(panel);
142 tegra_output_disable(output);
143 } else {
144 tegra_output_enable(output);
145 drm_panel_enable(panel);
146 }
147}
148
149static bool tegra_encoder_mode_fixup(struct drm_encoder *encoder,
150 const struct drm_display_mode *mode,
151 struct drm_display_mode *adjusted)
152{
153 return true;
154}
155
156static void tegra_encoder_prepare(struct drm_encoder *encoder)
157{
158}
159
160static void tegra_encoder_commit(struct drm_encoder *encoder)
161{
162}
163
164static void tegra_encoder_mode_set(struct drm_encoder *encoder,
165 struct drm_display_mode *mode,
166 struct drm_display_mode *adjusted)
167{
168 struct tegra_output *output = encoder_to_output(encoder);
169 int err;
170
171 err = tegra_output_enable(output);
172 if (err < 0)
173 dev_err(encoder->dev->dev, "tegra_output_enable(): %d\n", err);
174}
175
176static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
177 .dpms = tegra_encoder_dpms,
178 .mode_fixup = tegra_encoder_mode_fixup,
179 .prepare = tegra_encoder_prepare,
180 .commit = tegra_encoder_commit,
181 .mode_set = tegra_encoder_mode_set,
182};
183
184static irqreturn_t hpd_irq(int irq, void *data)
185{
186 struct tegra_output *output = data;
187
188 drm_helper_hpd_irq_event(output->connector.dev);
189
190 return IRQ_HANDLED;
191}
192
193int tegra_output_probe(struct tegra_output *output)
194{
195 struct device_node *ddc, *panel;
196 enum of_gpio_flags flags;
197 int err, size;
198
199 if (!output->of_node)
200 output->of_node = output->dev->of_node;
201
202 panel = of_parse_phandle(output->of_node, "nvidia,panel", 0);
203 if (panel) {
204 output->panel = of_drm_find_panel(panel);
205 if (!output->panel)
206 return -EPROBE_DEFER;
207
208 of_node_put(panel);
209 }
210
211 output->edid = of_get_property(output->of_node, "nvidia,edid", &size);
212
213 ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0);
214 if (ddc) {
215 output->ddc = of_find_i2c_adapter_by_node(ddc);
216 if (!output->ddc) {
217 err = -EPROBE_DEFER;
218 of_node_put(ddc);
219 return err;
220 }
221
222 of_node_put(ddc);
223 }
224
225 output->hpd_gpio = of_get_named_gpio_flags(output->of_node,
226 "nvidia,hpd-gpio", 0,
227 &flags);
228 if (gpio_is_valid(output->hpd_gpio)) {
229 unsigned long flags;
230
231 err = gpio_request_one(output->hpd_gpio, GPIOF_DIR_IN,
232 "HDMI hotplug detect");
233 if (err < 0) {
234 dev_err(output->dev, "gpio_request_one(): %d\n", err);
235 return err;
236 }
237
238 err = gpio_to_irq(output->hpd_gpio);
239 if (err < 0) {
240 dev_err(output->dev, "gpio_to_irq(): %d\n", err);
241 gpio_free(output->hpd_gpio);
242 return err;
243 }
244
245 output->hpd_irq = err;
246
247 flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
248 IRQF_ONESHOT;
249
250 err = request_threaded_irq(output->hpd_irq, NULL, hpd_irq,
251 flags, "hpd", output);
252 if (err < 0) {
253 dev_err(output->dev, "failed to request IRQ#%u: %d\n",
254 output->hpd_irq, err);
255 gpio_free(output->hpd_gpio);
256 return err;
257 }
258
259 output->connector.polled = DRM_CONNECTOR_POLL_HPD;
260 }
261
262 return 0;
263}
264
265int tegra_output_remove(struct tegra_output *output)
266{
267 if (gpio_is_valid(output->hpd_gpio)) {
268 free_irq(output->hpd_irq, output);
269 gpio_free(output->hpd_gpio);
270 }
271
272 if (output->ddc)
273 put_device(&output->ddc->dev);
274
275 return 0;
276}
277
278int tegra_output_init(struct drm_device *drm, struct tegra_output *output)
279{
280 int connector, encoder;
281
282 switch (output->type) {
283 case TEGRA_OUTPUT_RGB:
284 connector = DRM_MODE_CONNECTOR_LVDS;
285 encoder = DRM_MODE_ENCODER_LVDS;
286 break;
287
288 case TEGRA_OUTPUT_HDMI:
289 connector = DRM_MODE_CONNECTOR_HDMIA;
290 encoder = DRM_MODE_ENCODER_TMDS;
291 break;
292
293 case TEGRA_OUTPUT_DSI:
294 connector = DRM_MODE_CONNECTOR_DSI;
295 encoder = DRM_MODE_ENCODER_DSI;
296 break;
297
298 case TEGRA_OUTPUT_EDP:
299 connector = DRM_MODE_CONNECTOR_eDP;
300 encoder = DRM_MODE_ENCODER_TMDS;
301 break;
302
303 default:
304 connector = DRM_MODE_CONNECTOR_Unknown;
305 encoder = DRM_MODE_ENCODER_NONE;
306 break;
307 }
308
309 drm_connector_init(drm, &output->connector, &connector_funcs,
310 connector);
311 drm_connector_helper_add(&output->connector, &connector_helper_funcs);
312 output->connector.dpms = DRM_MODE_DPMS_OFF;
313
314 if (output->panel)
315 drm_panel_attach(output->panel, &output->connector);
316
317 drm_encoder_init(drm, &output->encoder, &encoder_funcs, encoder);
318 drm_encoder_helper_add(&output->encoder, &encoder_helper_funcs);
319
320 drm_mode_connector_attach_encoder(&output->connector, &output->encoder);
321 drm_sysfs_connector_add(&output->connector);
322
323 output->encoder.possible_crtcs = 0x3;
324
325 return 0;
326}
327
328int tegra_output_exit(struct tegra_output *output)
329{
330 return 0;
331}