1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
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
25void 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
50static irqreturn_t msm_hdmi_irq(int irq, void *dev_id)
51{
52 struct hdmi *hdmi = dev_id;
53
54
55 msm_hdmi_connector_irq(hdmi->connector);
56
57
58 msm_hdmi_i2c_irq(hdmi->i2c);
59
60
61 if (hdmi->hdcp_ctrl)
62 msm_hdmi_hdcp_irq(hdmi->hdcp_ctrl);
63
64
65
66 return IRQ_HANDLED;
67}
68
69static void msm_hdmi_destroy(struct hdmi *hdmi)
70{
71
72
73
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
93static 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
122
123
124
125static 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
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_kcalloc(&pdev->dev,
161 config->hpd_reg_cnt,
162 sizeof(hdmi->hpd_regs[0]),
163 GFP_KERNEL);
164 if (!hdmi->hpd_regs) {
165 ret = -ENOMEM;
166 goto fail;
167 }
168 for (i = 0; i < config->hpd_reg_cnt; i++) {
169 struct regulator *reg;
170
171 reg = devm_regulator_get(&pdev->dev,
172 config->hpd_reg_names[i]);
173 if (IS_ERR(reg)) {
174 ret = PTR_ERR(reg);
175 dev_err(&pdev->dev, "failed to get hpd regulator: %s (%d)\n",
176 config->hpd_reg_names[i], ret);
177 goto fail;
178 }
179
180 hdmi->hpd_regs[i] = reg;
181 }
182
183 hdmi->pwr_regs = devm_kcalloc(&pdev->dev,
184 config->pwr_reg_cnt,
185 sizeof(hdmi->pwr_regs[0]),
186 GFP_KERNEL);
187 if (!hdmi->pwr_regs) {
188 ret = -ENOMEM;
189 goto fail;
190 }
191 for (i = 0; i < config->pwr_reg_cnt; i++) {
192 struct regulator *reg;
193
194 reg = devm_regulator_get(&pdev->dev,
195 config->pwr_reg_names[i]);
196 if (IS_ERR(reg)) {
197 ret = PTR_ERR(reg);
198 dev_err(&pdev->dev, "failed to get pwr regulator: %s (%d)\n",
199 config->pwr_reg_names[i], ret);
200 goto fail;
201 }
202
203 hdmi->pwr_regs[i] = reg;
204 }
205
206 hdmi->hpd_clks = devm_kcalloc(&pdev->dev,
207 config->hpd_clk_cnt,
208 sizeof(hdmi->hpd_clks[0]),
209 GFP_KERNEL);
210 if (!hdmi->hpd_clks) {
211 ret = -ENOMEM;
212 goto fail;
213 }
214 for (i = 0; i < config->hpd_clk_cnt; i++) {
215 struct clk *clk;
216
217 clk = msm_clk_get(pdev, config->hpd_clk_names[i]);
218 if (IS_ERR(clk)) {
219 ret = PTR_ERR(clk);
220 dev_err(&pdev->dev, "failed to get hpd clk: %s (%d)\n",
221 config->hpd_clk_names[i], ret);
222 goto fail;
223 }
224
225 hdmi->hpd_clks[i] = clk;
226 }
227
228 hdmi->pwr_clks = devm_kcalloc(&pdev->dev,
229 config->pwr_clk_cnt,
230 sizeof(hdmi->pwr_clks[0]),
231 GFP_KERNEL);
232 if (!hdmi->pwr_clks) {
233 ret = -ENOMEM;
234 goto fail;
235 }
236 for (i = 0; i < config->pwr_clk_cnt; i++) {
237 struct clk *clk;
238
239 clk = msm_clk_get(pdev, config->pwr_clk_names[i]);
240 if (IS_ERR(clk)) {
241 ret = PTR_ERR(clk);
242 dev_err(&pdev->dev, "failed to get pwr clk: %s (%d)\n",
243 config->pwr_clk_names[i], ret);
244 goto fail;
245 }
246
247 hdmi->pwr_clks[i] = clk;
248 }
249
250 pm_runtime_enable(&pdev->dev);
251
252 hdmi->workq = alloc_ordered_workqueue("msm_hdmi", 0);
253
254 hdmi->i2c = msm_hdmi_i2c_init(hdmi);
255 if (IS_ERR(hdmi->i2c)) {
256 ret = PTR_ERR(hdmi->i2c);
257 dev_err(&pdev->dev, "failed to get i2c: %d\n", ret);
258 hdmi->i2c = NULL;
259 goto fail;
260 }
261
262 ret = msm_hdmi_get_phy(hdmi);
263 if (ret) {
264 dev_err(&pdev->dev, "failed to get phy\n");
265 goto fail;
266 }
267
268 hdmi->hdcp_ctrl = msm_hdmi_hdcp_init(hdmi);
269 if (IS_ERR(hdmi->hdcp_ctrl)) {
270 dev_warn(&pdev->dev, "failed to init hdcp: disabled\n");
271 hdmi->hdcp_ctrl = NULL;
272 }
273
274 return hdmi;
275
276fail:
277 if (hdmi)
278 msm_hdmi_destroy(hdmi);
279
280 return ERR_PTR(ret);
281}
282
283
284
285
286
287
288
289
290
291int msm_hdmi_modeset_init(struct hdmi *hdmi,
292 struct drm_device *dev, struct drm_encoder *encoder)
293{
294 struct msm_drm_private *priv = dev->dev_private;
295 struct platform_device *pdev = hdmi->pdev;
296 int ret;
297
298 hdmi->dev = dev;
299 hdmi->encoder = encoder;
300
301 hdmi_audio_infoframe_init(&hdmi->audio.infoframe);
302
303 hdmi->bridge = msm_hdmi_bridge_init(hdmi);
304 if (IS_ERR(hdmi->bridge)) {
305 ret = PTR_ERR(hdmi->bridge);
306 dev_err(dev->dev, "failed to create HDMI bridge: %d\n", ret);
307 hdmi->bridge = NULL;
308 goto fail;
309 }
310
311 hdmi->connector = msm_hdmi_connector_init(hdmi);
312 if (IS_ERR(hdmi->connector)) {
313 ret = PTR_ERR(hdmi->connector);
314 dev_err(dev->dev, "failed to create HDMI connector: %d\n", ret);
315 hdmi->connector = NULL;
316 goto fail;
317 }
318
319 hdmi->irq = irq_of_parse_and_map(pdev->dev.of_node, 0);
320 if (hdmi->irq < 0) {
321 ret = hdmi->irq;
322 dev_err(dev->dev, "failed to get irq: %d\n", ret);
323 goto fail;
324 }
325
326 ret = devm_request_irq(&pdev->dev, hdmi->irq,
327 msm_hdmi_irq, IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
328 "hdmi_isr", hdmi);
329 if (ret < 0) {
330 dev_err(dev->dev, "failed to request IRQ%u: %d\n",
331 hdmi->irq, ret);
332 goto fail;
333 }
334
335 encoder->bridge = hdmi->bridge;
336
337 priv->bridges[priv->num_bridges++] = hdmi->bridge;
338 priv->connectors[priv->num_connectors++] = hdmi->connector;
339
340 platform_set_drvdata(pdev, hdmi);
341
342 return 0;
343
344fail:
345
346 if (hdmi->bridge) {
347 msm_hdmi_bridge_destroy(hdmi->bridge);
348 hdmi->bridge = NULL;
349 }
350 if (hdmi->connector) {
351 hdmi->connector->funcs->destroy(hdmi->connector);
352 hdmi->connector = NULL;
353 }
354
355 return ret;
356}
357
358
359
360
361
362#define HDMI_CFG(item, entry) \
363 .item ## _names = item ##_names_ ## entry, \
364 .item ## _cnt = ARRAY_SIZE(item ## _names_ ## entry)
365
366static const char *pwr_reg_names_none[] = {};
367static const char *hpd_reg_names_none[] = {};
368
369static struct hdmi_platform_config hdmi_tx_8660_config;
370
371static const char *hpd_reg_names_8960[] = {"core-vdda", "hdmi-mux"};
372static const char *hpd_clk_names_8960[] = {"core", "master_iface", "slave_iface"};
373
374static struct hdmi_platform_config hdmi_tx_8960_config = {
375 HDMI_CFG(hpd_reg, 8960),
376 HDMI_CFG(hpd_clk, 8960),
377};
378
379static const char *pwr_reg_names_8x74[] = {"core-vdda", "core-vcc"};
380static const char *hpd_reg_names_8x74[] = {"hpd-gdsc", "hpd-5v"};
381static const char *pwr_clk_names_8x74[] = {"extp", "alt_iface"};
382static const char *hpd_clk_names_8x74[] = {"iface", "core", "mdp_core"};
383static unsigned long hpd_clk_freq_8x74[] = {0, 19200000, 0};
384
385static struct hdmi_platform_config hdmi_tx_8974_config = {
386 HDMI_CFG(pwr_reg, 8x74),
387 HDMI_CFG(hpd_reg, 8x74),
388 HDMI_CFG(pwr_clk, 8x74),
389 HDMI_CFG(hpd_clk, 8x74),
390 .hpd_freq = hpd_clk_freq_8x74,
391};
392
393static const char *hpd_reg_names_8084[] = {"hpd-gdsc", "hpd-5v", "hpd-5v-en"};
394
395static struct hdmi_platform_config hdmi_tx_8084_config = {
396 HDMI_CFG(pwr_reg, 8x74),
397 HDMI_CFG(hpd_reg, 8084),
398 HDMI_CFG(pwr_clk, 8x74),
399 HDMI_CFG(hpd_clk, 8x74),
400 .hpd_freq = hpd_clk_freq_8x74,
401};
402
403static struct hdmi_platform_config hdmi_tx_8994_config = {
404 HDMI_CFG(pwr_reg, 8x74),
405 HDMI_CFG(hpd_reg, none),
406 HDMI_CFG(pwr_clk, 8x74),
407 HDMI_CFG(hpd_clk, 8x74),
408 .hpd_freq = hpd_clk_freq_8x74,
409};
410
411static struct hdmi_platform_config hdmi_tx_8996_config = {
412 HDMI_CFG(pwr_reg, none),
413 HDMI_CFG(hpd_reg, none),
414 HDMI_CFG(pwr_clk, 8x74),
415 HDMI_CFG(hpd_clk, 8x74),
416 .hpd_freq = hpd_clk_freq_8x74,
417};
418
419static const struct {
420 const char *name;
421 const bool output;
422 const int value;
423 const char *label;
424} msm_hdmi_gpio_pdata[] = {
425 { "qcom,hdmi-tx-ddc-clk", true, 1, "HDMI_DDC_CLK" },
426 { "qcom,hdmi-tx-ddc-data", true, 1, "HDMI_DDC_DATA" },
427 { "qcom,hdmi-tx-hpd", false, 1, "HDMI_HPD" },
428 { "qcom,hdmi-tx-mux-en", true, 1, "HDMI_MUX_EN" },
429 { "qcom,hdmi-tx-mux-sel", true, 0, "HDMI_MUX_SEL" },
430 { "qcom,hdmi-tx-mux-lpm", true, 1, "HDMI_MUX_LPM" },
431};
432
433static int msm_hdmi_get_gpio(struct device_node *of_node, const char *name)
434{
435 int gpio;
436
437
438 gpio = of_get_named_gpio(of_node, name, 0);
439 if (gpio < 0) {
440 char name2[32];
441
442
443 snprintf(name2, sizeof(name2), "%s-gpios", name);
444 gpio = of_get_named_gpio(of_node, name2, 0);
445 if (gpio < 0) {
446 char name3[32];
447
448
449
450
451
452
453 if (sscanf(name2, "qcom,hdmi-tx-%s", name3))
454 gpio = of_get_named_gpio(of_node, name3, 0);
455 }
456
457 if (gpio < 0) {
458 DBG("failed to get gpio: %s (%d)", name, gpio);
459 gpio = -1;
460 }
461 }
462 return gpio;
463}
464
465
466
467
468static int msm_hdmi_audio_hw_params(struct device *dev, void *data,
469 struct hdmi_codec_daifmt *daifmt,
470 struct hdmi_codec_params *params)
471{
472 struct hdmi *hdmi = dev_get_drvdata(dev);
473 unsigned int chan;
474 unsigned int channel_allocation = 0;
475 unsigned int rate;
476 unsigned int level_shift = 0;
477 bool down_mix = false;
478
479 dev_dbg(dev, "%u Hz, %d bit, %d channels\n", params->sample_rate,
480 params->sample_width, params->cea.channels);
481
482 switch (params->cea.channels) {
483 case 2:
484
485 channel_allocation = 0;
486 chan = MSM_HDMI_AUDIO_CHANNEL_2;
487 break;
488 case 4:
489
490 channel_allocation = 0x3;
491 chan = MSM_HDMI_AUDIO_CHANNEL_4;
492 break;
493 case 6:
494
495 channel_allocation = 0x0B;
496 chan = MSM_HDMI_AUDIO_CHANNEL_6;
497 break;
498 case 8:
499
500 channel_allocation = 0x1F;
501 chan = MSM_HDMI_AUDIO_CHANNEL_8;
502 break;
503 default:
504 return -EINVAL;
505 }
506
507 switch (params->sample_rate) {
508 case 32000:
509 rate = HDMI_SAMPLE_RATE_32KHZ;
510 break;
511 case 44100:
512 rate = HDMI_SAMPLE_RATE_44_1KHZ;
513 break;
514 case 48000:
515 rate = HDMI_SAMPLE_RATE_48KHZ;
516 break;
517 case 88200:
518 rate = HDMI_SAMPLE_RATE_88_2KHZ;
519 break;
520 case 96000:
521 rate = HDMI_SAMPLE_RATE_96KHZ;
522 break;
523 case 176400:
524 rate = HDMI_SAMPLE_RATE_176_4KHZ;
525 break;
526 case 192000:
527 rate = HDMI_SAMPLE_RATE_192KHZ;
528 break;
529 default:
530 dev_err(dev, "rate[%d] not supported!\n",
531 params->sample_rate);
532 return -EINVAL;
533 }
534
535 msm_hdmi_audio_set_sample_rate(hdmi, rate);
536 msm_hdmi_audio_info_setup(hdmi, 1, chan, channel_allocation,
537 level_shift, down_mix);
538
539 return 0;
540}
541
542static void msm_hdmi_audio_shutdown(struct device *dev, void *data)
543{
544 struct hdmi *hdmi = dev_get_drvdata(dev);
545
546 msm_hdmi_audio_info_setup(hdmi, 0, 0, 0, 0, 0);
547}
548
549static const struct hdmi_codec_ops msm_hdmi_audio_codec_ops = {
550 .hw_params = msm_hdmi_audio_hw_params,
551 .audio_shutdown = msm_hdmi_audio_shutdown,
552};
553
554static struct hdmi_codec_pdata codec_data = {
555 .ops = &msm_hdmi_audio_codec_ops,
556 .max_i2s_channels = 8,
557 .i2s = 1,
558};
559
560static int msm_hdmi_register_audio_driver(struct hdmi *hdmi, struct device *dev)
561{
562 hdmi->audio_pdev = platform_device_register_data(dev,
563 HDMI_CODEC_DRV_NAME,
564 PLATFORM_DEVID_AUTO,
565 &codec_data,
566 sizeof(codec_data));
567 return PTR_ERR_OR_ZERO(hdmi->audio_pdev);
568}
569
570static int msm_hdmi_bind(struct device *dev, struct device *master, void *data)
571{
572 struct drm_device *drm = dev_get_drvdata(master);
573 struct msm_drm_private *priv = drm->dev_private;
574 static struct hdmi_platform_config *hdmi_cfg;
575 struct hdmi *hdmi;
576 struct device_node *of_node = dev->of_node;
577 int i, err;
578
579 hdmi_cfg = (struct hdmi_platform_config *)
580 of_device_get_match_data(dev);
581 if (!hdmi_cfg) {
582 dev_err(dev, "unknown hdmi_cfg: %s\n", of_node->name);
583 return -ENXIO;
584 }
585
586 hdmi_cfg->mmio_name = "core_physical";
587 hdmi_cfg->qfprom_mmio_name = "qfprom_physical";
588
589 for (i = 0; i < HDMI_MAX_NUM_GPIO; i++) {
590 hdmi_cfg->gpios[i].num = msm_hdmi_get_gpio(of_node,
591 msm_hdmi_gpio_pdata[i].name);
592 hdmi_cfg->gpios[i].output = msm_hdmi_gpio_pdata[i].output;
593 hdmi_cfg->gpios[i].value = msm_hdmi_gpio_pdata[i].value;
594 hdmi_cfg->gpios[i].label = msm_hdmi_gpio_pdata[i].label;
595 }
596
597 dev->platform_data = hdmi_cfg;
598
599 hdmi = msm_hdmi_init(to_platform_device(dev));
600 if (IS_ERR(hdmi))
601 return PTR_ERR(hdmi);
602 priv->hdmi = hdmi;
603
604 err = msm_hdmi_register_audio_driver(hdmi, dev);
605 if (err) {
606 DRM_ERROR("Failed to attach an audio codec %d\n", err);
607 hdmi->audio_pdev = NULL;
608 }
609
610 return 0;
611}
612
613static void msm_hdmi_unbind(struct device *dev, struct device *master,
614 void *data)
615{
616 struct drm_device *drm = dev_get_drvdata(master);
617 struct msm_drm_private *priv = drm->dev_private;
618 if (priv->hdmi) {
619 if (priv->hdmi->audio_pdev)
620 platform_device_unregister(priv->hdmi->audio_pdev);
621
622 msm_hdmi_destroy(priv->hdmi);
623 priv->hdmi = NULL;
624 }
625}
626
627static const struct component_ops msm_hdmi_ops = {
628 .bind = msm_hdmi_bind,
629 .unbind = msm_hdmi_unbind,
630};
631
632static int msm_hdmi_dev_probe(struct platform_device *pdev)
633{
634 return component_add(&pdev->dev, &msm_hdmi_ops);
635}
636
637static int msm_hdmi_dev_remove(struct platform_device *pdev)
638{
639 component_del(&pdev->dev, &msm_hdmi_ops);
640 return 0;
641}
642
643static const struct of_device_id msm_hdmi_dt_match[] = {
644 { .compatible = "qcom,hdmi-tx-8996", .data = &hdmi_tx_8996_config },
645 { .compatible = "qcom,hdmi-tx-8994", .data = &hdmi_tx_8994_config },
646 { .compatible = "qcom,hdmi-tx-8084", .data = &hdmi_tx_8084_config },
647 { .compatible = "qcom,hdmi-tx-8974", .data = &hdmi_tx_8974_config },
648 { .compatible = "qcom,hdmi-tx-8960", .data = &hdmi_tx_8960_config },
649 { .compatible = "qcom,hdmi-tx-8660", .data = &hdmi_tx_8660_config },
650 {}
651};
652
653static struct platform_driver msm_hdmi_driver = {
654 .probe = msm_hdmi_dev_probe,
655 .remove = msm_hdmi_dev_remove,
656 .driver = {
657 .name = "hdmi_msm",
658 .of_match_table = msm_hdmi_dt_match,
659 },
660};
661
662void __init msm_hdmi_register(void)
663{
664 msm_hdmi_phy_driver_register();
665 platform_driver_register(&msm_hdmi_driver);
666}
667
668void __exit msm_hdmi_unregister(void)
669{
670 platform_driver_unregister(&msm_hdmi_driver);
671 msm_hdmi_phy_driver_unregister();
672}
673
