• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * Copyright (c) 2014 The Linux Foundation. All rights reserved.
3  * Copyright (C) 2013 Red Hat
4  * Author: Rob Clark <robdclark@gmail.com>
5  *
6  * This program is free software; you can redistribute it and/or modify it
7  * under the terms of the GNU General Public License version 2 as published by
8  * the Free Software Foundation.
9  *
10  * This program is distributed in the hope that it will be useful, but WITHOUT
11  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
13  * more details.
14  *
15  * You should have received a copy of the GNU General Public License along with
16  * this program.  If not, see <http://www.gnu.org/licenses/>.
17  */
18 
19 #include <linux/of_irq.h>
20 #include <linux/of_gpio.h>
21 
22 #include <sound/hdmi-codec.h>
23 #include "hdmi.h"
24 
msm_hdmi_set_mode(struct hdmi * hdmi,bool power_on)25 void msm_hdmi_set_mode(struct hdmi *hdmi, bool power_on)
26 {
27 	uint32_t ctrl = 0;
28 	unsigned long flags;
29 
30 	spin_lock_irqsave(&hdmi->reg_lock, flags);
31 	if (power_on) {
32 		ctrl |= HDMI_CTRL_ENABLE;
33 		if (!hdmi->hdmi_mode) {
34 			ctrl |= HDMI_CTRL_HDMI;
35 			hdmi_write(hdmi, REG_HDMI_CTRL, ctrl);
36 			ctrl &= ~HDMI_CTRL_HDMI;
37 		} else {
38 			ctrl |= HDMI_CTRL_HDMI;
39 		}
40 	} else {
41 		ctrl = HDMI_CTRL_HDMI;
42 	}
43 
44 	hdmi_write(hdmi, REG_HDMI_CTRL, ctrl);
45 	spin_unlock_irqrestore(&hdmi->reg_lock, flags);
46 	DBG("HDMI Core: %s, HDMI_CTRL=0x%08x",
47 			power_on ? "Enable" : "Disable", ctrl);
48 }
49 
msm_hdmi_irq(int irq,void * dev_id)50 static irqreturn_t msm_hdmi_irq(int irq, void *dev_id)
51 {
52 	struct hdmi *hdmi = dev_id;
53 
54 	/* Process HPD: */
55 	msm_hdmi_connector_irq(hdmi->connector);
56 
57 	/* Process DDC: */
58 	msm_hdmi_i2c_irq(hdmi->i2c);
59 
60 	/* Process HDCP: */
61 	if (hdmi->hdcp_ctrl)
62 		msm_hdmi_hdcp_irq(hdmi->hdcp_ctrl);
63 
64 	/* TODO audio.. */
65 
66 	return IRQ_HANDLED;
67 }
68 
msm_hdmi_destroy(struct hdmi * hdmi)69 static void msm_hdmi_destroy(struct hdmi *hdmi)
70 {
71 	/*
72 	 * at this point, hpd has been disabled,
73 	 * after flush workq, it's safe to deinit hdcp
74 	 */
75 	if (hdmi->workq) {
76 		flush_workqueue(hdmi->workq);
77 		destroy_workqueue(hdmi->workq);
78 	}
79 	msm_hdmi_hdcp_destroy(hdmi);
80 
81 	if (hdmi->phy_dev) {
82 		put_device(hdmi->phy_dev);
83 		hdmi->phy = NULL;
84 		hdmi->phy_dev = NULL;
85 	}
86 
87 	if (hdmi->i2c)
88 		msm_hdmi_i2c_destroy(hdmi->i2c);
89 
90 	platform_set_drvdata(hdmi->pdev, NULL);
91 }
92 
msm_hdmi_get_phy(struct hdmi * hdmi)93 static int msm_hdmi_get_phy(struct hdmi *hdmi)
94 {
95 	struct platform_device *pdev = hdmi->pdev;
96 	struct platform_device *phy_pdev;
97 	struct device_node *phy_node;
98 
99 	phy_node = of_parse_phandle(pdev->dev.of_node, "phys", 0);
100 	if (!phy_node) {
101 		dev_err(&pdev->dev, "cannot find phy device\n");
102 		return -ENXIO;
103 	}
104 
105 	phy_pdev = of_find_device_by_node(phy_node);
106 	if (phy_pdev)
107 		hdmi->phy = platform_get_drvdata(phy_pdev);
108 
109 	of_node_put(phy_node);
110 
111 	if (!phy_pdev || !hdmi->phy) {
112 		dev_err(&pdev->dev, "phy driver is not ready\n");
113 		return -EPROBE_DEFER;
114 	}
115 
116 	hdmi->phy_dev = get_device(&phy_pdev->dev);
117 
118 	return 0;
119 }
120 
121 /* construct hdmi at bind/probe time, grab all the resources.  If
122  * we are to EPROBE_DEFER we want to do it here, rather than later
123  * at modeset_init() time
124  */
msm_hdmi_init(struct platform_device * pdev)125 static struct hdmi *msm_hdmi_init(struct platform_device *pdev)
126 {
127 	struct hdmi_platform_config *config = pdev->dev.platform_data;
128 	struct hdmi *hdmi = NULL;
129 	struct resource *res;
130 	int i, ret;
131 
132 	hdmi = devm_kzalloc(&pdev->dev, sizeof(*hdmi), GFP_KERNEL);
133 	if (!hdmi) {
134 		ret = -ENOMEM;
135 		goto fail;
136 	}
137 
138 	hdmi->pdev = pdev;
139 	hdmi->config = config;
140 	spin_lock_init(&hdmi->reg_lock);
141 
142 	hdmi->mmio = msm_ioremap(pdev, config->mmio_name, "HDMI");
143 	if (IS_ERR(hdmi->mmio)) {
144 		ret = PTR_ERR(hdmi->mmio);
145 		goto fail;
146 	}
147 
148 	/* HDCP needs physical address of hdmi register */
149 	res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
150 		config->mmio_name);
151 	hdmi->mmio_phy_addr = res->start;
152 
153 	hdmi->qfprom_mmio = msm_ioremap(pdev,
154 		config->qfprom_mmio_name, "HDMI_QFPROM");
155 	if (IS_ERR(hdmi->qfprom_mmio)) {
156 		dev_info(&pdev->dev, "can't find qfprom resource\n");
157 		hdmi->qfprom_mmio = NULL;
158 	}
159 
160 	hdmi->hpd_regs = devm_kzalloc(&pdev->dev, sizeof(hdmi->hpd_regs[0]) *
161 			config->hpd_reg_cnt, GFP_KERNEL);
162 	if (!hdmi->hpd_regs) {
163 		ret = -ENOMEM;
164 		goto fail;
165 	}
166 	for (i = 0; i < config->hpd_reg_cnt; i++) {
167 		struct regulator *reg;
168 
169 		reg = devm_regulator_get(&pdev->dev,
170 				config->hpd_reg_names[i]);
171 		if (IS_ERR(reg)) {
172 			ret = PTR_ERR(reg);
173 			dev_err(&pdev->dev, "failed to get hpd regulator: %s (%d)\n",
174 					config->hpd_reg_names[i], ret);
175 			goto fail;
176 		}
177 
178 		hdmi->hpd_regs[i] = reg;
179 	}
180 
181 	hdmi->pwr_regs = devm_kzalloc(&pdev->dev, sizeof(hdmi->pwr_regs[0]) *
182 			config->pwr_reg_cnt, GFP_KERNEL);
183 	if (!hdmi->pwr_regs) {
184 		ret = -ENOMEM;
185 		goto fail;
186 	}
187 	for (i = 0; i < config->pwr_reg_cnt; i++) {
188 		struct regulator *reg;
189 
190 		reg = devm_regulator_get(&pdev->dev,
191 				config->pwr_reg_names[i]);
192 		if (IS_ERR(reg)) {
193 			ret = PTR_ERR(reg);
194 			dev_err(&pdev->dev, "failed to get pwr regulator: %s (%d)\n",
195 					config->pwr_reg_names[i], ret);
196 			goto fail;
197 		}
198 
199 		hdmi->pwr_regs[i] = reg;
200 	}
201 
202 	hdmi->hpd_clks = devm_kzalloc(&pdev->dev, sizeof(hdmi->hpd_clks[0]) *
203 			config->hpd_clk_cnt, GFP_KERNEL);
204 	if (!hdmi->hpd_clks) {
205 		ret = -ENOMEM;
206 		goto fail;
207 	}
208 	for (i = 0; i < config->hpd_clk_cnt; i++) {
209 		struct clk *clk;
210 
211 		clk = devm_clk_get(&pdev->dev, config->hpd_clk_names[i]);
212 		if (IS_ERR(clk)) {
213 			ret = PTR_ERR(clk);
214 			dev_err(&pdev->dev, "failed to get hpd clk: %s (%d)\n",
215 					config->hpd_clk_names[i], ret);
216 			goto fail;
217 		}
218 
219 		hdmi->hpd_clks[i] = clk;
220 	}
221 
222 	hdmi->pwr_clks = devm_kzalloc(&pdev->dev, sizeof(hdmi->pwr_clks[0]) *
223 			config->pwr_clk_cnt, GFP_KERNEL);
224 	if (!hdmi->pwr_clks) {
225 		ret = -ENOMEM;
226 		goto fail;
227 	}
228 	for (i = 0; i < config->pwr_clk_cnt; i++) {
229 		struct clk *clk;
230 
231 		clk = devm_clk_get(&pdev->dev, config->pwr_clk_names[i]);
232 		if (IS_ERR(clk)) {
233 			ret = PTR_ERR(clk);
234 			dev_err(&pdev->dev, "failed to get pwr clk: %s (%d)\n",
235 					config->pwr_clk_names[i], ret);
236 			goto fail;
237 		}
238 
239 		hdmi->pwr_clks[i] = clk;
240 	}
241 
242 	hdmi->workq = alloc_ordered_workqueue("msm_hdmi", 0);
243 
244 	hdmi->i2c = msm_hdmi_i2c_init(hdmi);
245 	if (IS_ERR(hdmi->i2c)) {
246 		ret = PTR_ERR(hdmi->i2c);
247 		dev_err(&pdev->dev, "failed to get i2c: %d\n", ret);
248 		hdmi->i2c = NULL;
249 		goto fail;
250 	}
251 
252 	ret = msm_hdmi_get_phy(hdmi);
253 	if (ret) {
254 		dev_err(&pdev->dev, "failed to get phy\n");
255 		goto fail;
256 	}
257 
258 	hdmi->hdcp_ctrl = msm_hdmi_hdcp_init(hdmi);
259 	if (IS_ERR(hdmi->hdcp_ctrl)) {
260 		dev_warn(&pdev->dev, "failed to init hdcp: disabled\n");
261 		hdmi->hdcp_ctrl = NULL;
262 	}
263 
264 	return hdmi;
265 
266 fail:
267 	if (hdmi)
268 		msm_hdmi_destroy(hdmi);
269 
270 	return ERR_PTR(ret);
271 }
272 
273 /* Second part of initialization, the drm/kms level modeset_init,
274  * constructs/initializes mode objects, etc, is called from master
275  * driver (not hdmi sub-device's probe/bind!)
276  *
277  * Any resource (regulator/clk/etc) which could be missing at boot
278  * should be handled in msm_hdmi_init() so that failure happens from
279  * hdmi sub-device's probe.
280  */
msm_hdmi_modeset_init(struct hdmi * hdmi,struct drm_device * dev,struct drm_encoder * encoder)281 int msm_hdmi_modeset_init(struct hdmi *hdmi,
282 		struct drm_device *dev, struct drm_encoder *encoder)
283 {
284 	struct msm_drm_private *priv = dev->dev_private;
285 	struct platform_device *pdev = hdmi->pdev;
286 	int ret;
287 
288 	hdmi->dev = dev;
289 	hdmi->encoder = encoder;
290 
291 	hdmi_audio_infoframe_init(&hdmi->audio.infoframe);
292 
293 	hdmi->bridge = msm_hdmi_bridge_init(hdmi);
294 	if (IS_ERR(hdmi->bridge)) {
295 		ret = PTR_ERR(hdmi->bridge);
296 		dev_err(dev->dev, "failed to create HDMI bridge: %d\n", ret);
297 		hdmi->bridge = NULL;
298 		goto fail;
299 	}
300 
301 	hdmi->connector = msm_hdmi_connector_init(hdmi);
302 	if (IS_ERR(hdmi->connector)) {
303 		ret = PTR_ERR(hdmi->connector);
304 		dev_err(dev->dev, "failed to create HDMI connector: %d\n", ret);
305 		hdmi->connector = NULL;
306 		goto fail;
307 	}
308 
309 	hdmi->irq = irq_of_parse_and_map(pdev->dev.of_node, 0);
310 	if (hdmi->irq < 0) {
311 		ret = hdmi->irq;
312 		dev_err(dev->dev, "failed to get irq: %d\n", ret);
313 		goto fail;
314 	}
315 
316 	ret = devm_request_irq(&pdev->dev, hdmi->irq,
317 			msm_hdmi_irq, IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
318 			"hdmi_isr", hdmi);
319 	if (ret < 0) {
320 		dev_err(dev->dev, "failed to request IRQ%u: %d\n",
321 				hdmi->irq, ret);
322 		goto fail;
323 	}
324 
325 	encoder->bridge = hdmi->bridge;
326 
327 	priv->bridges[priv->num_bridges++]       = hdmi->bridge;
328 	priv->connectors[priv->num_connectors++] = hdmi->connector;
329 
330 	platform_set_drvdata(pdev, hdmi);
331 
332 	return 0;
333 
334 fail:
335 	/* bridge is normally destroyed by drm: */
336 	if (hdmi->bridge) {
337 		msm_hdmi_bridge_destroy(hdmi->bridge);
338 		hdmi->bridge = NULL;
339 	}
340 	if (hdmi->connector) {
341 		hdmi->connector->funcs->destroy(hdmi->connector);
342 		hdmi->connector = NULL;
343 	}
344 
345 	return ret;
346 }
347 
348 /*
349  * The hdmi device:
350  */
351 
352 #define HDMI_CFG(item, entry) \
353 	.item ## _names = item ##_names_ ## entry, \
354 	.item ## _cnt   = ARRAY_SIZE(item ## _names_ ## entry)
355 
356 static const char *pwr_reg_names_none[] = {};
357 static const char *hpd_reg_names_none[] = {};
358 
359 static struct hdmi_platform_config hdmi_tx_8660_config;
360 
361 static const char *hpd_reg_names_8960[] = {"core-vdda", "hdmi-mux"};
362 static const char *hpd_clk_names_8960[] = {"core_clk", "master_iface_clk", "slave_iface_clk"};
363 
364 static struct hdmi_platform_config hdmi_tx_8960_config = {
365 		HDMI_CFG(hpd_reg, 8960),
366 		HDMI_CFG(hpd_clk, 8960),
367 };
368 
369 static const char *pwr_reg_names_8x74[] = {"core-vdda", "core-vcc"};
370 static const char *hpd_reg_names_8x74[] = {"hpd-gdsc", "hpd-5v"};
371 static const char *pwr_clk_names_8x74[] = {"extp_clk", "alt_iface_clk"};
372 static const char *hpd_clk_names_8x74[] = {"iface_clk", "core_clk", "mdp_core_clk"};
373 static unsigned long hpd_clk_freq_8x74[] = {0, 19200000, 0};
374 
375 static struct hdmi_platform_config hdmi_tx_8974_config = {
376 		HDMI_CFG(pwr_reg, 8x74),
377 		HDMI_CFG(hpd_reg, 8x74),
378 		HDMI_CFG(pwr_clk, 8x74),
379 		HDMI_CFG(hpd_clk, 8x74),
380 		.hpd_freq      = hpd_clk_freq_8x74,
381 };
382 
383 static const char *hpd_reg_names_8084[] = {"hpd-gdsc", "hpd-5v", "hpd-5v-en"};
384 
385 static struct hdmi_platform_config hdmi_tx_8084_config = {
386 		HDMI_CFG(pwr_reg, 8x74),
387 		HDMI_CFG(hpd_reg, 8084),
388 		HDMI_CFG(pwr_clk, 8x74),
389 		HDMI_CFG(hpd_clk, 8x74),
390 		.hpd_freq      = hpd_clk_freq_8x74,
391 };
392 
393 static struct hdmi_platform_config hdmi_tx_8994_config = {
394 		HDMI_CFG(pwr_reg, 8x74),
395 		HDMI_CFG(hpd_reg, none),
396 		HDMI_CFG(pwr_clk, 8x74),
397 		HDMI_CFG(hpd_clk, 8x74),
398 		.hpd_freq      = hpd_clk_freq_8x74,
399 };
400 
401 static struct hdmi_platform_config hdmi_tx_8996_config = {
402 		HDMI_CFG(pwr_reg, none),
403 		HDMI_CFG(hpd_reg, none),
404 		HDMI_CFG(pwr_clk, 8x74),
405 		HDMI_CFG(hpd_clk, 8x74),
406 		.hpd_freq      = hpd_clk_freq_8x74,
407 };
408 
409 static const struct {
410 	const char *name;
411 	const bool output;
412 	const int value;
413 	const char *label;
414 } msm_hdmi_gpio_pdata[] = {
415 	{ "qcom,hdmi-tx-ddc-clk", true, 1, "HDMI_DDC_CLK" },
416 	{ "qcom,hdmi-tx-ddc-data", true, 1, "HDMI_DDC_DATA" },
417 	{ "qcom,hdmi-tx-hpd", false, 1, "HDMI_HPD" },
418 	{ "qcom,hdmi-tx-mux-en", true, 1, "HDMI_MUX_EN" },
419 	{ "qcom,hdmi-tx-mux-sel", true, 0, "HDMI_MUX_SEL" },
420 	{ "qcom,hdmi-tx-mux-lpm", true, 1, "HDMI_MUX_LPM" },
421 };
422 
msm_hdmi_get_gpio(struct device_node * of_node,const char * name)423 static int msm_hdmi_get_gpio(struct device_node *of_node, const char *name)
424 {
425 	int gpio;
426 
427 	/* try with the gpio names as in the table (downstream bindings) */
428 	gpio = of_get_named_gpio(of_node, name, 0);
429 	if (gpio < 0) {
430 		char name2[32];
431 
432 		/* try with the gpio names as in the upstream bindings */
433 		snprintf(name2, sizeof(name2), "%s-gpios", name);
434 		gpio = of_get_named_gpio(of_node, name2, 0);
435 		if (gpio < 0) {
436 			char name3[32];
437 
438 			/*
439 			 * try again after stripping out the "qcom,hdmi-tx"
440 			 * prefix. This is mainly to match "hpd-gpios" used
441 			 * in the upstream bindings
442 			 */
443 			if (sscanf(name2, "qcom,hdmi-tx-%s", name3))
444 				gpio = of_get_named_gpio(of_node, name3, 0);
445 		}
446 
447 		if (gpio < 0) {
448 			DBG("failed to get gpio: %s (%d)", name, gpio);
449 			gpio = -1;
450 		}
451 	}
452 	return gpio;
453 }
454 
455 /*
456  * HDMI audio codec callbacks
457  */
msm_hdmi_audio_hw_params(struct device * dev,void * data,struct hdmi_codec_daifmt * daifmt,struct hdmi_codec_params * params)458 static int msm_hdmi_audio_hw_params(struct device *dev, void *data,
459 				    struct hdmi_codec_daifmt *daifmt,
460 				    struct hdmi_codec_params *params)
461 {
462 	struct hdmi *hdmi = dev_get_drvdata(dev);
463 	unsigned int chan;
464 	unsigned int channel_allocation = 0;
465 	unsigned int rate;
466 	unsigned int level_shift  = 0; /* 0dB */
467 	bool down_mix = false;
468 
469 	dev_dbg(dev, "%u Hz, %d bit, %d channels\n", params->sample_rate,
470 		 params->sample_width, params->cea.channels);
471 
472 	switch (params->cea.channels) {
473 	case 2:
474 		/* FR and FL speakers */
475 		channel_allocation  = 0;
476 		chan = MSM_HDMI_AUDIO_CHANNEL_2;
477 		break;
478 	case 4:
479 		/* FC, LFE, FR and FL speakers */
480 		channel_allocation  = 0x3;
481 		chan = MSM_HDMI_AUDIO_CHANNEL_4;
482 		break;
483 	case 6:
484 		/* RR, RL, FC, LFE, FR and FL speakers */
485 		channel_allocation  = 0x0B;
486 		chan = MSM_HDMI_AUDIO_CHANNEL_6;
487 		break;
488 	case 8:
489 		/* FRC, FLC, RR, RL, FC, LFE, FR and FL speakers */
490 		channel_allocation  = 0x1F;
491 		chan = MSM_HDMI_AUDIO_CHANNEL_8;
492 		break;
493 	default:
494 		return -EINVAL;
495 	}
496 
497 	switch (params->sample_rate) {
498 	case 32000:
499 		rate = HDMI_SAMPLE_RATE_32KHZ;
500 		break;
501 	case 44100:
502 		rate = HDMI_SAMPLE_RATE_44_1KHZ;
503 		break;
504 	case 48000:
505 		rate = HDMI_SAMPLE_RATE_48KHZ;
506 		break;
507 	case 88200:
508 		rate = HDMI_SAMPLE_RATE_88_2KHZ;
509 		break;
510 	case 96000:
511 		rate = HDMI_SAMPLE_RATE_96KHZ;
512 		break;
513 	case 176400:
514 		rate = HDMI_SAMPLE_RATE_176_4KHZ;
515 		break;
516 	case 192000:
517 		rate = HDMI_SAMPLE_RATE_192KHZ;
518 		break;
519 	default:
520 		dev_err(dev, "rate[%d] not supported!\n",
521 			params->sample_rate);
522 		return -EINVAL;
523 	}
524 
525 	msm_hdmi_audio_set_sample_rate(hdmi, rate);
526 	msm_hdmi_audio_info_setup(hdmi, 1, chan, channel_allocation,
527 			      level_shift, down_mix);
528 
529 	return 0;
530 }
531 
msm_hdmi_audio_shutdown(struct device * dev,void * data)532 static void msm_hdmi_audio_shutdown(struct device *dev, void *data)
533 {
534 	struct hdmi *hdmi = dev_get_drvdata(dev);
535 
536 	msm_hdmi_audio_info_setup(hdmi, 0, 0, 0, 0, 0);
537 }
538 
539 static const struct hdmi_codec_ops msm_hdmi_audio_codec_ops = {
540 	.hw_params = msm_hdmi_audio_hw_params,
541 	.audio_shutdown = msm_hdmi_audio_shutdown,
542 };
543 
544 static struct hdmi_codec_pdata codec_data = {
545 	.ops = &msm_hdmi_audio_codec_ops,
546 	.max_i2s_channels = 8,
547 	.i2s = 1,
548 };
549 
msm_hdmi_register_audio_driver(struct hdmi * hdmi,struct device * dev)550 static int msm_hdmi_register_audio_driver(struct hdmi *hdmi, struct device *dev)
551 {
552 	hdmi->audio_pdev = platform_device_register_data(dev,
553 							 HDMI_CODEC_DRV_NAME,
554 							 PLATFORM_DEVID_AUTO,
555 							 &codec_data,
556 							 sizeof(codec_data));
557 	return PTR_ERR_OR_ZERO(hdmi->audio_pdev);
558 }
559 
msm_hdmi_bind(struct device * dev,struct device * master,void * data)560 static int msm_hdmi_bind(struct device *dev, struct device *master, void *data)
561 {
562 	struct drm_device *drm = dev_get_drvdata(master);
563 	struct msm_drm_private *priv = drm->dev_private;
564 	static struct hdmi_platform_config *hdmi_cfg;
565 	struct hdmi *hdmi;
566 	struct device_node *of_node = dev->of_node;
567 	int i, err;
568 
569 	hdmi_cfg = (struct hdmi_platform_config *)
570 			of_device_get_match_data(dev);
571 	if (!hdmi_cfg) {
572 		dev_err(dev, "unknown hdmi_cfg: %s\n", of_node->name);
573 		return -ENXIO;
574 	}
575 
576 	hdmi_cfg->mmio_name     = "core_physical";
577 	hdmi_cfg->qfprom_mmio_name = "qfprom_physical";
578 
579 	for (i = 0; i < HDMI_MAX_NUM_GPIO; i++) {
580 		hdmi_cfg->gpios[i].num = msm_hdmi_get_gpio(of_node,
581 						msm_hdmi_gpio_pdata[i].name);
582 		hdmi_cfg->gpios[i].output = msm_hdmi_gpio_pdata[i].output;
583 		hdmi_cfg->gpios[i].value = msm_hdmi_gpio_pdata[i].value;
584 		hdmi_cfg->gpios[i].label = msm_hdmi_gpio_pdata[i].label;
585 	}
586 
587 	dev->platform_data = hdmi_cfg;
588 
589 	hdmi = msm_hdmi_init(to_platform_device(dev));
590 	if (IS_ERR(hdmi))
591 		return PTR_ERR(hdmi);
592 	priv->hdmi = hdmi;
593 
594 	err = msm_hdmi_register_audio_driver(hdmi, dev);
595 	if (err) {
596 		DRM_ERROR("Failed to attach an audio codec %d\n", err);
597 		hdmi->audio_pdev = NULL;
598 	}
599 
600 	return 0;
601 }
602 
msm_hdmi_unbind(struct device * dev,struct device * master,void * data)603 static void msm_hdmi_unbind(struct device *dev, struct device *master,
604 		void *data)
605 {
606 	struct drm_device *drm = dev_get_drvdata(master);
607 	struct msm_drm_private *priv = drm->dev_private;
608 	if (priv->hdmi) {
609 		if (priv->hdmi->audio_pdev)
610 			platform_device_unregister(priv->hdmi->audio_pdev);
611 
612 		msm_hdmi_destroy(priv->hdmi);
613 		priv->hdmi = NULL;
614 	}
615 }
616 
617 static const struct component_ops msm_hdmi_ops = {
618 		.bind   = msm_hdmi_bind,
619 		.unbind = msm_hdmi_unbind,
620 };
621 
msm_hdmi_dev_probe(struct platform_device * pdev)622 static int msm_hdmi_dev_probe(struct platform_device *pdev)
623 {
624 	return component_add(&pdev->dev, &msm_hdmi_ops);
625 }
626 
msm_hdmi_dev_remove(struct platform_device * pdev)627 static int msm_hdmi_dev_remove(struct platform_device *pdev)
628 {
629 	component_del(&pdev->dev, &msm_hdmi_ops);
630 	return 0;
631 }
632 
633 static const struct of_device_id msm_hdmi_dt_match[] = {
634 	{ .compatible = "qcom,hdmi-tx-8996", .data = &hdmi_tx_8996_config },
635 	{ .compatible = "qcom,hdmi-tx-8994", .data = &hdmi_tx_8994_config },
636 	{ .compatible = "qcom,hdmi-tx-8084", .data = &hdmi_tx_8084_config },
637 	{ .compatible = "qcom,hdmi-tx-8974", .data = &hdmi_tx_8974_config },
638 	{ .compatible = "qcom,hdmi-tx-8960", .data = &hdmi_tx_8960_config },
639 	{ .compatible = "qcom,hdmi-tx-8660", .data = &hdmi_tx_8660_config },
640 	{}
641 };
642 
643 static struct platform_driver msm_hdmi_driver = {
644 	.probe = msm_hdmi_dev_probe,
645 	.remove = msm_hdmi_dev_remove,
646 	.driver = {
647 		.name = "hdmi_msm",
648 		.of_match_table = msm_hdmi_dt_match,
649 	},
650 };
651 
msm_hdmi_register(void)652 void __init msm_hdmi_register(void)
653 {
654 	msm_hdmi_phy_driver_register();
655 	platform_driver_register(&msm_hdmi_driver);
656 }
657 
msm_hdmi_unregister(void)658 void __exit msm_hdmi_unregister(void)
659 {
660 	platform_driver_unregister(&msm_hdmi_driver);
661 	msm_hdmi_phy_driver_unregister();
662 }
663