2 * Copyright (C) 2013 Red Hat
3 * Author: Rob Clark <robdclark@gmail.com>
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.
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
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/>.
18 #include <linux/gpio.h>
23 struct hdmi_connector {
24 struct drm_connector base;
26 struct work_struct hpd_work;
28 #define to_hdmi_connector(x) container_of(x, struct hdmi_connector, base)
30 static int gpio_config(struct hdmi *hdmi, bool on)
32 struct drm_device *dev = hdmi->dev;
33 const struct hdmi_platform_config *config = hdmi->config;
37 ret = gpio_request(config->ddc_clk_gpio, "HDMI_DDC_CLK");
39 dev_err(dev->dev, "'%s'(%d) gpio_request failed: %d\n",
40 "HDMI_DDC_CLK", config->ddc_clk_gpio, ret);
43 gpio_set_value_cansleep(config->ddc_clk_gpio, 1);
45 ret = gpio_request(config->ddc_data_gpio, "HDMI_DDC_DATA");
47 dev_err(dev->dev, "'%s'(%d) gpio_request failed: %d\n",
48 "HDMI_DDC_DATA", config->ddc_data_gpio, ret);
51 gpio_set_value_cansleep(config->ddc_data_gpio, 1);
53 ret = gpio_request(config->hpd_gpio, "HDMI_HPD");
55 dev_err(dev->dev, "'%s'(%d) gpio_request failed: %d\n",
56 "HDMI_HPD", config->hpd_gpio, ret);
59 gpio_direction_input(config->hpd_gpio);
60 gpio_set_value_cansleep(config->hpd_gpio, 1);
62 if (config->mux_en_gpio != -1) {
63 ret = gpio_request(config->mux_en_gpio, "HDMI_MUX_EN");
65 dev_err(dev->dev, "'%s'(%d) gpio_request failed: %d\n",
66 "HDMI_MUX_SEL", config->mux_en_gpio, ret);
69 gpio_set_value_cansleep(config->mux_en_gpio, 1);
72 if (config->mux_sel_gpio != -1) {
73 ret = gpio_request(config->mux_sel_gpio, "HDMI_MUX_SEL");
75 dev_err(dev->dev, "'%s'(%d) gpio_request failed: %d\n",
76 "HDMI_MUX_SEL", config->mux_sel_gpio, ret);
79 gpio_set_value_cansleep(config->mux_sel_gpio, 0);
83 gpio_free(config->ddc_clk_gpio);
84 gpio_free(config->ddc_data_gpio);
85 gpio_free(config->hpd_gpio);
87 if (config->mux_en_gpio != -1) {
88 gpio_set_value_cansleep(config->mux_en_gpio, 0);
89 gpio_free(config->mux_en_gpio);
92 if (config->mux_sel_gpio != -1) {
93 gpio_set_value_cansleep(config->mux_sel_gpio, 1);
94 gpio_free(config->mux_sel_gpio);
102 if (config->mux_en_gpio != -1)
103 gpio_free(config->mux_en_gpio);
105 gpio_free(config->hpd_gpio);
107 gpio_free(config->ddc_data_gpio);
109 gpio_free(config->ddc_clk_gpio);
114 static int hpd_enable(struct hdmi_connector *hdmi_connector)
116 struct hdmi *hdmi = hdmi_connector->hdmi;
117 const struct hdmi_platform_config *config = hdmi->config;
118 struct drm_device *dev = hdmi_connector->base.dev;
119 struct hdmi_phy *phy = hdmi->phy;
123 ret = gpio_config(hdmi, true);
125 dev_err(dev->dev, "failed to configure GPIOs: %d\n", ret);
129 for (i = 0; i < config->hpd_clk_cnt; i++) {
130 if (config->hpd_freq && config->hpd_freq[i]) {
131 ret = clk_set_rate(hdmi->hpd_clks[i],
132 config->hpd_freq[i]);
134 dev_warn(dev->dev, "failed to set clk %s (%d)\n",
135 config->hpd_clk_names[i], ret);
138 ret = clk_prepare_enable(hdmi->hpd_clks[i]);
140 dev_err(dev->dev, "failed to enable hpd clk: %s (%d)\n",
141 config->hpd_clk_names[i], ret);
146 for (i = 0; i < config->hpd_reg_cnt; i++) {
147 ret = regulator_enable(hdmi->hpd_regs[i]);
149 dev_err(dev->dev, "failed to enable hpd regulator: %s (%d)\n",
150 config->hpd_reg_names[i], ret);
155 hdmi_set_mode(hdmi, false);
156 phy->funcs->reset(phy);
157 hdmi_set_mode(hdmi, true);
159 hdmi_write(hdmi, REG_HDMI_USEC_REFTIMER, 0x0001001b);
161 /* enable HPD events: */
162 hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL,
163 HDMI_HPD_INT_CTRL_INT_CONNECT |
164 HDMI_HPD_INT_CTRL_INT_EN);
166 /* set timeout to 4.1ms (max) for hardware debounce */
167 hpd_ctrl = hdmi_read(hdmi, REG_HDMI_HPD_CTRL);
168 hpd_ctrl |= HDMI_HPD_CTRL_TIMEOUT(0x1fff);
170 /* Toggle HPD circuit to trigger HPD sense */
171 hdmi_write(hdmi, REG_HDMI_HPD_CTRL,
172 ~HDMI_HPD_CTRL_ENABLE & hpd_ctrl);
173 hdmi_write(hdmi, REG_HDMI_HPD_CTRL,
174 HDMI_HPD_CTRL_ENABLE | hpd_ctrl);
182 static int hdp_disable(struct hdmi_connector *hdmi_connector)
184 struct hdmi *hdmi = hdmi_connector->hdmi;
185 const struct hdmi_platform_config *config = hdmi->config;
186 struct drm_device *dev = hdmi_connector->base.dev;
189 /* Disable HPD interrupt */
190 hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL, 0);
192 hdmi_set_mode(hdmi, false);
194 for (i = 0; i < config->hpd_reg_cnt; i++) {
195 ret = regulator_disable(hdmi->hpd_regs[i]);
197 dev_err(dev->dev, "failed to disable hpd regulator: %s (%d)\n",
198 config->hpd_reg_names[i], ret);
203 for (i = 0; i < config->hpd_clk_cnt; i++)
204 clk_disable_unprepare(hdmi->hpd_clks[i]);
206 ret = gpio_config(hdmi, false);
208 dev_err(dev->dev, "failed to unconfigure GPIOs: %d\n", ret);
219 hotplug_work(struct work_struct *work)
221 struct hdmi_connector *hdmi_connector =
222 container_of(work, struct hdmi_connector, hpd_work);
223 struct drm_connector *connector = &hdmi_connector->base;
224 drm_helper_hpd_irq_event(connector->dev);
227 void hdmi_connector_irq(struct drm_connector *connector)
229 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
230 struct msm_drm_private *priv = connector->dev->dev_private;
231 struct hdmi *hdmi = hdmi_connector->hdmi;
232 uint32_t hpd_int_status, hpd_int_ctrl;
235 hpd_int_status = hdmi_read(hdmi, REG_HDMI_HPD_INT_STATUS);
236 hpd_int_ctrl = hdmi_read(hdmi, REG_HDMI_HPD_INT_CTRL);
238 if ((hpd_int_ctrl & HDMI_HPD_INT_CTRL_INT_EN) &&
239 (hpd_int_status & HDMI_HPD_INT_STATUS_INT)) {
240 bool detected = !!(hpd_int_status & HDMI_HPD_INT_STATUS_CABLE_DETECTED);
242 DBG("status=%04x, ctrl=%04x", hpd_int_status, hpd_int_ctrl);
245 hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL,
246 hpd_int_ctrl | HDMI_HPD_INT_CTRL_INT_ACK);
248 /* detect disconnect if we are connected or visa versa: */
249 hpd_int_ctrl = HDMI_HPD_INT_CTRL_INT_EN;
251 hpd_int_ctrl |= HDMI_HPD_INT_CTRL_INT_CONNECT;
252 hdmi_write(hdmi, REG_HDMI_HPD_INT_CTRL, hpd_int_ctrl);
254 queue_work(priv->wq, &hdmi_connector->hpd_work);
258 static enum drm_connector_status detect_reg(struct hdmi *hdmi)
260 uint32_t hpd_int_status = hdmi_read(hdmi, REG_HDMI_HPD_INT_STATUS);
261 return (hpd_int_status & HDMI_HPD_INT_STATUS_CABLE_DETECTED) ?
262 connector_status_connected : connector_status_disconnected;
265 static enum drm_connector_status detect_gpio(struct hdmi *hdmi)
267 const struct hdmi_platform_config *config = hdmi->config;
268 return gpio_get_value(config->hpd_gpio) ?
269 connector_status_connected :
270 connector_status_disconnected;
273 static enum drm_connector_status hdmi_connector_detect(
274 struct drm_connector *connector, bool force)
276 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
277 struct hdmi *hdmi = hdmi_connector->hdmi;
278 enum drm_connector_status stat_gpio, stat_reg;
282 stat_gpio = detect_gpio(hdmi);
283 stat_reg = detect_reg(hdmi);
285 if (stat_gpio == stat_reg)
291 /* the status we get from reading gpio seems to be more reliable,
292 * so trust that one the most if we didn't manage to get hdmi and
293 * gpio status to agree:
295 if (stat_gpio != stat_reg) {
296 DBG("HDMI_HPD_INT_STATUS tells us: %d", stat_reg);
297 DBG("hpd gpio tells us: %d", stat_gpio);
303 static void hdmi_connector_destroy(struct drm_connector *connector)
305 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
307 hdp_disable(hdmi_connector);
309 drm_sysfs_connector_remove(connector);
310 drm_connector_cleanup(connector);
312 hdmi_unreference(hdmi_connector->hdmi);
314 kfree(hdmi_connector);
317 static int hdmi_connector_get_modes(struct drm_connector *connector)
319 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
320 struct hdmi *hdmi = hdmi_connector->hdmi;
325 hdmi_ctrl = hdmi_read(hdmi, REG_HDMI_CTRL);
326 hdmi_write(hdmi, REG_HDMI_CTRL, hdmi_ctrl | HDMI_CTRL_ENABLE);
328 edid = drm_get_edid(connector, hdmi->i2c);
330 hdmi_write(hdmi, REG_HDMI_CTRL, hdmi_ctrl);
332 drm_mode_connector_update_edid_property(connector, edid);
335 ret = drm_add_edid_modes(connector, edid);
342 static int hdmi_connector_mode_valid(struct drm_connector *connector,
343 struct drm_display_mode *mode)
345 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
346 struct hdmi *hdmi = hdmi_connector->hdmi;
347 const struct hdmi_platform_config *config = hdmi->config;
348 struct msm_drm_private *priv = connector->dev->dev_private;
349 struct msm_kms *kms = priv->kms;
350 long actual, requested;
352 requested = 1000 * mode->clock;
353 actual = kms->funcs->round_pixclk(kms,
354 requested, hdmi_connector->hdmi->encoder);
356 /* for mdp5/apq8074, we manage our own pixel clk (as opposed to
357 * mdp4/dtv stuff where pixel clk is assigned to mdp/encoder
360 if (config->pwr_clk_cnt > 0)
361 actual = clk_round_rate(hdmi->pwr_clks[0], actual);
363 DBG("requested=%ld, actual=%ld", requested, actual);
365 if (actual != requested)
366 return MODE_CLOCK_RANGE;
371 static struct drm_encoder *
372 hdmi_connector_best_encoder(struct drm_connector *connector)
374 struct hdmi_connector *hdmi_connector = to_hdmi_connector(connector);
375 return hdmi_connector->hdmi->encoder;
378 static const struct drm_connector_funcs hdmi_connector_funcs = {
379 .dpms = drm_helper_connector_dpms,
380 .detect = hdmi_connector_detect,
381 .fill_modes = drm_helper_probe_single_connector_modes,
382 .destroy = hdmi_connector_destroy,
385 static const struct drm_connector_helper_funcs hdmi_connector_helper_funcs = {
386 .get_modes = hdmi_connector_get_modes,
387 .mode_valid = hdmi_connector_mode_valid,
388 .best_encoder = hdmi_connector_best_encoder,
391 /* initialize connector */
392 struct drm_connector *hdmi_connector_init(struct hdmi *hdmi)
394 struct drm_connector *connector = NULL;
395 struct hdmi_connector *hdmi_connector;
398 hdmi_connector = kzalloc(sizeof(*hdmi_connector), GFP_KERNEL);
399 if (!hdmi_connector) {
404 hdmi_connector->hdmi = hdmi_reference(hdmi);
405 INIT_WORK(&hdmi_connector->hpd_work, hotplug_work);
407 connector = &hdmi_connector->base;
409 drm_connector_init(hdmi->dev, connector, &hdmi_connector_funcs,
410 DRM_MODE_CONNECTOR_HDMIA);
411 drm_connector_helper_add(connector, &hdmi_connector_helper_funcs);
413 connector->polled = DRM_CONNECTOR_POLL_CONNECT |
414 DRM_CONNECTOR_POLL_DISCONNECT;
416 connector->interlace_allowed = 1;
417 connector->doublescan_allowed = 0;
419 drm_sysfs_connector_add(connector);
421 ret = hpd_enable(hdmi_connector);
423 dev_err(hdmi->dev->dev, "failed to enable HPD: %d\n", ret);
427 drm_mode_connector_attach_encoder(connector, hdmi->encoder);
433 hdmi_connector_destroy(connector);