2 * Copyright (C) 2012 Avionic Design GmbH
3 * Copyright (C) 2012 NVIDIA CORPORATION. All rights reserved.
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.
10 #include <linux/of_gpio.h>
12 #include <drm/drm_panel.h>
15 static int tegra_connector_get_modes(struct drm_connector *connector)
17 struct tegra_output *output = connector_to_output(connector);
18 struct edid *edid = NULL;
22 * If the panel provides one or more modes, use them exclusively and
23 * ignore any other means of obtaining a mode.
26 err = output->panel->funcs->get_modes(output->panel);
32 edid = kmemdup(output->edid, sizeof(*edid), GFP_KERNEL);
34 edid = drm_get_edid(connector, output->ddc);
36 drm_mode_connector_update_edid_property(connector, edid);
39 err = drm_add_edid_modes(connector, edid);
46 static int tegra_connector_mode_valid(struct drm_connector *connector,
47 struct drm_display_mode *mode)
49 struct tegra_output *output = connector_to_output(connector);
50 enum drm_mode_status status = MODE_OK;
53 err = tegra_output_check_mode(output, mode, &status);
60 static struct drm_encoder *
61 tegra_connector_best_encoder(struct drm_connector *connector)
63 struct tegra_output *output = connector_to_output(connector);
65 return &output->encoder;
68 static 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,
74 static enum drm_connector_status
75 tegra_connector_detect(struct drm_connector *connector, bool force)
77 struct tegra_output *output = connector_to_output(connector);
78 enum drm_connector_status status = connector_status_unknown;
80 if (output->ops->detect)
81 return output->ops->detect(output);
83 if (gpio_is_valid(output->hpd_gpio)) {
84 if (gpio_get_value(output->hpd_gpio) == 0)
85 status = connector_status_disconnected;
87 status = connector_status_connected;
90 status = connector_status_disconnected;
92 status = connector_status_connected;
94 if (connector->connector_type == DRM_MODE_CONNECTOR_LVDS)
95 status = connector_status_connected;
101 static void drm_connector_clear(struct drm_connector *connector)
103 memset(connector, 0, sizeof(*connector));
106 static void tegra_connector_destroy(struct drm_connector *connector)
108 drm_connector_unregister(connector);
109 drm_connector_cleanup(connector);
110 drm_connector_clear(connector);
113 static 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,
120 static void drm_encoder_clear(struct drm_encoder *encoder)
122 memset(encoder, 0, sizeof(*encoder));
125 static void tegra_encoder_destroy(struct drm_encoder *encoder)
127 drm_encoder_cleanup(encoder);
128 drm_encoder_clear(encoder);
131 static const struct drm_encoder_funcs encoder_funcs = {
132 .destroy = tegra_encoder_destroy,
135 static void tegra_encoder_dpms(struct drm_encoder *encoder, int mode)
137 struct tegra_output *output = encoder_to_output(encoder);
138 struct drm_panel *panel = output->panel;
140 if (mode != DRM_MODE_DPMS_ON) {
141 drm_panel_disable(panel);
142 tegra_output_disable(output);
143 drm_panel_unprepare(panel);
145 drm_panel_prepare(panel);
146 tegra_output_enable(output);
147 drm_panel_enable(panel);
151 static bool tegra_encoder_mode_fixup(struct drm_encoder *encoder,
152 const struct drm_display_mode *mode,
153 struct drm_display_mode *adjusted)
158 static void tegra_encoder_prepare(struct drm_encoder *encoder)
160 tegra_encoder_dpms(encoder, DRM_MODE_DPMS_OFF);
163 static void tegra_encoder_commit(struct drm_encoder *encoder)
165 tegra_encoder_dpms(encoder, DRM_MODE_DPMS_ON);
168 static void tegra_encoder_mode_set(struct drm_encoder *encoder,
169 struct drm_display_mode *mode,
170 struct drm_display_mode *adjusted)
174 static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
175 .dpms = tegra_encoder_dpms,
176 .mode_fixup = tegra_encoder_mode_fixup,
177 .prepare = tegra_encoder_prepare,
178 .commit = tegra_encoder_commit,
179 .mode_set = tegra_encoder_mode_set,
182 static irqreturn_t hpd_irq(int irq, void *data)
184 struct tegra_output *output = data;
186 if (output->connector.dev)
187 drm_helper_hpd_irq_event(output->connector.dev);
192 int tegra_output_probe(struct tegra_output *output)
194 struct device_node *ddc, *panel;
195 enum of_gpio_flags flags;
198 if (!output->of_node)
199 output->of_node = output->dev->of_node;
201 panel = of_parse_phandle(output->of_node, "nvidia,panel", 0);
203 output->panel = of_drm_find_panel(panel);
205 return -EPROBE_DEFER;
210 output->edid = of_get_property(output->of_node, "nvidia,edid", &size);
212 ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0);
214 output->ddc = of_find_i2c_adapter_by_node(ddc);
224 output->hpd_gpio = of_get_named_gpio_flags(output->of_node,
225 "nvidia,hpd-gpio", 0,
227 if (gpio_is_valid(output->hpd_gpio)) {
230 err = gpio_request_one(output->hpd_gpio, GPIOF_DIR_IN,
231 "HDMI hotplug detect");
233 dev_err(output->dev, "gpio_request_one(): %d\n", err);
237 err = gpio_to_irq(output->hpd_gpio);
239 dev_err(output->dev, "gpio_to_irq(): %d\n", err);
240 gpio_free(output->hpd_gpio);
244 output->hpd_irq = err;
246 flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
249 err = request_threaded_irq(output->hpd_irq, NULL, hpd_irq,
250 flags, "hpd", output);
252 dev_err(output->dev, "failed to request IRQ#%u: %d\n",
253 output->hpd_irq, err);
254 gpio_free(output->hpd_gpio);
258 output->connector.polled = DRM_CONNECTOR_POLL_HPD;
261 * Disable the interrupt until the connector has been
262 * initialized to avoid a race in the hotplug interrupt
265 disable_irq(output->hpd_irq);
271 int tegra_output_remove(struct tegra_output *output)
273 if (gpio_is_valid(output->hpd_gpio)) {
274 free_irq(output->hpd_irq, output);
275 gpio_free(output->hpd_gpio);
279 put_device(&output->ddc->dev);
284 int tegra_output_init(struct drm_device *drm, struct tegra_output *output)
286 int connector, encoder;
288 switch (output->type) {
289 case TEGRA_OUTPUT_RGB:
290 connector = DRM_MODE_CONNECTOR_LVDS;
291 encoder = DRM_MODE_ENCODER_LVDS;
294 case TEGRA_OUTPUT_HDMI:
295 connector = DRM_MODE_CONNECTOR_HDMIA;
296 encoder = DRM_MODE_ENCODER_TMDS;
299 case TEGRA_OUTPUT_DSI:
300 connector = DRM_MODE_CONNECTOR_DSI;
301 encoder = DRM_MODE_ENCODER_DSI;
304 case TEGRA_OUTPUT_EDP:
305 connector = DRM_MODE_CONNECTOR_eDP;
306 encoder = DRM_MODE_ENCODER_TMDS;
310 connector = DRM_MODE_CONNECTOR_Unknown;
311 encoder = DRM_MODE_ENCODER_NONE;
315 drm_connector_init(drm, &output->connector, &connector_funcs,
317 drm_connector_helper_add(&output->connector, &connector_helper_funcs);
318 output->connector.dpms = DRM_MODE_DPMS_OFF;
321 drm_panel_attach(output->panel, &output->connector);
323 drm_encoder_init(drm, &output->encoder, &encoder_funcs, encoder);
324 drm_encoder_helper_add(&output->encoder, &encoder_helper_funcs);
326 drm_mode_connector_attach_encoder(&output->connector, &output->encoder);
327 drm_connector_register(&output->connector);
329 output->encoder.possible_crtcs = 0x3;
332 * The connector is now registered and ready to receive hotplug events
333 * so the hotplug interrupt can be enabled.
335 if (gpio_is_valid(output->hpd_gpio))
336 enable_irq(output->hpd_irq);
341 int tegra_output_exit(struct tegra_output *output)
344 * The connector is going away, so the interrupt must be disabled to
345 * prevent the hotplug interrupt handler from potentially crashing.
347 if (gpio_is_valid(output->hpd_gpio))
348 disable_irq(output->hpd_irq);
351 drm_panel_detach(output->panel);