1 /*
2 * Copyright (C) 2013 Red Hat
3 * Author: Rob Clark <robdclark@gmail.com>
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License version 2 as published by
7 * the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 * You should have received a copy of the GNU General Public License along with
15 * this program. If not, see <http://www.gnu.org/licenses/>.
16 */
17
18 #include <linux/gpio.h>
19 #include <linux/pinctrl/consumer.h>
20
21 #include "msm_kms.h"
22 #include "hdmi.h"
23
24 struct hdmi_connector {
25 struct drm_connector base;
26 struct hdmi *hdmi;
27 struct work_struct hpd_work;
28 };
29 #define to_hdmi_connector(x) container_of(x, struct hdmi_connector, base)
30
hdmi_phy_reset(struct hdmi * hdmi)31 static void hdmi_phy_reset(struct hdmi *hdmi)
32 {
33 unsigned int val;
34
35 val = hdmi_read(hdmi, REG_HDMI_PHY_CTRL);
36
37 if (val & HDMI_PHY_CTRL_SW_RESET_LOW) {
38 /* pull low */
39 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
40 val & ~HDMI_PHY_CTRL_SW_RESET);
41 } else {
42 /* pull high */
43 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
44 val | HDMI_PHY_CTRL_SW_RESET);
45 }
46
47 if (val & HDMI_PHY_CTRL_SW_RESET_PLL_LOW) {
48 /* pull low */
49 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
50 val & ~HDMI_PHY_CTRL_SW_RESET_PLL);
51 } else {
52 /* pull high */
53 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
54 val | HDMI_PHY_CTRL_SW_RESET_PLL);
55 }
56
57 msleep(100);
58
59 if (val & HDMI_PHY_CTRL_SW_RESET_LOW) {
60 /* pull high */
61 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
62 val | HDMI_PHY_CTRL_SW_RESET);
63 } else {
64 /* pull low */
65 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
66 val & ~HDMI_PHY_CTRL_SW_RESET);
67 }
68
69 if (val & HDMI_PHY_CTRL_SW_RESET_PLL_LOW) {
70 /* pull high */
71 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
72 val | HDMI_PHY_CTRL_SW_RESET_PLL);
73 } else {
74 /* pull low */
75 hdmi_write(hdmi, REG_HDMI_PHY_CTRL,
76 val & ~HDMI_PHY_CTRL_SW_RESET_PLL);
77 }
78 }
79
gpio_config(struct hdmi * hdmi,bool on)80 static int gpio_config(struct hdmi *hdmi, bool on)
81 {
82 struct device *dev = &hdmi->pdev->dev;
83 const struct hdmi_platform_config *config = hdmi->config;
84 int ret;
85
86 if (on) {
87 if (config->ddc_clk_gpio != -1) {
88 ret = gpio_request(config->ddc_clk_gpio, "HDMI_DDC_CLK");
89 if (ret) {
90 dev_err(dev, "'%s'(%d) gpio_request failed: %d\n",
91 "HDMI_DDC_CLK", config->ddc_clk_gpio, ret);
92 goto error1;
93 }
94 gpio_set_value_cansleep(config->ddc_clk_gpio, 1);
95 }
96
97 if (config->ddc_data_gpio != -1) {
98 ret = gpio_request(config->ddc_data_gpio, "HDMI_DDC_DATA");
99 if (ret) {
100 dev_err(dev, "'%s'(%d) gpio_request failed: %d\n",
101 "HDMI_DDC_DATA", config->ddc_data_gpio, ret);
102 goto error2;
103 }
104 gpio_set_value_cansleep(config->ddc_data_gpio, 1);
105 }
106
107 ret = gpio_request(config->hpd_gpio, "HDMI_HPD");
108 if (ret) {
109 dev_err(dev, "'%s'(%d) gpio_request failed: %d\n",
110 "HDMI_HPD", config->hpd_gpio, ret);
111 goto error3;
112 }
113 gpio_direction_input(config->hpd_gpio);
114 gpio_set_value_cansleep(config->hpd_gpio, 1);
115
116 if (config->mux_en_gpio != -1) {
117 ret = gpio_request(config->mux_en_gpio, "HDMI_MUX_EN");
118 if (ret) {
119 dev_err(dev, "'%s'(%d) gpio_request failed: %d\n",
120 "HDMI_MUX_EN", config->mux_en_gpio, ret);
121 goto error4;
122 }
123 gpio_set_value_cansleep(config->mux_en_gpio, 1);
124 }
125
126 if (config->mux_sel_gpio != -1) {
127 ret = gpio_request(config->mux_sel_gpio, "HDMI_MUX_SEL");
128 if (ret) {
129 dev_err(dev, "'%s'(%d) gpio_request failed: %d\n",
130 "HDMI_MUX_SEL", config->mux_sel_gpio, ret);
131 goto error5;
132 }
133 gpio_set_value_cansleep(config->mux_sel_gpio, 0);
134 }
135
136 if (config->mux_lpm_gpio != -1) {
137 ret = gpio_request(config->mux_lpm_gpio,
138 "HDMI_MUX_LPM");
139 if (ret) {
140 dev_err(dev,
141 "'%s'(%d) gpio_request failed: %d\n",
142 "HDMI_MUX_LPM",
143 config->mux_lpm_gpio, ret);
144 goto error6;
145 }
146 gpio_set_value_cansleep(config->mux_lpm_gpio, 1);
147 }
148 DBG("gpio on");
149 } else {
150 if (config->ddc_clk_gpio != -1)
151 gpio_free(config->ddc_clk_gpio);
152
153 if (config->ddc_data_gpio != -1)
154 gpio_free(config->ddc_data_gpio);
155
156 gpio_free(config->hpd_gpio);
157
158 if (config->mux_en_gpio != -1) {
159 gpio_set_value_cansleep(config->mux_en_gpio, 0);
160 gpio_free(config->mux_en_gpio);
161 }
162
163 if (config->mux_sel_gpio != -1) {
164 gpio_set_value_cansleep(config->mux_sel_gpio, 1);
165 gpio_free(config->mux_sel_gpio);
166 }
167
168 if (config->mux_lpm_gpio != -1) {
169 gpio_set_value_cansleep(config->mux_lpm_gpio, 0);
170 gpio_free(config->mux_lpm_gpio);
171 }
172 DBG("gpio off");
173 }
174
175 return 0;
176
177 error6:
178 if (config->mux_sel_gpio != -1)
179 gpio_free(config->mux_sel_gpio);
180 error5:
181 if (config->mux_en_gpio != -1)
182 gpio_free(config->mux_en_gpio);
183 error4:
184 gpio_free(config->hpd_gpio);
185 error3:
186 if (config->ddc_data_gpio != -1)
187 gpio_free(config->ddc_data_gpio);
188 error2:
189 if (config->ddc_clk_gpio != -1)
190 gpio_free(config->ddc_clk_gpio);
191 error1:
192 return ret;
193 }
194
hpd_enable(struct hdmi_connector * hdmi_connector)195 static int hpd_enable(struct hdmi_connector *hdmi_connector)
196 {
197 struct hdmi *hdmi = hdmi_connector->hdmi;
198 const struct hdmi_platform_config *config = hdmi->config;
199 struct device *dev = &hdmi->pdev->dev;
200 uint32_t hpd_ctrl;
201 int i, ret;
202 unsigned long flags;
203
204 for (i = 0; i < config->hpd_reg_cnt; i++) {
205 ret = regulator_enable(hdmi->hpd_regs[i]);
206 if (ret) {
207 dev_err(dev, "failed to enable hpd regulator: %s (%d)\n",
208 config->hpd_reg_names[i], ret);
209 goto fail;
210 }
211 }
212
213 ret = pinctrl_pm_select_default_state(dev);
214 if (ret) {
215 dev_err(dev, "pinctrl state chg failed: %d\n", ret);
216 goto fail;
217 }
218
219 ret = gpio_config(hdmi, true);
220 if (ret) {
221 dev_err(dev, "failed to configure GPIOs: %d\n", ret);
222 goto fail;
223 }
224
225 for (i = 0; i < config->hpd_clk_cnt; i++) {
226 if (config->hpd_freq && config->hpd_freq[i]) {
227 ret = clk_set_rate(hdmi->hpd_clks[i],
228 config->hpd_freq[i]);
229 if (ret)
230 dev_warn(dev, "failed to set clk %s (%d)\n",
231 config->hpd_clk_names[i], ret);
232 }
233
234 ret = clk_prepare_enable(hdmi->hpd_clks[i]);
235 if (ret) {
236 dev_err(dev, "failed to enable hpd clk: %s (%d)\n",
237 config->hpd_clk_names[i], ret);
238 goto fail;
239 }
240 }
241
242 hdmi_set_mode(hdmi, false);
243 hdmi_phy_reset(hdmi);
244 hdmi_set_mode(hdmi, true);
245
246 hdmi_write(hdmi, REG_HDMI_USEC_REFTIMER, 0x0001001b);
247
248 /* enable HPD events: */
249 hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL,
250 HDMI_HPD_INT_CTRL_INT_CONNECT |
251 HDMI_HPD_INT_CTRL_INT_EN);
252
253 /* set timeout to 4.1ms (max) for hardware debounce */
254 spin_lock_irqsave(&hdmi->reg_lock, flags);
255 hpd_ctrl = hdmi_read(hdmi, REG_HDMI_HPD_CTRL);
256 hpd_ctrl |= HDMI_HPD_CTRL_TIMEOUT(0x1fff);
257
258 /* Toggle HPD circuit to trigger HPD sense */
259 hdmi_write(hdmi, REG_HDMI_HPD_CTRL,
260 ~HDMI_HPD_CTRL_ENABLE & hpd_ctrl);
261 hdmi_write(hdmi, REG_HDMI_HPD_CTRL,
262 HDMI_HPD_CTRL_ENABLE | hpd_ctrl);
263 spin_unlock_irqrestore(&hdmi->reg_lock, flags);
264
265 return 0;
266
267 fail:
268 return ret;
269 }
270
hdp_disable(struct hdmi_connector * hdmi_connector)271 static void hdp_disable(struct hdmi_connector *hdmi_connector)
272 {
273 struct hdmi *hdmi = hdmi_connector->hdmi;
274 const struct hdmi_platform_config *config = hdmi->config;
275 struct device *dev = &hdmi->pdev->dev;
276 int i, ret = 0;
277
278 /* Disable HPD interrupt */
279 hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL, 0);
280
281 hdmi_set_mode(hdmi, false);
282
283 for (i = 0; i < config->hpd_clk_cnt; i++)
284 clk_disable_unprepare(hdmi->hpd_clks[i]);
285
286 ret = gpio_config(hdmi, false);
287 if (ret)
288 dev_warn(dev, "failed to unconfigure GPIOs: %d\n", ret);
289
290 ret = pinctrl_pm_select_sleep_state(dev);
291 if (ret)
292 dev_warn(dev, "pinctrl state chg failed: %d\n", ret);
293
294 for (i = 0; i < config->hpd_reg_cnt; i++) {
295 ret = regulator_disable(hdmi->hpd_regs[i]);
296 if (ret)
297 dev_warn(dev, "failed to disable hpd regulator: %s (%d)\n",
298 config->hpd_reg_names[i], ret);
299 }
300 }
301
302 static void
hotplug_work(struct work_struct * work)303 hotplug_work(struct work_struct *work)
304 {
305 struct hdmi_connector *hdmi_connector =
306 container_of(work, struct hdmi_connector, hpd_work);
307 struct drm_connector *connector = &hdmi_connector->base;
308 drm_helper_hpd_irq_event(connector->dev);
309 }
310
hdmi_connector_irq(struct drm_connector * connector)311 void hdmi_connector_irq(struct drm_connector *connector)
312 {
313 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
314 struct hdmi *hdmi = hdmi_connector->hdmi;
315 uint32_t hpd_int_status, hpd_int_ctrl;
316
317 /* Process HPD: */
318 hpd_int_status = hdmi_read(hdmi, REG_HDMI_HPD_INT_STATUS);
319 hpd_int_ctrl = hdmi_read(hdmi, REG_HDMI_HPD_INT_CTRL);
320
321 if ((hpd_int_ctrl & HDMI_HPD_INT_CTRL_INT_EN) &&
322 (hpd_int_status & HDMI_HPD_INT_STATUS_INT)) {
323 bool detected = !!(hpd_int_status & HDMI_HPD_INT_STATUS_CABLE_DETECTED);
324
325 /* ack & disable (temporarily) HPD events: */
326 hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL,
327 HDMI_HPD_INT_CTRL_INT_ACK);
328
329 DBG("status=%04x, ctrl=%04x", hpd_int_status, hpd_int_ctrl);
330
331 /* detect disconnect if we are connected or visa versa: */
332 hpd_int_ctrl = HDMI_HPD_INT_CTRL_INT_EN;
333 if (!detected)
334 hpd_int_ctrl |= HDMI_HPD_INT_CTRL_INT_CONNECT;
335 hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL, hpd_int_ctrl);
336
337 queue_work(hdmi->workq, &hdmi_connector->hpd_work);
338 }
339 }
340
detect_reg(struct hdmi * hdmi)341 static enum drm_connector_status detect_reg(struct hdmi *hdmi)
342 {
343 uint32_t hpd_int_status = hdmi_read(hdmi, REG_HDMI_HPD_INT_STATUS);
344 return (hpd_int_status & HDMI_HPD_INT_STATUS_CABLE_DETECTED) ?
345 connector_status_connected : connector_status_disconnected;
346 }
347
detect_gpio(struct hdmi * hdmi)348 static enum drm_connector_status detect_gpio(struct hdmi *hdmi)
349 {
350 const struct hdmi_platform_config *config = hdmi->config;
351 return gpio_get_value(config->hpd_gpio) ?
352 connector_status_connected :
353 connector_status_disconnected;
354 }
355
hdmi_connector_detect(struct drm_connector * connector,bool force)356 static enum drm_connector_status hdmi_connector_detect(
357 struct drm_connector *connector, bool force)
358 {
359 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
360 struct hdmi *hdmi = hdmi_connector->hdmi;
361 enum drm_connector_status stat_gpio, stat_reg;
362 int retry = 20;
363
364 do {
365 stat_gpio = detect_gpio(hdmi);
366 stat_reg = detect_reg(hdmi);
367
368 if (stat_gpio == stat_reg)
369 break;
370
371 mdelay(10);
372 } while (--retry);
373
374 /* the status we get from reading gpio seems to be more reliable,
375 * so trust that one the most if we didn't manage to get hdmi and
376 * gpio status to agree:
377 */
378 if (stat_gpio != stat_reg) {
379 DBG("HDMI_HPD_INT_STATUS tells us: %d", stat_reg);
380 DBG("hpd gpio tells us: %d", stat_gpio);
381 }
382
383 return stat_gpio;
384 }
385
hdmi_connector_destroy(struct drm_connector * connector)386 static void hdmi_connector_destroy(struct drm_connector *connector)
387 {
388 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
389
390 hdp_disable(hdmi_connector);
391
392 drm_connector_unregister(connector);
393 drm_connector_cleanup(connector);
394
395 kfree(hdmi_connector);
396 }
397
hdmi_connector_get_modes(struct drm_connector * connector)398 static int hdmi_connector_get_modes(struct drm_connector *connector)
399 {
400 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
401 struct hdmi *hdmi = hdmi_connector->hdmi;
402 struct edid *edid;
403 uint32_t hdmi_ctrl;
404 int ret = 0;
405
406 hdmi_ctrl = hdmi_read(hdmi, REG_HDMI_CTRL);
407 hdmi_write(hdmi, REG_HDMI_CTRL, hdmi_ctrl | HDMI_CTRL_ENABLE);
408
409 edid = drm_get_edid(connector, hdmi->i2c);
410
411 hdmi_write(hdmi, REG_HDMI_CTRL, hdmi_ctrl);
412
413 hdmi->hdmi_mode = drm_detect_hdmi_monitor(edid);
414 drm_mode_connector_update_edid_property(connector, edid);
415
416 if (edid) {
417 ret = drm_add_edid_modes(connector, edid);
418 kfree(edid);
419 }
420
421 return ret;
422 }
423
hdmi_connector_mode_valid(struct drm_connector * connector,struct drm_display_mode * mode)424 static int hdmi_connector_mode_valid(struct drm_connector *connector,
425 struct drm_display_mode *mode)
426 {
427 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
428 struct hdmi *hdmi = hdmi_connector->hdmi;
429 const struct hdmi_platform_config *config = hdmi->config;
430 struct msm_drm_private *priv = connector->dev->dev_private;
431 struct msm_kms *kms = priv->kms;
432 long actual, requested;
433
434 requested = 1000 * mode->clock;
435 actual = kms->funcs->round_pixclk(kms,
436 requested, hdmi_connector->hdmi->encoder);
437
438 /* for mdp5/apq8074, we manage our own pixel clk (as opposed to
439 * mdp4/dtv stuff where pixel clk is assigned to mdp/encoder
440 * instead):
441 */
442 if (config->pwr_clk_cnt > 0)
443 actual = clk_round_rate(hdmi->pwr_clks[0], actual);
444
445 DBG("requested=%ld, actual=%ld", requested, actual);
446
447 if (actual != requested)
448 return MODE_CLOCK_RANGE;
449
450 return 0;
451 }
452
453 static struct drm_encoder *
hdmi_connector_best_encoder(struct drm_connector * connector)454 hdmi_connector_best_encoder(struct drm_connector *connector)
455 {
456 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
457 return hdmi_connector->hdmi->encoder;
458 }
459
460 static const struct drm_connector_funcs hdmi_connector_funcs = {
461 .dpms = drm_atomic_helper_connector_dpms,
462 .detect = hdmi_connector_detect,
463 .fill_modes = drm_helper_probe_single_connector_modes,
464 .destroy = hdmi_connector_destroy,
465 .reset = drm_atomic_helper_connector_reset,
466 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
467 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
468 };
469
470 static const struct drm_connector_helper_funcs hdmi_connector_helper_funcs = {
471 .get_modes = hdmi_connector_get_modes,
472 .mode_valid = hdmi_connector_mode_valid,
473 .best_encoder = hdmi_connector_best_encoder,
474 };
475
476 /* initialize connector */
hdmi_connector_init(struct hdmi * hdmi)477 struct drm_connector *hdmi_connector_init(struct hdmi *hdmi)
478 {
479 struct drm_connector *connector = NULL;
480 struct hdmi_connector *hdmi_connector;
481 int ret;
482
483 hdmi_connector = kzalloc(sizeof(*hdmi_connector), GFP_KERNEL);
484 if (!hdmi_connector) {
485 ret = -ENOMEM;
486 goto fail;
487 }
488
489 hdmi_connector->hdmi = hdmi;
490 INIT_WORK(&hdmi_connector->hpd_work, hotplug_work);
491
492 connector = &hdmi_connector->base;
493
494 drm_connector_init(hdmi->dev, connector, &hdmi_connector_funcs,
495 DRM_MODE_CONNECTOR_HDMIA);
496 drm_connector_helper_add(connector, &hdmi_connector_helper_funcs);
497
498 connector->polled = DRM_CONNECTOR_POLL_CONNECT |
499 DRM_CONNECTOR_POLL_DISCONNECT;
500
501 connector->interlace_allowed = 0;
502 connector->doublescan_allowed = 0;
503
504 drm_connector_register(connector);
505
506 ret = hpd_enable(hdmi_connector);
507 if (ret) {
508 dev_err(&hdmi->pdev->dev, "failed to enable HPD: %d\n", ret);
509 goto fail;
510 }
511
512 drm_mode_connector_attach_encoder(connector, hdmi->encoder);
513
514 return connector;
515
516 fail:
517 if (connector)
518 hdmi_connector_destroy(connector);
519
520 return ERR_PTR(ret);
521 }
522