Linux Audio

Check our new training course

Loading...
Note: File does not exist in v3.1.
  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}