Commit | Line | Data |
---|---|---|
d8f4a9ed TR |
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 | ||
4aa3df71 | 10 | #include <drm/drm_atomic_helper.h> |
9be7d864 | 11 | #include <drm/drm_panel.h> |
d8f4a9ed TR |
12 | #include "drm.h" |
13 | ||
132085d8 | 14 | int tegra_output_connector_get_modes(struct drm_connector *connector) |
d8f4a9ed TR |
15 | { |
16 | struct tegra_output *output = connector_to_output(connector); | |
17 | struct edid *edid = NULL; | |
18 | int err = 0; | |
19 | ||
acde5413 TR |
20 | /* |
21 | * If the panel provides one or more modes, use them exclusively and | |
22 | * ignore any other means of obtaining a mode. | |
23 | */ | |
9be7d864 TR |
24 | if (output->panel) { |
25 | err = output->panel->funcs->get_modes(output->panel); | |
26 | if (err > 0) | |
27 | return err; | |
28 | } | |
29 | ||
d8f4a9ed TR |
30 | if (output->edid) |
31 | edid = kmemdup(output->edid, sizeof(*edid), GFP_KERNEL); | |
32 | else if (output->ddc) | |
33 | edid = drm_get_edid(connector, output->ddc); | |
34 | ||
35 | drm_mode_connector_update_edid_property(connector, edid); | |
36 | ||
37 | if (edid) { | |
38 | err = drm_add_edid_modes(connector, edid); | |
39 | kfree(edid); | |
40 | } | |
41 | ||
42 | return err; | |
43 | } | |
44 | ||
132085d8 TR |
45 | struct drm_encoder * |
46 | tegra_output_connector_best_encoder(struct drm_connector *connector) | |
d8f4a9ed TR |
47 | { |
48 | struct tegra_output *output = connector_to_output(connector); | |
49 | ||
50 | return &output->encoder; | |
51 | } | |
52 | ||
132085d8 TR |
53 | enum drm_connector_status |
54 | tegra_output_connector_detect(struct drm_connector *connector, bool force) | |
d8f4a9ed TR |
55 | { |
56 | struct tegra_output *output = connector_to_output(connector); | |
57 | enum drm_connector_status status = connector_status_unknown; | |
58 | ||
59 | if (gpio_is_valid(output->hpd_gpio)) { | |
fb36d0ee TR |
60 | if (output->hpd_gpio_flags & OF_GPIO_ACTIVE_LOW) { |
61 | if (gpio_get_value(output->hpd_gpio) != 0) | |
62 | status = connector_status_disconnected; | |
63 | else | |
64 | status = connector_status_connected; | |
65 | } else { | |
66 | if (gpio_get_value(output->hpd_gpio) == 0) | |
67 | status = connector_status_disconnected; | |
68 | else | |
69 | status = connector_status_connected; | |
70 | } | |
d8f4a9ed | 71 | } else { |
9be7d864 TR |
72 | if (!output->panel) |
73 | status = connector_status_disconnected; | |
74 | else | |
75 | status = connector_status_connected; | |
d8f4a9ed TR |
76 | } |
77 | ||
78 | return status; | |
79 | } | |
80 | ||
132085d8 | 81 | void tegra_output_connector_destroy(struct drm_connector *connector) |
d8f4a9ed | 82 | { |
34ea3d38 | 83 | drm_connector_unregister(connector); |
d8f4a9ed TR |
84 | drm_connector_cleanup(connector); |
85 | } | |
86 | ||
132085d8 | 87 | void tegra_output_encoder_destroy(struct drm_encoder *encoder) |
d8f4a9ed TR |
88 | { |
89 | drm_encoder_cleanup(encoder); | |
90 | } | |
91 | ||
d8f4a9ed TR |
92 | static irqreturn_t hpd_irq(int irq, void *data) |
93 | { | |
94 | struct tegra_output *output = data; | |
95 | ||
8fc8f7da TR |
96 | if (output->connector.dev) |
97 | drm_helper_hpd_irq_event(output->connector.dev); | |
d8f4a9ed TR |
98 | |
99 | return IRQ_HANDLED; | |
100 | } | |
101 | ||
59d29c0e | 102 | int tegra_output_probe(struct tegra_output *output) |
d8f4a9ed | 103 | { |
9be7d864 | 104 | struct device_node *ddc, *panel; |
7236aa03 | 105 | int err, size; |
d8f4a9ed TR |
106 | |
107 | if (!output->of_node) | |
108 | output->of_node = output->dev->of_node; | |
109 | ||
9be7d864 TR |
110 | panel = of_parse_phandle(output->of_node, "nvidia,panel", 0); |
111 | if (panel) { | |
112 | output->panel = of_drm_find_panel(panel); | |
113 | if (!output->panel) | |
114 | return -EPROBE_DEFER; | |
115 | ||
116 | of_node_put(panel); | |
117 | } | |
118 | ||
d8f4a9ed TR |
119 | output->edid = of_get_property(output->of_node, "nvidia,edid", &size); |
120 | ||
121 | ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0); | |
122 | if (ddc) { | |
123 | output->ddc = of_find_i2c_adapter_by_node(ddc); | |
124 | if (!output->ddc) { | |
125 | err = -EPROBE_DEFER; | |
126 | of_node_put(ddc); | |
127 | return err; | |
128 | } | |
129 | ||
130 | of_node_put(ddc); | |
131 | } | |
132 | ||
d8f4a9ed TR |
133 | output->hpd_gpio = of_get_named_gpio_flags(output->of_node, |
134 | "nvidia,hpd-gpio", 0, | |
fb36d0ee | 135 | &output->hpd_gpio_flags); |
d8f4a9ed TR |
136 | if (gpio_is_valid(output->hpd_gpio)) { |
137 | unsigned long flags; | |
138 | ||
139 | err = gpio_request_one(output->hpd_gpio, GPIOF_DIR_IN, | |
140 | "HDMI hotplug detect"); | |
141 | if (err < 0) { | |
142 | dev_err(output->dev, "gpio_request_one(): %d\n", err); | |
143 | return err; | |
144 | } | |
145 | ||
146 | err = gpio_to_irq(output->hpd_gpio); | |
147 | if (err < 0) { | |
148 | dev_err(output->dev, "gpio_to_irq(): %d\n", err); | |
59d29c0e TR |
149 | gpio_free(output->hpd_gpio); |
150 | return err; | |
d8f4a9ed TR |
151 | } |
152 | ||
153 | output->hpd_irq = err; | |
154 | ||
155 | flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | | |
156 | IRQF_ONESHOT; | |
157 | ||
158 | err = request_threaded_irq(output->hpd_irq, NULL, hpd_irq, | |
159 | flags, "hpd", output); | |
160 | if (err < 0) { | |
161 | dev_err(output->dev, "failed to request IRQ#%u: %d\n", | |
162 | output->hpd_irq, err); | |
59d29c0e TR |
163 | gpio_free(output->hpd_gpio); |
164 | return err; | |
d8f4a9ed TR |
165 | } |
166 | ||
167 | output->connector.polled = DRM_CONNECTOR_POLL_HPD; | |
8fc8f7da TR |
168 | |
169 | /* | |
170 | * Disable the interrupt until the connector has been | |
171 | * initialized to avoid a race in the hotplug interrupt | |
172 | * handler. | |
173 | */ | |
174 | disable_irq(output->hpd_irq); | |
d8f4a9ed TR |
175 | } |
176 | ||
59d29c0e TR |
177 | return 0; |
178 | } | |
179 | ||
328ec69e | 180 | void tegra_output_remove(struct tegra_output *output) |
59d29c0e TR |
181 | { |
182 | if (gpio_is_valid(output->hpd_gpio)) { | |
183 | free_irq(output->hpd_irq, output); | |
184 | gpio_free(output->hpd_gpio); | |
185 | } | |
186 | ||
187 | if (output->ddc) | |
188 | put_device(&output->ddc->dev); | |
59d29c0e TR |
189 | } |
190 | ||
191 | int tegra_output_init(struct drm_device *drm, struct tegra_output *output) | |
192 | { | |
ea130b24 | 193 | int err; |
d8f4a9ed | 194 | |
ea130b24 TR |
195 | if (output->panel) { |
196 | err = drm_panel_attach(output->panel, &output->connector); | |
197 | if (err < 0) | |
198 | return err; | |
199 | } | |
d8f4a9ed | 200 | |
8fc8f7da TR |
201 | /* |
202 | * The connector is now registered and ready to receive hotplug events | |
203 | * so the hotplug interrupt can be enabled. | |
204 | */ | |
205 | if (gpio_is_valid(output->hpd_gpio)) | |
206 | enable_irq(output->hpd_irq); | |
207 | ||
d8f4a9ed | 208 | return 0; |
d8f4a9ed TR |
209 | } |
210 | ||
328ec69e | 211 | void tegra_output_exit(struct tegra_output *output) |
d8f4a9ed | 212 | { |
8fc8f7da TR |
213 | /* |
214 | * The connector is going away, so the interrupt must be disabled to | |
215 | * prevent the hotplug interrupt handler from potentially crashing. | |
216 | */ | |
217 | if (gpio_is_valid(output->hpd_gpio)) | |
218 | disable_irq(output->hpd_irq); | |
219 | ||
9aaa0ceb TR |
220 | if (output->panel) |
221 | drm_panel_detach(output->panel); | |
d8f4a9ed | 222 | } |