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>
14 static int tegra_connector_get_modes(struct drm_connector *connector)
16 struct tegra_output *output = connector_to_output(connector);
17 struct edid *edid = NULL;
21 edid = kmemdup(output->edid, sizeof(*edid), GFP_KERNEL);
23 edid = drm_get_edid(connector, output->ddc);
25 drm_mode_connector_update_edid_property(connector, edid);
28 err = drm_add_edid_modes(connector, edid);
35 static int tegra_connector_mode_valid(struct drm_connector *connector,
36 struct drm_display_mode *mode)
38 struct tegra_output *output = connector_to_output(connector);
39 enum drm_mode_status status = MODE_OK;
42 err = tegra_output_check_mode(output, mode, &status);
49 static struct drm_encoder *
50 tegra_connector_best_encoder(struct drm_connector *connector)
52 struct tegra_output *output = connector_to_output(connector);
54 return &output->encoder;
57 static const struct drm_connector_helper_funcs connector_helper_funcs = {
58 .get_modes = tegra_connector_get_modes,
59 .mode_valid = tegra_connector_mode_valid,
60 .best_encoder = tegra_connector_best_encoder,
63 static enum drm_connector_status
64 tegra_connector_detect(struct drm_connector *connector, bool force)
66 struct tegra_output *output = connector_to_output(connector);
67 enum drm_connector_status status = connector_status_unknown;
69 if (gpio_is_valid(output->hpd_gpio)) {
70 if (gpio_get_value(output->hpd_gpio) == 0)
71 status = connector_status_disconnected;
73 status = connector_status_connected;
75 if (connector->connector_type == DRM_MODE_CONNECTOR_LVDS)
76 status = connector_status_connected;
82 static void tegra_connector_destroy(struct drm_connector *connector)
84 drm_sysfs_connector_remove(connector);
85 drm_connector_cleanup(connector);
88 static const struct drm_connector_funcs connector_funcs = {
89 .dpms = drm_helper_connector_dpms,
90 .detect = tegra_connector_detect,
91 .fill_modes = drm_helper_probe_single_connector_modes,
92 .destroy = tegra_connector_destroy,
95 static void tegra_encoder_destroy(struct drm_encoder *encoder)
97 drm_encoder_cleanup(encoder);
100 static const struct drm_encoder_funcs encoder_funcs = {
101 .destroy = tegra_encoder_destroy,
104 static void tegra_encoder_dpms(struct drm_encoder *encoder, int mode)
108 static bool tegra_encoder_mode_fixup(struct drm_encoder *encoder,
109 const struct drm_display_mode *mode,
110 struct drm_display_mode *adjusted)
115 static void tegra_encoder_prepare(struct drm_encoder *encoder)
119 static void tegra_encoder_commit(struct drm_encoder *encoder)
123 static void tegra_encoder_mode_set(struct drm_encoder *encoder,
124 struct drm_display_mode *mode,
125 struct drm_display_mode *adjusted)
127 struct tegra_output *output = encoder_to_output(encoder);
130 err = tegra_output_enable(output);
132 dev_err(encoder->dev->dev, "tegra_output_enable(): %d\n", err);
135 static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
136 .dpms = tegra_encoder_dpms,
137 .mode_fixup = tegra_encoder_mode_fixup,
138 .prepare = tegra_encoder_prepare,
139 .commit = tegra_encoder_commit,
140 .mode_set = tegra_encoder_mode_set,
143 static irqreturn_t hpd_irq(int irq, void *data)
145 struct tegra_output *output = data;
147 drm_helper_hpd_irq_event(output->connector.dev);
152 int tegra_output_parse_dt(struct tegra_output *output)
154 enum of_gpio_flags flags;
155 struct device_node *ddc;
159 if (!output->of_node)
160 output->of_node = output->dev->of_node;
162 output->edid = of_get_property(output->of_node, "nvidia,edid", &size);
164 ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0);
166 output->ddc = of_find_i2c_adapter_by_node(ddc);
176 if (!output->edid && !output->ddc)
179 output->hpd_gpio = of_get_named_gpio_flags(output->of_node,
180 "nvidia,hpd-gpio", 0,
186 int tegra_output_init(struct drm_device *drm, struct tegra_output *output)
188 int connector, encoder, err;
190 if (gpio_is_valid(output->hpd_gpio)) {
193 err = gpio_request_one(output->hpd_gpio, GPIOF_DIR_IN,
194 "HDMI hotplug detect");
196 dev_err(output->dev, "gpio_request_one(): %d\n", err);
200 err = gpio_to_irq(output->hpd_gpio);
202 dev_err(output->dev, "gpio_to_irq(): %d\n", err);
206 output->hpd_irq = err;
208 flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
211 err = request_threaded_irq(output->hpd_irq, NULL, hpd_irq,
212 flags, "hpd", output);
214 dev_err(output->dev, "failed to request IRQ#%u: %d\n",
215 output->hpd_irq, err);
219 output->connector.polled = DRM_CONNECTOR_POLL_HPD;
222 switch (output->type) {
223 case TEGRA_OUTPUT_RGB:
224 connector = DRM_MODE_CONNECTOR_LVDS;
225 encoder = DRM_MODE_ENCODER_LVDS;
228 case TEGRA_OUTPUT_HDMI:
229 connector = DRM_MODE_CONNECTOR_HDMIA;
230 encoder = DRM_MODE_ENCODER_TMDS;
234 connector = DRM_MODE_CONNECTOR_Unknown;
235 encoder = DRM_MODE_ENCODER_NONE;
239 drm_connector_init(drm, &output->connector, &connector_funcs,
241 drm_connector_helper_add(&output->connector, &connector_helper_funcs);
243 drm_encoder_init(drm, &output->encoder, &encoder_funcs, encoder);
244 drm_encoder_helper_add(&output->encoder, &encoder_helper_funcs);
246 drm_mode_connector_attach_encoder(&output->connector, &output->encoder);
247 drm_sysfs_connector_add(&output->connector);
249 output->encoder.possible_crtcs = 0x3;
254 gpio_free(output->hpd_gpio);
259 int tegra_output_exit(struct tegra_output *output)
261 if (gpio_is_valid(output->hpd_gpio)) {
262 free_irq(output->hpd_irq, output);
263 gpio_free(output->hpd_gpio);
267 put_device(&output->ddc->dev);