4 * HDMI interface DSS driver setting for TI's OMAP4 family of processor.
5 * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
7 * Mythri pk <mythripk@ti.com>
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License version 2 as published by
11 * the Free Software Foundation.
13 * This program is distributed in the hope that it will be useful, but WITHOUT
14 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
15 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
18 * You should have received a copy of the GNU General Public License along with
19 * this program. If not, see <http://www.gnu.org/licenses/>.
22 #define DSS_SUBSYS_NAME "HDMI"
24 #include <linux/kernel.h>
25 #include <linux/module.h>
26 #include <linux/err.h>
28 #include <linux/interrupt.h>
29 #include <linux/mutex.h>
30 #include <linux/delay.h>
31 #include <linux/string.h>
32 #include <linux/platform_device.h>
33 #include <linux/pm_runtime.h>
34 #include <linux/clk.h>
35 #include <linux/gpio.h>
36 #include <linux/regulator/consumer.h>
37 #include <video/omapdss.h>
41 #include "dss_features.h"
44 #define HDMI_CORE_SYS 0x400
45 #define HDMI_CORE_AV 0x900
46 #define HDMI_PLLCTRL 0x200
47 #define HDMI_PHY 0x300
49 /* HDMI EDID Length move this */
50 #define HDMI_EDID_MAX_LENGTH 256
51 #define EDID_TIMING_DESCRIPTOR_SIZE 0x12
52 #define EDID_DESCRIPTOR_BLOCK0_ADDRESS 0x36
53 #define EDID_DESCRIPTOR_BLOCK1_ADDRESS 0x80
54 #define EDID_SIZE_BLOCK0_TIMING_DESCRIPTOR 4
55 #define EDID_SIZE_BLOCK1_TIMING_DESCRIPTOR 4
57 #define HDMI_DEFAULT_REGN 16
58 #define HDMI_DEFAULT_REGM2 1
62 struct platform_device *pdev;
64 struct hdmi_ip_data ip_data;
67 struct regulator *vdda_hdmi_dac_reg;
73 struct omap_dss_output output;
77 * Logic for the below structure :
78 * user enters the CEA or VESA timings by specifying the HDMI/DVI code.
79 * There is a correspondence between CEA/VESA timing and code, please
80 * refer to section 6.3 in HDMI 1.3 specification for timing code.
82 * In the below structure, cea_vesa_timings corresponds to all OMAP4
83 * supported CEA and VESA timing values.code_cea corresponds to the CEA
84 * code, It is used to get the timing from cea_vesa_timing array.Similarly
85 * with code_vesa. Code_index is used for back mapping, that is once EDID
86 * is read from the TV, EDID is parsed to find the timing values and then
87 * map it to corresponding CEA or VESA index.
90 static const struct hdmi_config cea_timings[] = {
92 { 640, 480, 25200, 96, 16, 48, 2, 10, 33,
93 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
98 { 720, 480, 27027, 62, 16, 60, 6, 9, 30,
99 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
104 { 1280, 720, 74250, 40, 110, 220, 5, 5, 20,
105 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
110 { 1920, 540, 74250, 44, 88, 148, 5, 2, 15,
111 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
116 { 1440, 240, 27027, 124, 38, 114, 3, 4, 15,
117 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
122 { 1920, 1080, 148500, 44, 88, 148, 5, 4, 36,
123 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
128 { 720, 576, 27000, 64, 12, 68, 5, 5, 39,
129 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
134 { 1280, 720, 74250, 40, 440, 220, 5, 5, 20,
135 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
140 { 1920, 540, 74250, 44, 528, 148, 5, 2, 15,
141 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
146 { 1440, 288, 27000, 126, 24, 138, 3, 2, 19,
147 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
152 { 1440, 576, 54000, 128, 24, 136, 5, 5, 39,
153 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
158 { 1920, 1080, 148500, 44, 528, 148, 5, 4, 36,
159 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
164 { 1920, 1080, 74250, 44, 638, 148, 5, 4, 36,
165 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
170 { 2880, 480, 108108, 248, 64, 240, 6, 9, 30,
171 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
176 { 2880, 576, 108000, 256, 48, 272, 5, 5, 39,
177 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
183 static const struct hdmi_config vesa_timings[] = {
186 { 640, 480, 25175, 96, 16, 48, 2, 11, 31,
187 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
192 { 800, 600, 40000, 128, 40, 88, 4, 1, 23,
193 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
198 { 848, 480, 33750, 112, 16, 112, 8, 6, 23,
199 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
204 { 1280, 768, 79500, 128, 64, 192, 7, 3, 20,
205 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
210 { 1280, 800, 83500, 128, 72, 200, 6, 3, 22,
211 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
216 { 1360, 768, 85500, 112, 64, 256, 6, 3, 18,
217 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
222 { 1280, 960, 108000, 112, 96, 312, 3, 1, 36,
223 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
228 { 1280, 1024, 108000, 112, 48, 248, 3, 1, 38,
229 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
234 { 1024, 768, 65000, 136, 24, 160, 6, 3, 29,
235 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
240 { 1400, 1050, 121750, 144, 88, 232, 4, 3, 32,
241 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
246 { 1440, 900, 106500, 152, 80, 232, 6, 3, 25,
247 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
252 { 1680, 1050, 146250, 176 , 104, 280, 6, 3, 30,
253 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
258 { 1366, 768, 85500, 143, 70, 213, 3, 3, 24,
259 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
264 { 1920, 1080, 148500, 44, 148, 80, 5, 4, 36,
265 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
270 { 1280, 768, 68250, 32, 48, 80, 7, 3, 12,
271 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
276 { 1400, 1050, 101000, 32, 48, 80, 4, 3, 23,
277 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
282 { 1680, 1050, 119000, 32, 48, 80, 6, 3, 21,
283 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
288 { 1280, 800, 79500, 32, 48, 80, 6, 3, 14,
289 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
294 { 1280, 720, 74250, 40, 110, 220, 5, 5, 20,
295 OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
300 { 1920, 1200, 154000, 32, 48, 80, 6, 3, 26,
301 OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
307 static int hdmi_runtime_get(void)
311 DSSDBG("hdmi_runtime_get\n");
313 r = pm_runtime_get_sync(&hdmi.pdev->dev);
321 static void hdmi_runtime_put(void)
325 DSSDBG("hdmi_runtime_put\n");
327 r = pm_runtime_put_sync(&hdmi.pdev->dev);
328 WARN_ON(r < 0 && r != -ENOSYS);
331 static int hdmi_init_display(struct omap_dss_device *dssdev)
335 struct gpio gpios[] = {
336 { hdmi.ct_cp_hpd_gpio, GPIOF_OUT_INIT_LOW, "hdmi_ct_cp_hpd" },
337 { hdmi.ls_oe_gpio, GPIOF_OUT_INIT_LOW, "hdmi_ls_oe" },
338 { hdmi.hpd_gpio, GPIOF_DIR_IN, "hdmi_hpd" },
341 DSSDBG("init_display\n");
343 dss_init_hdmi_ip_ops(&hdmi.ip_data, omapdss_get_version());
345 if (hdmi.vdda_hdmi_dac_reg == NULL) {
346 struct regulator *reg;
348 reg = devm_regulator_get(&hdmi.pdev->dev, "vdda_hdmi_dac");
350 /* DT HACK: try VDAC to make omapdss work for o4 sdp/panda */
352 reg = devm_regulator_get(&hdmi.pdev->dev, "VDAC");
355 DSSERR("can't get VDDA_HDMI_DAC regulator\n");
359 hdmi.vdda_hdmi_dac_reg = reg;
362 r = gpio_request_array(gpios, ARRAY_SIZE(gpios));
369 static void hdmi_uninit_display(struct omap_dss_device *dssdev)
371 DSSDBG("uninit_display\n");
373 gpio_free(hdmi.ct_cp_hpd_gpio);
374 gpio_free(hdmi.ls_oe_gpio);
375 gpio_free(hdmi.hpd_gpio);
378 static const struct hdmi_config *hdmi_find_timing(
379 const struct hdmi_config *timings_arr,
384 for (i = 0; i < len; i++) {
385 if (timings_arr[i].cm.code == hdmi.ip_data.cfg.cm.code)
386 return &timings_arr[i];
391 static const struct hdmi_config *hdmi_get_timings(void)
393 const struct hdmi_config *arr;
396 if (hdmi.ip_data.cfg.cm.mode == HDMI_DVI) {
398 len = ARRAY_SIZE(vesa_timings);
401 len = ARRAY_SIZE(cea_timings);
404 return hdmi_find_timing(arr, len);
407 static bool hdmi_timings_compare(struct omap_video_timings *timing1,
408 const struct omap_video_timings *timing2)
410 int timing1_vsync, timing1_hsync, timing2_vsync, timing2_hsync;
412 if ((DIV_ROUND_CLOSEST(timing2->pixel_clock, 1000) ==
413 DIV_ROUND_CLOSEST(timing1->pixel_clock, 1000)) &&
414 (timing2->x_res == timing1->x_res) &&
415 (timing2->y_res == timing1->y_res)) {
417 timing2_hsync = timing2->hfp + timing2->hsw + timing2->hbp;
418 timing1_hsync = timing1->hfp + timing1->hsw + timing1->hbp;
419 timing2_vsync = timing2->vfp + timing2->vsw + timing2->vbp;
420 timing1_vsync = timing2->vfp + timing2->vsw + timing2->vbp;
422 DSSDBG("timing1_hsync = %d timing1_vsync = %d"\
423 "timing2_hsync = %d timing2_vsync = %d\n",
424 timing1_hsync, timing1_vsync,
425 timing2_hsync, timing2_vsync);
427 if ((timing1_hsync == timing2_hsync) &&
428 (timing1_vsync == timing2_vsync)) {
435 static struct hdmi_cm hdmi_get_code(struct omap_video_timings *timing)
438 struct hdmi_cm cm = {-1};
439 DSSDBG("hdmi_get_code\n");
441 for (i = 0; i < ARRAY_SIZE(cea_timings); i++) {
442 if (hdmi_timings_compare(timing, &cea_timings[i].timings)) {
443 cm = cea_timings[i].cm;
447 for (i = 0; i < ARRAY_SIZE(vesa_timings); i++) {
448 if (hdmi_timings_compare(timing, &vesa_timings[i].timings)) {
449 cm = vesa_timings[i].cm;
458 unsigned long hdmi_get_pixel_clock(void)
460 /* HDMI Pixel Clock in Mhz */
461 return hdmi.ip_data.cfg.timings.pixel_clock * 1000;
464 static void hdmi_compute_pll(struct omap_dss_device *dssdev, int phy,
465 struct hdmi_pll_info *pi)
467 unsigned long clkin, refclk;
470 clkin = clk_get_rate(hdmi.sys_clk) / 10000;
472 * Input clock is predivided by N + 1
473 * out put of which is reference clk
476 pi->regn = HDMI_DEFAULT_REGN;
478 refclk = clkin / pi->regn;
480 pi->regm2 = HDMI_DEFAULT_REGM2;
483 * multiplier is pixel_clk/ref_clk
484 * Multiplying by 100 to avoid fractional part removal
486 pi->regm = phy * pi->regm2 / refclk;
489 * fractional multiplier is remainder of the difference between
490 * multiplier and actual phy(required pixel clock thus should be
491 * multiplied by 2^18(262144) divided by the reference clock
493 mf = (phy - pi->regm / pi->regm2 * refclk) * 262144;
494 pi->regmf = pi->regm2 * mf / refclk;
497 * Dcofreq should be set to 1 if required pixel clock
498 * is greater than 1000MHz
500 pi->dcofreq = phy > 1000 * 100;
501 pi->regsd = ((pi->regm * clkin / 10) / (pi->regn * 250) + 5) / 10;
503 /* Set the reference clock to sysclk reference */
504 pi->refsel = HDMI_REFSEL_SYSCLK;
506 DSSDBG("M = %d Mf = %d\n", pi->regm, pi->regmf);
507 DSSDBG("range = %d sd = %d\n", pi->dcofreq, pi->regsd);
510 static int hdmi_power_on_core(struct omap_dss_device *dssdev)
514 gpio_set_value(hdmi.ct_cp_hpd_gpio, 1);
515 gpio_set_value(hdmi.ls_oe_gpio, 1);
517 /* wait 300us after CT_CP_HPD for the 5V power output to reach 90% */
520 r = regulator_enable(hdmi.vdda_hdmi_dac_reg);
522 goto err_vdac_enable;
524 r = hdmi_runtime_get();
526 goto err_runtime_get;
528 /* Make selection of HDMI in DSS */
529 dss_select_hdmi_venc_clk_source(DSS_HDMI_M_PCLK);
534 regulator_disable(hdmi.vdda_hdmi_dac_reg);
536 gpio_set_value(hdmi.ct_cp_hpd_gpio, 0);
537 gpio_set_value(hdmi.ls_oe_gpio, 0);
541 static void hdmi_power_off_core(struct omap_dss_device *dssdev)
544 regulator_disable(hdmi.vdda_hdmi_dac_reg);
545 gpio_set_value(hdmi.ct_cp_hpd_gpio, 0);
546 gpio_set_value(hdmi.ls_oe_gpio, 0);
549 static int hdmi_power_on_full(struct omap_dss_device *dssdev)
552 struct omap_video_timings *p;
553 struct omap_overlay_manager *mgr = dssdev->output->manager;
556 r = hdmi_power_on_core(dssdev);
560 dss_mgr_disable(mgr);
562 p = &hdmi.ip_data.cfg.timings;
564 DSSDBG("hdmi_power_on x_res= %d y_res = %d\n", p->x_res, p->y_res);
566 phy = p->pixel_clock;
568 hdmi_compute_pll(dssdev, phy, &hdmi.ip_data.pll_data);
570 hdmi.ip_data.ops->video_disable(&hdmi.ip_data);
572 /* config the PLL and PHY hdmi_set_pll_pwrfirst */
573 r = hdmi.ip_data.ops->pll_enable(&hdmi.ip_data);
575 DSSDBG("Failed to lock PLL\n");
579 r = hdmi.ip_data.ops->phy_enable(&hdmi.ip_data);
581 DSSDBG("Failed to start PHY\n");
585 hdmi.ip_data.ops->video_configure(&hdmi.ip_data);
587 /* bypass TV gamma table */
588 dispc_enable_gamma_table(0);
591 dss_mgr_set_timings(mgr, p);
593 r = hdmi.ip_data.ops->video_enable(&hdmi.ip_data);
597 r = dss_mgr_enable(mgr);
604 hdmi.ip_data.ops->video_disable(&hdmi.ip_data);
606 hdmi.ip_data.ops->phy_disable(&hdmi.ip_data);
608 hdmi.ip_data.ops->pll_disable(&hdmi.ip_data);
610 hdmi_power_off_core(dssdev);
614 static void hdmi_power_off_full(struct omap_dss_device *dssdev)
616 struct omap_overlay_manager *mgr = dssdev->output->manager;
618 dss_mgr_disable(mgr);
620 hdmi.ip_data.ops->video_disable(&hdmi.ip_data);
621 hdmi.ip_data.ops->phy_disable(&hdmi.ip_data);
622 hdmi.ip_data.ops->pll_disable(&hdmi.ip_data);
624 hdmi_power_off_core(dssdev);
627 int omapdss_hdmi_display_check_timing(struct omap_dss_device *dssdev,
628 struct omap_video_timings *timings)
632 cm = hdmi_get_code(timings);
641 void omapdss_hdmi_display_set_timing(struct omap_dss_device *dssdev,
642 struct omap_video_timings *timings)
645 const struct hdmi_config *t;
647 mutex_lock(&hdmi.lock);
649 cm = hdmi_get_code(timings);
650 hdmi.ip_data.cfg.cm = cm;
652 t = hdmi_get_timings();
654 hdmi.ip_data.cfg = *t;
656 mutex_unlock(&hdmi.lock);
659 static void hdmi_dump_regs(struct seq_file *s)
661 mutex_lock(&hdmi.lock);
663 if (hdmi_runtime_get()) {
664 mutex_unlock(&hdmi.lock);
668 hdmi.ip_data.ops->dump_wrapper(&hdmi.ip_data, s);
669 hdmi.ip_data.ops->dump_pll(&hdmi.ip_data, s);
670 hdmi.ip_data.ops->dump_phy(&hdmi.ip_data, s);
671 hdmi.ip_data.ops->dump_core(&hdmi.ip_data, s);
674 mutex_unlock(&hdmi.lock);
677 int omapdss_hdmi_read_edid(u8 *buf, int len)
681 mutex_lock(&hdmi.lock);
683 r = hdmi_runtime_get();
686 r = hdmi.ip_data.ops->read_edid(&hdmi.ip_data, buf, len);
689 mutex_unlock(&hdmi.lock);
694 bool omapdss_hdmi_detect(void)
698 mutex_lock(&hdmi.lock);
700 r = hdmi_runtime_get();
703 r = hdmi.ip_data.ops->detect(&hdmi.ip_data);
706 mutex_unlock(&hdmi.lock);
711 int omapdss_hdmi_display_enable(struct omap_dss_device *dssdev)
713 struct omap_dss_output *out = dssdev->output;
716 DSSDBG("ENTER hdmi_display_enable\n");
718 mutex_lock(&hdmi.lock);
720 if (out == NULL || out->manager == NULL) {
721 DSSERR("failed to enable display: no output/manager\n");
726 hdmi.ip_data.hpd_gpio = hdmi.hpd_gpio;
728 r = omap_dss_start_device(dssdev);
730 DSSERR("failed to start device\n");
734 r = hdmi_power_on_full(dssdev);
736 DSSERR("failed to power on device\n");
740 mutex_unlock(&hdmi.lock);
744 omap_dss_stop_device(dssdev);
746 mutex_unlock(&hdmi.lock);
750 void omapdss_hdmi_display_disable(struct omap_dss_device *dssdev)
752 DSSDBG("Enter hdmi_display_disable\n");
754 mutex_lock(&hdmi.lock);
756 hdmi_power_off_full(dssdev);
758 omap_dss_stop_device(dssdev);
760 mutex_unlock(&hdmi.lock);
763 int omapdss_hdmi_core_enable(struct omap_dss_device *dssdev)
767 DSSDBG("ENTER omapdss_hdmi_core_enable\n");
769 mutex_lock(&hdmi.lock);
771 hdmi.ip_data.hpd_gpio = hdmi.hpd_gpio;
773 r = hdmi_power_on_core(dssdev);
775 DSSERR("failed to power on device\n");
779 mutex_unlock(&hdmi.lock);
783 mutex_unlock(&hdmi.lock);
787 void omapdss_hdmi_core_disable(struct omap_dss_device *dssdev)
789 DSSDBG("Enter omapdss_hdmi_core_disable\n");
791 mutex_lock(&hdmi.lock);
793 hdmi_power_off_core(dssdev);
795 mutex_unlock(&hdmi.lock);
798 static int hdmi_get_clocks(struct platform_device *pdev)
802 clk = devm_clk_get(&pdev->dev, "sys_clk");
804 DSSERR("can't get sys_clk\n");
813 #if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
814 int hdmi_compute_acr(u32 sample_freq, u32 *n, u32 *cts)
817 bool deep_color_correct = false;
818 u32 pclk = hdmi.ip_data.cfg.timings.pixel_clock;
820 if (n == NULL || cts == NULL)
823 /* TODO: When implemented, query deep color mode here. */
827 * When using deep color, the default N value (as in the HDMI
828 * specification) yields to an non-integer CTS. Hence, we
829 * modify it while keeping the restrictions described in
830 * section 7.2.1 of the HDMI 1.4a specification.
832 switch (sample_freq) {
837 if (deep_color == 125)
838 if (pclk == 27027 || pclk == 74250)
839 deep_color_correct = true;
840 if (deep_color == 150)
842 deep_color_correct = true;
847 if (deep_color == 125)
849 deep_color_correct = true;
855 if (deep_color_correct) {
856 switch (sample_freq) {
882 switch (sample_freq) {
908 /* Calculate CTS. See HDMI 1.3a or 1.4a specifications */
909 *cts = pclk * (*n / 128) * deep_color / (sample_freq / 10);
914 int hdmi_audio_enable(void)
916 DSSDBG("audio_enable\n");
918 return hdmi.ip_data.ops->audio_enable(&hdmi.ip_data);
921 void hdmi_audio_disable(void)
923 DSSDBG("audio_disable\n");
925 hdmi.ip_data.ops->audio_disable(&hdmi.ip_data);
928 int hdmi_audio_start(void)
930 DSSDBG("audio_start\n");
932 return hdmi.ip_data.ops->audio_start(&hdmi.ip_data);
935 void hdmi_audio_stop(void)
937 DSSDBG("audio_stop\n");
939 hdmi.ip_data.ops->audio_stop(&hdmi.ip_data);
942 bool hdmi_mode_has_audio(void)
944 if (hdmi.ip_data.cfg.cm.mode == HDMI_HDMI)
950 int hdmi_audio_config(struct omap_dss_audio *audio)
952 return hdmi.ip_data.ops->audio_config(&hdmi.ip_data, audio);
957 static struct omap_dss_device *hdmi_find_dssdev(struct platform_device *pdev)
959 struct omap_dss_board_info *pdata = pdev->dev.platform_data;
960 const char *def_disp_name = omapdss_get_default_display_name();
961 struct omap_dss_device *def_dssdev;
966 for (i = 0; i < pdata->num_devices; ++i) {
967 struct omap_dss_device *dssdev = pdata->devices[i];
969 if (dssdev->type != OMAP_DISPLAY_TYPE_HDMI)
972 if (def_dssdev == NULL)
975 if (def_disp_name != NULL &&
976 strcmp(dssdev->name, def_disp_name) == 0) {
985 static int hdmi_probe_pdata(struct platform_device *pdev)
987 struct omap_dss_device *plat_dssdev;
988 struct omap_dss_device *dssdev;
989 struct omap_dss_hdmi_data *priv;
992 plat_dssdev = hdmi_find_dssdev(pdev);
997 dssdev = dss_alloc_and_init_device(&pdev->dev);
1001 dss_copy_device_pdata(dssdev, plat_dssdev);
1003 priv = dssdev->data;
1005 hdmi.ct_cp_hpd_gpio = priv->ct_cp_hpd_gpio;
1006 hdmi.ls_oe_gpio = priv->ls_oe_gpio;
1007 hdmi.hpd_gpio = priv->hpd_gpio;
1009 r = hdmi_init_display(dssdev);
1011 DSSERR("device %s init failed: %d\n", dssdev->name, r);
1012 dss_put_device(dssdev);
1016 r = omapdss_output_set_device(&hdmi.output, dssdev);
1018 DSSERR("failed to connect output to new device: %s\n",
1020 dss_put_device(dssdev);
1024 r = dss_add_device(dssdev);
1026 DSSERR("device %s register failed: %d\n", dssdev->name, r);
1027 omapdss_output_unset_device(&hdmi.output);
1028 hdmi_uninit_display(dssdev);
1029 dss_put_device(dssdev);
1036 static void hdmi_init_output(struct platform_device *pdev)
1038 struct omap_dss_output *out = &hdmi.output;
1041 out->id = OMAP_DSS_OUTPUT_HDMI;
1042 out->type = OMAP_DISPLAY_TYPE_HDMI;
1043 out->name = "hdmi.0";
1044 out->dispc_channel = OMAP_DSS_CHANNEL_DIGIT;
1046 dss_register_output(out);
1049 static void __exit hdmi_uninit_output(struct platform_device *pdev)
1051 struct omap_dss_output *out = &hdmi.output;
1053 dss_unregister_output(out);
1056 /* HDMI HW IP initialisation */
1057 static int omapdss_hdmihw_probe(struct platform_device *pdev)
1059 struct resource *res;
1064 mutex_init(&hdmi.lock);
1065 mutex_init(&hdmi.ip_data.lock);
1067 res = platform_get_resource(hdmi.pdev, IORESOURCE_MEM, 0);
1069 DSSERR("can't get IORESOURCE_MEM HDMI\n");
1073 /* Base address taken from platform */
1074 hdmi.ip_data.base_wp = devm_ioremap_resource(&pdev->dev, res);
1075 if (IS_ERR(hdmi.ip_data.base_wp))
1076 return PTR_ERR(hdmi.ip_data.base_wp);
1078 r = hdmi_get_clocks(pdev);
1080 DSSERR("can't get clocks\n");
1084 pm_runtime_enable(&pdev->dev);
1086 hdmi.ip_data.core_sys_offset = HDMI_CORE_SYS;
1087 hdmi.ip_data.core_av_offset = HDMI_CORE_AV;
1088 hdmi.ip_data.pll_offset = HDMI_PLLCTRL;
1089 hdmi.ip_data.phy_offset = HDMI_PHY;
1091 hdmi_init_output(pdev);
1093 r = hdmi_panel_init();
1095 DSSERR("can't init panel\n");
1099 dss_debugfs_create_file("hdmi", hdmi_dump_regs);
1101 r = hdmi_probe_pdata(pdev);
1104 hdmi_uninit_output(pdev);
1105 pm_runtime_disable(&pdev->dev);
1112 static int __exit hdmi_remove_child(struct device *dev, void *data)
1114 struct omap_dss_device *dssdev = to_dss_device(dev);
1115 hdmi_uninit_display(dssdev);
1119 static int __exit omapdss_hdmihw_remove(struct platform_device *pdev)
1121 device_for_each_child(&pdev->dev, NULL, hdmi_remove_child);
1123 dss_unregister_child_devices(&pdev->dev);
1127 hdmi_uninit_output(pdev);
1129 pm_runtime_disable(&pdev->dev);
1134 static int hdmi_runtime_suspend(struct device *dev)
1136 clk_disable_unprepare(hdmi.sys_clk);
1138 dispc_runtime_put();
1143 static int hdmi_runtime_resume(struct device *dev)
1147 r = dispc_runtime_get();
1151 clk_prepare_enable(hdmi.sys_clk);
1156 static const struct dev_pm_ops hdmi_pm_ops = {
1157 .runtime_suspend = hdmi_runtime_suspend,
1158 .runtime_resume = hdmi_runtime_resume,
1161 static struct platform_driver omapdss_hdmihw_driver = {
1162 .probe = omapdss_hdmihw_probe,
1163 .remove = __exit_p(omapdss_hdmihw_remove),
1165 .name = "omapdss_hdmi",
1166 .owner = THIS_MODULE,
1171 int __init hdmi_init_platform_driver(void)
1173 return platform_driver_register(&omapdss_hdmihw_driver);
1176 void __exit hdmi_uninit_platform_driver(void)
1178 platform_driver_unregister(&omapdss_hdmihw_driver);