19960aa7cSTomi Valkeinen /* 29960aa7cSTomi Valkeinen * HDMI interface DSS driver for TI's OMAP4 family of SoCs. 3bb5cdf8dSAndrew F. Davis * 49960aa7cSTomi Valkeinen * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/ 59960aa7cSTomi Valkeinen * Authors: Yong Zhi 69960aa7cSTomi Valkeinen * Mythri pk <mythripk@ti.com> 79960aa7cSTomi Valkeinen * 89960aa7cSTomi Valkeinen * This program is free software; you can redistribute it and/or modify it 99960aa7cSTomi Valkeinen * under the terms of the GNU General Public License version 2 as published by 109960aa7cSTomi Valkeinen * the Free Software Foundation. 119960aa7cSTomi Valkeinen * 129960aa7cSTomi Valkeinen * This program is distributed in the hope that it will be useful, but WITHOUT 139960aa7cSTomi Valkeinen * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 149960aa7cSTomi Valkeinen * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 159960aa7cSTomi Valkeinen * more details. 169960aa7cSTomi Valkeinen * 179960aa7cSTomi Valkeinen * You should have received a copy of the GNU General Public License along with 189960aa7cSTomi Valkeinen * this program. If not, see <http://www.gnu.org/licenses/>. 199960aa7cSTomi Valkeinen */ 209960aa7cSTomi Valkeinen 219960aa7cSTomi Valkeinen #define DSS_SUBSYS_NAME "HDMI" 229960aa7cSTomi Valkeinen 239960aa7cSTomi Valkeinen #include <linux/kernel.h> 249960aa7cSTomi Valkeinen #include <linux/module.h> 259960aa7cSTomi Valkeinen #include <linux/err.h> 269960aa7cSTomi Valkeinen #include <linux/io.h> 279960aa7cSTomi Valkeinen #include <linux/interrupt.h> 289960aa7cSTomi Valkeinen #include <linux/mutex.h> 299960aa7cSTomi Valkeinen #include <linux/delay.h> 309960aa7cSTomi Valkeinen #include <linux/string.h> 319960aa7cSTomi Valkeinen #include <linux/platform_device.h> 329960aa7cSTomi Valkeinen #include <linux/pm_runtime.h> 339960aa7cSTomi Valkeinen #include <linux/clk.h> 349960aa7cSTomi Valkeinen #include <linux/gpio.h> 359960aa7cSTomi Valkeinen #include <linux/regulator/consumer.h> 369960aa7cSTomi Valkeinen #include <linux/component.h> 37d9e32ecdSTomi Valkeinen #include <linux/of.h> 3809bffa6eSRob Herring #include <linux/of_graph.h> 399960aa7cSTomi Valkeinen #include <sound/omap-hdmi-audio.h> 401897e1a3SHans Verkuil #include <media/cec.h> 419960aa7cSTomi Valkeinen 4232043da7SPeter Ujfalusi #include "omapdss.h" 439960aa7cSTomi Valkeinen #include "hdmi4_core.h" 441897e1a3SHans Verkuil #include "hdmi4_cec.h" 459960aa7cSTomi Valkeinen #include "dss.h" 469960aa7cSTomi Valkeinen #include "hdmi.h" 479960aa7cSTomi Valkeinen 489960aa7cSTomi Valkeinen static struct omap_hdmi hdmi; 499960aa7cSTomi Valkeinen 509960aa7cSTomi Valkeinen static int hdmi_runtime_get(void) 519960aa7cSTomi Valkeinen { 529960aa7cSTomi Valkeinen int r; 539960aa7cSTomi Valkeinen 549960aa7cSTomi Valkeinen DSSDBG("hdmi_runtime_get\n"); 559960aa7cSTomi Valkeinen 569960aa7cSTomi Valkeinen r = pm_runtime_get_sync(&hdmi.pdev->dev); 579960aa7cSTomi Valkeinen WARN_ON(r < 0); 589960aa7cSTomi Valkeinen if (r < 0) 599960aa7cSTomi Valkeinen return r; 609960aa7cSTomi Valkeinen 619960aa7cSTomi Valkeinen return 0; 629960aa7cSTomi Valkeinen } 639960aa7cSTomi Valkeinen 649960aa7cSTomi Valkeinen static void hdmi_runtime_put(void) 659960aa7cSTomi Valkeinen { 669960aa7cSTomi Valkeinen int r; 679960aa7cSTomi Valkeinen 689960aa7cSTomi Valkeinen DSSDBG("hdmi_runtime_put\n"); 699960aa7cSTomi Valkeinen 709960aa7cSTomi Valkeinen r = pm_runtime_put_sync(&hdmi.pdev->dev); 719960aa7cSTomi Valkeinen WARN_ON(r < 0 && r != -ENOSYS); 729960aa7cSTomi Valkeinen } 739960aa7cSTomi Valkeinen 749960aa7cSTomi Valkeinen static irqreturn_t hdmi_irq_handler(int irq, void *data) 759960aa7cSTomi Valkeinen { 76f3096a4aSHans Verkuil struct omap_hdmi *hdmi = data; 77f3096a4aSHans Verkuil struct hdmi_wp_data *wp = &hdmi->wp; 789960aa7cSTomi Valkeinen u32 irqstatus; 799960aa7cSTomi Valkeinen 809960aa7cSTomi Valkeinen irqstatus = hdmi_wp_get_irqstatus(wp); 819960aa7cSTomi Valkeinen hdmi_wp_set_irqstatus(wp, irqstatus); 829960aa7cSTomi Valkeinen 839960aa7cSTomi Valkeinen if ((irqstatus & HDMI_IRQ_LINK_CONNECT) && 849960aa7cSTomi Valkeinen irqstatus & HDMI_IRQ_LINK_DISCONNECT) { 859960aa7cSTomi Valkeinen /* 869960aa7cSTomi Valkeinen * If we get both connect and disconnect interrupts at the same 879960aa7cSTomi Valkeinen * time, turn off the PHY, clear interrupts, and restart, which 889960aa7cSTomi Valkeinen * raises connect interrupt if a cable is connected, or nothing 899960aa7cSTomi Valkeinen * if cable is not connected. 909960aa7cSTomi Valkeinen */ 919960aa7cSTomi Valkeinen hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_OFF); 929960aa7cSTomi Valkeinen 939960aa7cSTomi Valkeinen hdmi_wp_set_irqstatus(wp, HDMI_IRQ_LINK_CONNECT | 949960aa7cSTomi Valkeinen HDMI_IRQ_LINK_DISCONNECT); 959960aa7cSTomi Valkeinen 969960aa7cSTomi Valkeinen hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON); 979960aa7cSTomi Valkeinen } else if (irqstatus & HDMI_IRQ_LINK_CONNECT) { 989960aa7cSTomi Valkeinen hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_TXON); 999960aa7cSTomi Valkeinen } else if (irqstatus & HDMI_IRQ_LINK_DISCONNECT) { 1009960aa7cSTomi Valkeinen hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON); 1019960aa7cSTomi Valkeinen } 1021897e1a3SHans Verkuil if (irqstatus & HDMI_IRQ_CORE) { 1031897e1a3SHans Verkuil u32 intr4 = hdmi_read_reg(hdmi->core.base, HDMI_CORE_SYS_INTR4); 1041897e1a3SHans Verkuil 1051897e1a3SHans Verkuil hdmi_write_reg(hdmi->core.base, HDMI_CORE_SYS_INTR4, intr4); 1061897e1a3SHans Verkuil if (intr4 & 8) 1071897e1a3SHans Verkuil hdmi4_cec_irq(&hdmi->core); 1081897e1a3SHans Verkuil } 1099960aa7cSTomi Valkeinen 1109960aa7cSTomi Valkeinen return IRQ_HANDLED; 1119960aa7cSTomi Valkeinen } 1129960aa7cSTomi Valkeinen 1139960aa7cSTomi Valkeinen static int hdmi_init_regulator(void) 1149960aa7cSTomi Valkeinen { 1159960aa7cSTomi Valkeinen struct regulator *reg; 1169960aa7cSTomi Valkeinen 1179960aa7cSTomi Valkeinen if (hdmi.vdda_reg != NULL) 1189960aa7cSTomi Valkeinen return 0; 1199960aa7cSTomi Valkeinen 1209960aa7cSTomi Valkeinen reg = devm_regulator_get(&hdmi.pdev->dev, "vdda"); 1219960aa7cSTomi Valkeinen 1229960aa7cSTomi Valkeinen if (IS_ERR(reg)) { 1239960aa7cSTomi Valkeinen if (PTR_ERR(reg) != -EPROBE_DEFER) 1249960aa7cSTomi Valkeinen DSSERR("can't get VDDA regulator\n"); 1259960aa7cSTomi Valkeinen return PTR_ERR(reg); 1269960aa7cSTomi Valkeinen } 1279960aa7cSTomi Valkeinen 1289960aa7cSTomi Valkeinen hdmi.vdda_reg = reg; 1299960aa7cSTomi Valkeinen 1309960aa7cSTomi Valkeinen return 0; 1319960aa7cSTomi Valkeinen } 1329960aa7cSTomi Valkeinen 1339960aa7cSTomi Valkeinen static int hdmi_power_on_core(struct omap_dss_device *dssdev) 1349960aa7cSTomi Valkeinen { 1359960aa7cSTomi Valkeinen int r; 1369960aa7cSTomi Valkeinen 137a141a296SHans Verkuil if (hdmi.core.core_pwr_cnt++) 138a141a296SHans Verkuil return 0; 139a141a296SHans Verkuil 1409960aa7cSTomi Valkeinen r = regulator_enable(hdmi.vdda_reg); 1419960aa7cSTomi Valkeinen if (r) 142a141a296SHans Verkuil goto err_reg_enable; 1439960aa7cSTomi Valkeinen 1449960aa7cSTomi Valkeinen r = hdmi_runtime_get(); 1459960aa7cSTomi Valkeinen if (r) 1469960aa7cSTomi Valkeinen goto err_runtime_get; 1479960aa7cSTomi Valkeinen 1481d54ecf2SHans Verkuil hdmi4_core_powerdown_disable(&hdmi.core); 1491d54ecf2SHans Verkuil 1509960aa7cSTomi Valkeinen /* Make selection of HDMI in DSS */ 1518aea8e6aSLaurent Pinchart dss_select_hdmi_venc_clk_source(hdmi.dss, DSS_HDMI_M_PCLK); 1529960aa7cSTomi Valkeinen 1539960aa7cSTomi Valkeinen hdmi.core_enabled = true; 1549960aa7cSTomi Valkeinen 1559960aa7cSTomi Valkeinen return 0; 1569960aa7cSTomi Valkeinen 1579960aa7cSTomi Valkeinen err_runtime_get: 1589960aa7cSTomi Valkeinen regulator_disable(hdmi.vdda_reg); 159a141a296SHans Verkuil err_reg_enable: 160a141a296SHans Verkuil hdmi.core.core_pwr_cnt--; 1619960aa7cSTomi Valkeinen 1629960aa7cSTomi Valkeinen return r; 1639960aa7cSTomi Valkeinen } 1649960aa7cSTomi Valkeinen 1659960aa7cSTomi Valkeinen static void hdmi_power_off_core(struct omap_dss_device *dssdev) 1669960aa7cSTomi Valkeinen { 167a141a296SHans Verkuil if (--hdmi.core.core_pwr_cnt) 168a141a296SHans Verkuil return; 169a141a296SHans Verkuil 1709960aa7cSTomi Valkeinen hdmi.core_enabled = false; 1719960aa7cSTomi Valkeinen 1729960aa7cSTomi Valkeinen hdmi_runtime_put(); 1739960aa7cSTomi Valkeinen regulator_disable(hdmi.vdda_reg); 1749960aa7cSTomi Valkeinen } 1759960aa7cSTomi Valkeinen 1769960aa7cSTomi Valkeinen static int hdmi_power_on_full(struct omap_dss_device *dssdev) 1779960aa7cSTomi Valkeinen { 1789960aa7cSTomi Valkeinen int r; 179da11bbbbSPeter Ujfalusi struct videomode *vm; 18046e1ef3bSTomi Valkeinen enum omap_channel channel = dssdev->dispc_channel; 1819960aa7cSTomi Valkeinen struct hdmi_wp_data *wp = &hdmi.wp; 1829960aa7cSTomi Valkeinen struct dss_pll_clock_info hdmi_cinfo = { 0 }; 183d11e5c82SLaurent Pinchart unsigned int pc; 1849960aa7cSTomi Valkeinen 1859960aa7cSTomi Valkeinen r = hdmi_power_on_core(dssdev); 1869960aa7cSTomi Valkeinen if (r) 1879960aa7cSTomi Valkeinen return r; 1889960aa7cSTomi Valkeinen 1899960aa7cSTomi Valkeinen /* disable and clear irqs */ 190f3096a4aSHans Verkuil hdmi_wp_clear_irqenable(wp, ~HDMI_IRQ_CORE); 191f3096a4aSHans Verkuil hdmi_wp_set_irqstatus(wp, ~HDMI_IRQ_CORE); 1929960aa7cSTomi Valkeinen 193da11bbbbSPeter Ujfalusi vm = &hdmi.cfg.vm; 1949960aa7cSTomi Valkeinen 195da11bbbbSPeter Ujfalusi DSSDBG("hdmi_power_on hactive= %d vactive = %d\n", vm->hactive, 196da11bbbbSPeter Ujfalusi vm->vactive); 1979960aa7cSTomi Valkeinen 198da11bbbbSPeter Ujfalusi pc = vm->pixelclock; 199da11bbbbSPeter Ujfalusi if (vm->flags & DISPLAY_FLAGS_DOUBLECLK) 20067d8ffddSTomi Valkeinen pc *= 2; 20167d8ffddSTomi Valkeinen 202c107751dSTomi Valkeinen /* DSS_HDMI_TCLK is bitclk / 10 */ 203c107751dSTomi Valkeinen pc *= 10; 204c107751dSTomi Valkeinen 205c17dc0e3STomi Valkeinen dss_pll_calc_b(&hdmi.pll.pll, clk_get_rate(hdmi.pll.pll.clkin), 206c17dc0e3STomi Valkeinen pc, &hdmi_cinfo); 2079960aa7cSTomi Valkeinen 2089960aa7cSTomi Valkeinen r = dss_pll_enable(&hdmi.pll.pll); 2099960aa7cSTomi Valkeinen if (r) { 2109960aa7cSTomi Valkeinen DSSERR("Failed to enable PLL\n"); 2119960aa7cSTomi Valkeinen goto err_pll_enable; 2129960aa7cSTomi Valkeinen } 2139960aa7cSTomi Valkeinen 2149960aa7cSTomi Valkeinen r = dss_pll_set_config(&hdmi.pll.pll, &hdmi_cinfo); 2159960aa7cSTomi Valkeinen if (r) { 2169960aa7cSTomi Valkeinen DSSERR("Failed to configure PLL\n"); 2179960aa7cSTomi Valkeinen goto err_pll_cfg; 2189960aa7cSTomi Valkeinen } 2199960aa7cSTomi Valkeinen 2209960aa7cSTomi Valkeinen r = hdmi_phy_configure(&hdmi.phy, hdmi_cinfo.clkdco, 2219960aa7cSTomi Valkeinen hdmi_cinfo.clkout[0]); 2229960aa7cSTomi Valkeinen if (r) { 2239960aa7cSTomi Valkeinen DSSDBG("Failed to configure PHY\n"); 2249960aa7cSTomi Valkeinen goto err_phy_cfg; 2259960aa7cSTomi Valkeinen } 2269960aa7cSTomi Valkeinen 2279960aa7cSTomi Valkeinen r = hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON); 2289960aa7cSTomi Valkeinen if (r) 2299960aa7cSTomi Valkeinen goto err_phy_pwr; 2309960aa7cSTomi Valkeinen 2319960aa7cSTomi Valkeinen hdmi4_configure(&hdmi.core, &hdmi.wp, &hdmi.cfg); 2329960aa7cSTomi Valkeinen 2339960aa7cSTomi Valkeinen /* tv size */ 234da11bbbbSPeter Ujfalusi dss_mgr_set_timings(channel, vm); 2359960aa7cSTomi Valkeinen 23646e1ef3bSTomi Valkeinen r = dss_mgr_enable(channel); 2379960aa7cSTomi Valkeinen if (r) 2389960aa7cSTomi Valkeinen goto err_mgr_enable; 2399960aa7cSTomi Valkeinen 2404e4b53ceSTomi Valkeinen r = hdmi_wp_video_start(&hdmi.wp); 2414e4b53ceSTomi Valkeinen if (r) 2424e4b53ceSTomi Valkeinen goto err_vid_enable; 2434e4b53ceSTomi Valkeinen 2449960aa7cSTomi Valkeinen hdmi_wp_set_irqenable(wp, 2459960aa7cSTomi Valkeinen HDMI_IRQ_LINK_CONNECT | HDMI_IRQ_LINK_DISCONNECT); 2469960aa7cSTomi Valkeinen 2479960aa7cSTomi Valkeinen return 0; 2489960aa7cSTomi Valkeinen 2499960aa7cSTomi Valkeinen err_vid_enable: 25046e1ef3bSTomi Valkeinen dss_mgr_disable(channel); 2514e4b53ceSTomi Valkeinen err_mgr_enable: 2529960aa7cSTomi Valkeinen hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_OFF); 2539960aa7cSTomi Valkeinen err_phy_pwr: 2549960aa7cSTomi Valkeinen err_phy_cfg: 2559960aa7cSTomi Valkeinen err_pll_cfg: 2569960aa7cSTomi Valkeinen dss_pll_disable(&hdmi.pll.pll); 2579960aa7cSTomi Valkeinen err_pll_enable: 2589960aa7cSTomi Valkeinen hdmi_power_off_core(dssdev); 2599960aa7cSTomi Valkeinen return -EIO; 2609960aa7cSTomi Valkeinen } 2619960aa7cSTomi Valkeinen 2629960aa7cSTomi Valkeinen static void hdmi_power_off_full(struct omap_dss_device *dssdev) 2639960aa7cSTomi Valkeinen { 26446e1ef3bSTomi Valkeinen enum omap_channel channel = dssdev->dispc_channel; 2659960aa7cSTomi Valkeinen 266f3096a4aSHans Verkuil hdmi_wp_clear_irqenable(&hdmi.wp, ~HDMI_IRQ_CORE); 2679960aa7cSTomi Valkeinen 2689960aa7cSTomi Valkeinen hdmi_wp_video_stop(&hdmi.wp); 2699960aa7cSTomi Valkeinen 27046e1ef3bSTomi Valkeinen dss_mgr_disable(channel); 2714e4b53ceSTomi Valkeinen 2729960aa7cSTomi Valkeinen hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_OFF); 2739960aa7cSTomi Valkeinen 2749960aa7cSTomi Valkeinen dss_pll_disable(&hdmi.pll.pll); 2759960aa7cSTomi Valkeinen 2769960aa7cSTomi Valkeinen hdmi_power_off_core(dssdev); 2779960aa7cSTomi Valkeinen } 2789960aa7cSTomi Valkeinen 2799960aa7cSTomi Valkeinen static int hdmi_display_check_timing(struct omap_dss_device *dssdev, 280da11bbbbSPeter Ujfalusi struct videomode *vm) 2819960aa7cSTomi Valkeinen { 282da11bbbbSPeter Ujfalusi if (!dispc_mgr_timings_ok(dssdev->dispc_channel, vm)) 2839960aa7cSTomi Valkeinen return -EINVAL; 2849960aa7cSTomi Valkeinen 2859960aa7cSTomi Valkeinen return 0; 2869960aa7cSTomi Valkeinen } 2879960aa7cSTomi Valkeinen 2889960aa7cSTomi Valkeinen static void hdmi_display_set_timing(struct omap_dss_device *dssdev, 289da11bbbbSPeter Ujfalusi struct videomode *vm) 2909960aa7cSTomi Valkeinen { 2919960aa7cSTomi Valkeinen mutex_lock(&hdmi.lock); 2929960aa7cSTomi Valkeinen 293da11bbbbSPeter Ujfalusi hdmi.cfg.vm = *vm; 2949960aa7cSTomi Valkeinen 295da11bbbbSPeter Ujfalusi dispc_set_tv_pclk(vm->pixelclock); 2969960aa7cSTomi Valkeinen 2979960aa7cSTomi Valkeinen mutex_unlock(&hdmi.lock); 2989960aa7cSTomi Valkeinen } 2999960aa7cSTomi Valkeinen 3009960aa7cSTomi Valkeinen static void hdmi_display_get_timings(struct omap_dss_device *dssdev, 301da11bbbbSPeter Ujfalusi struct videomode *vm) 3029960aa7cSTomi Valkeinen { 303da11bbbbSPeter Ujfalusi *vm = hdmi.cfg.vm; 3049960aa7cSTomi Valkeinen } 3059960aa7cSTomi Valkeinen 306*f33656e1SLaurent Pinchart static int hdmi_dump_regs(struct seq_file *s, void *p) 3079960aa7cSTomi Valkeinen { 3089960aa7cSTomi Valkeinen mutex_lock(&hdmi.lock); 3099960aa7cSTomi Valkeinen 3109960aa7cSTomi Valkeinen if (hdmi_runtime_get()) { 3119960aa7cSTomi Valkeinen mutex_unlock(&hdmi.lock); 312*f33656e1SLaurent Pinchart return 0; 3139960aa7cSTomi Valkeinen } 3149960aa7cSTomi Valkeinen 3159960aa7cSTomi Valkeinen hdmi_wp_dump(&hdmi.wp, s); 3169960aa7cSTomi Valkeinen hdmi_pll_dump(&hdmi.pll, s); 3179960aa7cSTomi Valkeinen hdmi_phy_dump(&hdmi.phy, s); 3189960aa7cSTomi Valkeinen hdmi4_core_dump(&hdmi.core, s); 3199960aa7cSTomi Valkeinen 3209960aa7cSTomi Valkeinen hdmi_runtime_put(); 3219960aa7cSTomi Valkeinen mutex_unlock(&hdmi.lock); 322*f33656e1SLaurent Pinchart return 0; 3239960aa7cSTomi Valkeinen } 3249960aa7cSTomi Valkeinen 3259960aa7cSTomi Valkeinen static int read_edid(u8 *buf, int len) 3269960aa7cSTomi Valkeinen { 3279960aa7cSTomi Valkeinen int r; 3289960aa7cSTomi Valkeinen 3299960aa7cSTomi Valkeinen mutex_lock(&hdmi.lock); 3309960aa7cSTomi Valkeinen 3319960aa7cSTomi Valkeinen r = hdmi_runtime_get(); 3329960aa7cSTomi Valkeinen BUG_ON(r); 3339960aa7cSTomi Valkeinen 3349960aa7cSTomi Valkeinen r = hdmi4_read_edid(&hdmi.core, buf, len); 3359960aa7cSTomi Valkeinen 3369960aa7cSTomi Valkeinen hdmi_runtime_put(); 3379960aa7cSTomi Valkeinen mutex_unlock(&hdmi.lock); 3389960aa7cSTomi Valkeinen 3399960aa7cSTomi Valkeinen return r; 3409960aa7cSTomi Valkeinen } 3419960aa7cSTomi Valkeinen 3429960aa7cSTomi Valkeinen static void hdmi_start_audio_stream(struct omap_hdmi *hd) 3439960aa7cSTomi Valkeinen { 3449960aa7cSTomi Valkeinen hdmi_wp_audio_enable(&hd->wp, true); 3459960aa7cSTomi Valkeinen hdmi4_audio_start(&hd->core, &hd->wp); 3469960aa7cSTomi Valkeinen } 3479960aa7cSTomi Valkeinen 3489960aa7cSTomi Valkeinen static void hdmi_stop_audio_stream(struct omap_hdmi *hd) 3499960aa7cSTomi Valkeinen { 3509960aa7cSTomi Valkeinen hdmi4_audio_stop(&hd->core, &hd->wp); 3519960aa7cSTomi Valkeinen hdmi_wp_audio_enable(&hd->wp, false); 3529960aa7cSTomi Valkeinen } 3539960aa7cSTomi Valkeinen 3549960aa7cSTomi Valkeinen static int hdmi_display_enable(struct omap_dss_device *dssdev) 3559960aa7cSTomi Valkeinen { 3569960aa7cSTomi Valkeinen struct omap_dss_device *out = &hdmi.output; 3579960aa7cSTomi Valkeinen unsigned long flags; 3589960aa7cSTomi Valkeinen int r = 0; 3599960aa7cSTomi Valkeinen 3609960aa7cSTomi Valkeinen DSSDBG("ENTER hdmi_display_enable\n"); 3619960aa7cSTomi Valkeinen 3629960aa7cSTomi Valkeinen mutex_lock(&hdmi.lock); 3639960aa7cSTomi Valkeinen 364f1504ad0STomi Valkeinen if (!out->dispc_channel_connected) { 3659960aa7cSTomi Valkeinen DSSERR("failed to enable display: no output/manager\n"); 3669960aa7cSTomi Valkeinen r = -ENODEV; 3679960aa7cSTomi Valkeinen goto err0; 3689960aa7cSTomi Valkeinen } 3699960aa7cSTomi Valkeinen 3709960aa7cSTomi Valkeinen r = hdmi_power_on_full(dssdev); 3719960aa7cSTomi Valkeinen if (r) { 3729960aa7cSTomi Valkeinen DSSERR("failed to power on device\n"); 3739960aa7cSTomi Valkeinen goto err0; 3749960aa7cSTomi Valkeinen } 3759960aa7cSTomi Valkeinen 3769960aa7cSTomi Valkeinen if (hdmi.audio_configured) { 3779960aa7cSTomi Valkeinen r = hdmi4_audio_config(&hdmi.core, &hdmi.wp, &hdmi.audio_config, 378da11bbbbSPeter Ujfalusi hdmi.cfg.vm.pixelclock); 3799960aa7cSTomi Valkeinen if (r) { 3809960aa7cSTomi Valkeinen DSSERR("Error restoring audio configuration: %d", r); 3819960aa7cSTomi Valkeinen hdmi.audio_abort_cb(&hdmi.pdev->dev); 3829960aa7cSTomi Valkeinen hdmi.audio_configured = false; 3839960aa7cSTomi Valkeinen } 3849960aa7cSTomi Valkeinen } 3859960aa7cSTomi Valkeinen 3869960aa7cSTomi Valkeinen spin_lock_irqsave(&hdmi.audio_playing_lock, flags); 3879960aa7cSTomi Valkeinen if (hdmi.audio_configured && hdmi.audio_playing) 3889960aa7cSTomi Valkeinen hdmi_start_audio_stream(&hdmi); 3899960aa7cSTomi Valkeinen hdmi.display_enabled = true; 3909960aa7cSTomi Valkeinen spin_unlock_irqrestore(&hdmi.audio_playing_lock, flags); 3919960aa7cSTomi Valkeinen 3929960aa7cSTomi Valkeinen mutex_unlock(&hdmi.lock); 3939960aa7cSTomi Valkeinen return 0; 3949960aa7cSTomi Valkeinen 3959960aa7cSTomi Valkeinen err0: 3969960aa7cSTomi Valkeinen mutex_unlock(&hdmi.lock); 3979960aa7cSTomi Valkeinen return r; 3989960aa7cSTomi Valkeinen } 3999960aa7cSTomi Valkeinen 4009960aa7cSTomi Valkeinen static void hdmi_display_disable(struct omap_dss_device *dssdev) 4019960aa7cSTomi Valkeinen { 4029960aa7cSTomi Valkeinen unsigned long flags; 4039960aa7cSTomi Valkeinen 4049960aa7cSTomi Valkeinen DSSDBG("Enter hdmi_display_disable\n"); 4059960aa7cSTomi Valkeinen 4069960aa7cSTomi Valkeinen mutex_lock(&hdmi.lock); 4079960aa7cSTomi Valkeinen 4089960aa7cSTomi Valkeinen spin_lock_irqsave(&hdmi.audio_playing_lock, flags); 4099960aa7cSTomi Valkeinen hdmi_stop_audio_stream(&hdmi); 4109960aa7cSTomi Valkeinen hdmi.display_enabled = false; 4119960aa7cSTomi Valkeinen spin_unlock_irqrestore(&hdmi.audio_playing_lock, flags); 4129960aa7cSTomi Valkeinen 4139960aa7cSTomi Valkeinen hdmi_power_off_full(dssdev); 4149960aa7cSTomi Valkeinen 4159960aa7cSTomi Valkeinen mutex_unlock(&hdmi.lock); 4169960aa7cSTomi Valkeinen } 4179960aa7cSTomi Valkeinen 4185bebbbfeSHans Verkuil int hdmi4_core_enable(struct omap_dss_device *dssdev) 4199960aa7cSTomi Valkeinen { 4209960aa7cSTomi Valkeinen int r = 0; 4219960aa7cSTomi Valkeinen 4225bebbbfeSHans Verkuil DSSDBG("ENTER omapdss_hdmi4_core_enable\n"); 4239960aa7cSTomi Valkeinen 4249960aa7cSTomi Valkeinen mutex_lock(&hdmi.lock); 4259960aa7cSTomi Valkeinen 4269960aa7cSTomi Valkeinen r = hdmi_power_on_core(dssdev); 4279960aa7cSTomi Valkeinen if (r) { 4289960aa7cSTomi Valkeinen DSSERR("failed to power on device\n"); 4299960aa7cSTomi Valkeinen goto err0; 4309960aa7cSTomi Valkeinen } 4319960aa7cSTomi Valkeinen 4329960aa7cSTomi Valkeinen mutex_unlock(&hdmi.lock); 4339960aa7cSTomi Valkeinen return 0; 4349960aa7cSTomi Valkeinen 4359960aa7cSTomi Valkeinen err0: 4369960aa7cSTomi Valkeinen mutex_unlock(&hdmi.lock); 4379960aa7cSTomi Valkeinen return r; 4389960aa7cSTomi Valkeinen } 4399960aa7cSTomi Valkeinen 4405bebbbfeSHans Verkuil void hdmi4_core_disable(struct omap_dss_device *dssdev) 4419960aa7cSTomi Valkeinen { 4425bebbbfeSHans Verkuil DSSDBG("Enter omapdss_hdmi4_core_disable\n"); 4439960aa7cSTomi Valkeinen 4449960aa7cSTomi Valkeinen mutex_lock(&hdmi.lock); 4459960aa7cSTomi Valkeinen 4469960aa7cSTomi Valkeinen hdmi_power_off_core(dssdev); 4479960aa7cSTomi Valkeinen 4489960aa7cSTomi Valkeinen mutex_unlock(&hdmi.lock); 4499960aa7cSTomi Valkeinen } 4509960aa7cSTomi Valkeinen 4519960aa7cSTomi Valkeinen static int hdmi_connect(struct omap_dss_device *dssdev, 4529960aa7cSTomi Valkeinen struct omap_dss_device *dst) 4539960aa7cSTomi Valkeinen { 45446e1ef3bSTomi Valkeinen enum omap_channel channel = dssdev->dispc_channel; 4559960aa7cSTomi Valkeinen int r; 4569960aa7cSTomi Valkeinen 4579960aa7cSTomi Valkeinen r = hdmi_init_regulator(); 4589960aa7cSTomi Valkeinen if (r) 4599960aa7cSTomi Valkeinen return r; 4609960aa7cSTomi Valkeinen 46146e1ef3bSTomi Valkeinen r = dss_mgr_connect(channel, dssdev); 4629960aa7cSTomi Valkeinen if (r) 4639960aa7cSTomi Valkeinen return r; 4649960aa7cSTomi Valkeinen 4659960aa7cSTomi Valkeinen r = omapdss_output_set_device(dssdev, dst); 4669960aa7cSTomi Valkeinen if (r) { 4679960aa7cSTomi Valkeinen DSSERR("failed to connect output to new device: %s\n", 4689960aa7cSTomi Valkeinen dst->name); 46946e1ef3bSTomi Valkeinen dss_mgr_disconnect(channel, dssdev); 4709960aa7cSTomi Valkeinen return r; 4719960aa7cSTomi Valkeinen } 4729960aa7cSTomi Valkeinen 4739960aa7cSTomi Valkeinen return 0; 4749960aa7cSTomi Valkeinen } 4759960aa7cSTomi Valkeinen 4769960aa7cSTomi Valkeinen static void hdmi_disconnect(struct omap_dss_device *dssdev, 4779960aa7cSTomi Valkeinen struct omap_dss_device *dst) 4789960aa7cSTomi Valkeinen { 47946e1ef3bSTomi Valkeinen enum omap_channel channel = dssdev->dispc_channel; 48046e1ef3bSTomi Valkeinen 4819960aa7cSTomi Valkeinen WARN_ON(dst != dssdev->dst); 4829960aa7cSTomi Valkeinen 4839960aa7cSTomi Valkeinen if (dst != dssdev->dst) 4849960aa7cSTomi Valkeinen return; 4859960aa7cSTomi Valkeinen 4869960aa7cSTomi Valkeinen omapdss_output_unset_device(dssdev); 4879960aa7cSTomi Valkeinen 48846e1ef3bSTomi Valkeinen dss_mgr_disconnect(channel, dssdev); 4899960aa7cSTomi Valkeinen } 4909960aa7cSTomi Valkeinen 4919960aa7cSTomi Valkeinen static int hdmi_read_edid(struct omap_dss_device *dssdev, 4929960aa7cSTomi Valkeinen u8 *edid, int len) 4939960aa7cSTomi Valkeinen { 4949960aa7cSTomi Valkeinen bool need_enable; 4959960aa7cSTomi Valkeinen int r; 4969960aa7cSTomi Valkeinen 4979960aa7cSTomi Valkeinen need_enable = hdmi.core_enabled == false; 4989960aa7cSTomi Valkeinen 4999960aa7cSTomi Valkeinen if (need_enable) { 5005bebbbfeSHans Verkuil r = hdmi4_core_enable(dssdev); 5019960aa7cSTomi Valkeinen if (r) 5029960aa7cSTomi Valkeinen return r; 5039960aa7cSTomi Valkeinen } 5049960aa7cSTomi Valkeinen 5059960aa7cSTomi Valkeinen r = read_edid(edid, len); 5061897e1a3SHans Verkuil if (r >= 256) 5071897e1a3SHans Verkuil hdmi4_cec_set_phys_addr(&hdmi.core, 5081897e1a3SHans Verkuil cec_get_edid_phys_addr(edid, r, NULL)); 5091897e1a3SHans Verkuil else 5101897e1a3SHans Verkuil hdmi4_cec_set_phys_addr(&hdmi.core, CEC_PHYS_ADDR_INVALID); 5119960aa7cSTomi Valkeinen if (need_enable) 5125bebbbfeSHans Verkuil hdmi4_core_disable(dssdev); 5139960aa7cSTomi Valkeinen 5149960aa7cSTomi Valkeinen return r; 5159960aa7cSTomi Valkeinen } 5169960aa7cSTomi Valkeinen 517019114efSHans Verkuil static void hdmi_lost_hotplug(struct omap_dss_device *dssdev) 518019114efSHans Verkuil { 519019114efSHans Verkuil hdmi4_cec_set_phys_addr(&hdmi.core, CEC_PHYS_ADDR_INVALID); 520019114efSHans Verkuil } 521019114efSHans Verkuil 5229960aa7cSTomi Valkeinen static int hdmi_set_infoframe(struct omap_dss_device *dssdev, 5239960aa7cSTomi Valkeinen const struct hdmi_avi_infoframe *avi) 5249960aa7cSTomi Valkeinen { 5259960aa7cSTomi Valkeinen hdmi.cfg.infoframe = *avi; 5269960aa7cSTomi Valkeinen return 0; 5279960aa7cSTomi Valkeinen } 5289960aa7cSTomi Valkeinen 5299960aa7cSTomi Valkeinen static int hdmi_set_hdmi_mode(struct omap_dss_device *dssdev, 5309960aa7cSTomi Valkeinen bool hdmi_mode) 5319960aa7cSTomi Valkeinen { 5329960aa7cSTomi Valkeinen hdmi.cfg.hdmi_dvi_mode = hdmi_mode ? HDMI_HDMI : HDMI_DVI; 5339960aa7cSTomi Valkeinen return 0; 5349960aa7cSTomi Valkeinen } 5359960aa7cSTomi Valkeinen 5369960aa7cSTomi Valkeinen static const struct omapdss_hdmi_ops hdmi_ops = { 5379960aa7cSTomi Valkeinen .connect = hdmi_connect, 5389960aa7cSTomi Valkeinen .disconnect = hdmi_disconnect, 5399960aa7cSTomi Valkeinen 5409960aa7cSTomi Valkeinen .enable = hdmi_display_enable, 5419960aa7cSTomi Valkeinen .disable = hdmi_display_disable, 5429960aa7cSTomi Valkeinen 5439960aa7cSTomi Valkeinen .check_timings = hdmi_display_check_timing, 5449960aa7cSTomi Valkeinen .set_timings = hdmi_display_set_timing, 5459960aa7cSTomi Valkeinen .get_timings = hdmi_display_get_timings, 5469960aa7cSTomi Valkeinen 5479960aa7cSTomi Valkeinen .read_edid = hdmi_read_edid, 548019114efSHans Verkuil .lost_hotplug = hdmi_lost_hotplug, 5499960aa7cSTomi Valkeinen .set_infoframe = hdmi_set_infoframe, 5509960aa7cSTomi Valkeinen .set_hdmi_mode = hdmi_set_hdmi_mode, 5519960aa7cSTomi Valkeinen }; 5529960aa7cSTomi Valkeinen 5539960aa7cSTomi Valkeinen static void hdmi_init_output(struct platform_device *pdev) 5549960aa7cSTomi Valkeinen { 5559960aa7cSTomi Valkeinen struct omap_dss_device *out = &hdmi.output; 5569960aa7cSTomi Valkeinen 5579960aa7cSTomi Valkeinen out->dev = &pdev->dev; 5589960aa7cSTomi Valkeinen out->id = OMAP_DSS_OUTPUT_HDMI; 5599960aa7cSTomi Valkeinen out->output_type = OMAP_DISPLAY_TYPE_HDMI; 5609960aa7cSTomi Valkeinen out->name = "hdmi.0"; 5619960aa7cSTomi Valkeinen out->dispc_channel = OMAP_DSS_CHANNEL_DIGIT; 5629960aa7cSTomi Valkeinen out->ops.hdmi = &hdmi_ops; 5639960aa7cSTomi Valkeinen out->owner = THIS_MODULE; 5649960aa7cSTomi Valkeinen 5659960aa7cSTomi Valkeinen omapdss_register_output(out); 5669960aa7cSTomi Valkeinen } 5679960aa7cSTomi Valkeinen 5689960aa7cSTomi Valkeinen static void hdmi_uninit_output(struct platform_device *pdev) 5699960aa7cSTomi Valkeinen { 5709960aa7cSTomi Valkeinen struct omap_dss_device *out = &hdmi.output; 5719960aa7cSTomi Valkeinen 5729960aa7cSTomi Valkeinen omapdss_unregister_output(out); 5739960aa7cSTomi Valkeinen } 5749960aa7cSTomi Valkeinen 5759960aa7cSTomi Valkeinen static int hdmi_probe_of(struct platform_device *pdev) 5769960aa7cSTomi Valkeinen { 5779960aa7cSTomi Valkeinen struct device_node *node = pdev->dev.of_node; 5789960aa7cSTomi Valkeinen struct device_node *ep; 5799960aa7cSTomi Valkeinen int r; 5809960aa7cSTomi Valkeinen 58109bffa6eSRob Herring ep = of_graph_get_endpoint_by_regs(node, 0, 0); 5829960aa7cSTomi Valkeinen if (!ep) 5839960aa7cSTomi Valkeinen return 0; 5849960aa7cSTomi Valkeinen 5859960aa7cSTomi Valkeinen r = hdmi_parse_lanes_of(pdev, ep, &hdmi.phy); 5869960aa7cSTomi Valkeinen if (r) 5879960aa7cSTomi Valkeinen goto err; 5889960aa7cSTomi Valkeinen 5899960aa7cSTomi Valkeinen of_node_put(ep); 5909960aa7cSTomi Valkeinen return 0; 5919960aa7cSTomi Valkeinen 5929960aa7cSTomi Valkeinen err: 5939960aa7cSTomi Valkeinen of_node_put(ep); 5949960aa7cSTomi Valkeinen return r; 5959960aa7cSTomi Valkeinen } 5969960aa7cSTomi Valkeinen 5979960aa7cSTomi Valkeinen /* Audio callbacks */ 5989960aa7cSTomi Valkeinen static int hdmi_audio_startup(struct device *dev, 5999960aa7cSTomi Valkeinen void (*abort_cb)(struct device *dev)) 6009960aa7cSTomi Valkeinen { 6019960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 6029960aa7cSTomi Valkeinen int ret = 0; 6039960aa7cSTomi Valkeinen 6049960aa7cSTomi Valkeinen mutex_lock(&hd->lock); 6059960aa7cSTomi Valkeinen 6069960aa7cSTomi Valkeinen if (!hdmi_mode_has_audio(&hd->cfg) || !hd->display_enabled) { 6079960aa7cSTomi Valkeinen ret = -EPERM; 6089960aa7cSTomi Valkeinen goto out; 6099960aa7cSTomi Valkeinen } 6109960aa7cSTomi Valkeinen 6119960aa7cSTomi Valkeinen hd->audio_abort_cb = abort_cb; 6129960aa7cSTomi Valkeinen 6139960aa7cSTomi Valkeinen out: 6149960aa7cSTomi Valkeinen mutex_unlock(&hd->lock); 6159960aa7cSTomi Valkeinen 6169960aa7cSTomi Valkeinen return ret; 6179960aa7cSTomi Valkeinen } 6189960aa7cSTomi Valkeinen 6199960aa7cSTomi Valkeinen static int hdmi_audio_shutdown(struct device *dev) 6209960aa7cSTomi Valkeinen { 6219960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 6229960aa7cSTomi Valkeinen 6239960aa7cSTomi Valkeinen mutex_lock(&hd->lock); 6249960aa7cSTomi Valkeinen hd->audio_abort_cb = NULL; 6259960aa7cSTomi Valkeinen hd->audio_configured = false; 6269960aa7cSTomi Valkeinen hd->audio_playing = false; 6279960aa7cSTomi Valkeinen mutex_unlock(&hd->lock); 6289960aa7cSTomi Valkeinen 6299960aa7cSTomi Valkeinen return 0; 6309960aa7cSTomi Valkeinen } 6319960aa7cSTomi Valkeinen 6329960aa7cSTomi Valkeinen static int hdmi_audio_start(struct device *dev) 6339960aa7cSTomi Valkeinen { 6349960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 6359960aa7cSTomi Valkeinen unsigned long flags; 6369960aa7cSTomi Valkeinen 6379960aa7cSTomi Valkeinen WARN_ON(!hdmi_mode_has_audio(&hd->cfg)); 6389960aa7cSTomi Valkeinen 6399960aa7cSTomi Valkeinen spin_lock_irqsave(&hd->audio_playing_lock, flags); 6409960aa7cSTomi Valkeinen 6419960aa7cSTomi Valkeinen if (hd->display_enabled) 6429960aa7cSTomi Valkeinen hdmi_start_audio_stream(hd); 6439960aa7cSTomi Valkeinen hd->audio_playing = true; 6449960aa7cSTomi Valkeinen 6459960aa7cSTomi Valkeinen spin_unlock_irqrestore(&hd->audio_playing_lock, flags); 6469960aa7cSTomi Valkeinen return 0; 6479960aa7cSTomi Valkeinen } 6489960aa7cSTomi Valkeinen 6499960aa7cSTomi Valkeinen static void hdmi_audio_stop(struct device *dev) 6509960aa7cSTomi Valkeinen { 6519960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 6529960aa7cSTomi Valkeinen unsigned long flags; 6539960aa7cSTomi Valkeinen 6549960aa7cSTomi Valkeinen WARN_ON(!hdmi_mode_has_audio(&hd->cfg)); 6559960aa7cSTomi Valkeinen 6569960aa7cSTomi Valkeinen spin_lock_irqsave(&hd->audio_playing_lock, flags); 6579960aa7cSTomi Valkeinen 6589960aa7cSTomi Valkeinen if (hd->display_enabled) 6599960aa7cSTomi Valkeinen hdmi_stop_audio_stream(hd); 6609960aa7cSTomi Valkeinen hd->audio_playing = false; 6619960aa7cSTomi Valkeinen 6629960aa7cSTomi Valkeinen spin_unlock_irqrestore(&hd->audio_playing_lock, flags); 6639960aa7cSTomi Valkeinen } 6649960aa7cSTomi Valkeinen 6659960aa7cSTomi Valkeinen static int hdmi_audio_config(struct device *dev, 6669960aa7cSTomi Valkeinen struct omap_dss_audio *dss_audio) 6679960aa7cSTomi Valkeinen { 6689960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 6699960aa7cSTomi Valkeinen int ret; 6709960aa7cSTomi Valkeinen 6719960aa7cSTomi Valkeinen mutex_lock(&hd->lock); 6729960aa7cSTomi Valkeinen 6739960aa7cSTomi Valkeinen if (!hdmi_mode_has_audio(&hd->cfg) || !hd->display_enabled) { 6749960aa7cSTomi Valkeinen ret = -EPERM; 6759960aa7cSTomi Valkeinen goto out; 6769960aa7cSTomi Valkeinen } 6779960aa7cSTomi Valkeinen 6789960aa7cSTomi Valkeinen ret = hdmi4_audio_config(&hd->core, &hd->wp, dss_audio, 679da11bbbbSPeter Ujfalusi hd->cfg.vm.pixelclock); 6809960aa7cSTomi Valkeinen if (!ret) { 6819960aa7cSTomi Valkeinen hd->audio_configured = true; 6829960aa7cSTomi Valkeinen hd->audio_config = *dss_audio; 6839960aa7cSTomi Valkeinen } 6849960aa7cSTomi Valkeinen out: 6859960aa7cSTomi Valkeinen mutex_unlock(&hd->lock); 6869960aa7cSTomi Valkeinen 6879960aa7cSTomi Valkeinen return ret; 6889960aa7cSTomi Valkeinen } 6899960aa7cSTomi Valkeinen 6909960aa7cSTomi Valkeinen static const struct omap_hdmi_audio_ops hdmi_audio_ops = { 6919960aa7cSTomi Valkeinen .audio_startup = hdmi_audio_startup, 6929960aa7cSTomi Valkeinen .audio_shutdown = hdmi_audio_shutdown, 6939960aa7cSTomi Valkeinen .audio_start = hdmi_audio_start, 6949960aa7cSTomi Valkeinen .audio_stop = hdmi_audio_stop, 6959960aa7cSTomi Valkeinen .audio_config = hdmi_audio_config, 6969960aa7cSTomi Valkeinen }; 6979960aa7cSTomi Valkeinen 6989960aa7cSTomi Valkeinen static int hdmi_audio_register(struct device *dev) 6999960aa7cSTomi Valkeinen { 7009960aa7cSTomi Valkeinen struct omap_hdmi_audio_pdata pdata = { 7019960aa7cSTomi Valkeinen .dev = dev, 702d20fa5a0SLaurent Pinchart .version = 4, 7039960aa7cSTomi Valkeinen .audio_dma_addr = hdmi_wp_get_audio_dma_addr(&hdmi.wp), 7049960aa7cSTomi Valkeinen .ops = &hdmi_audio_ops, 7059960aa7cSTomi Valkeinen }; 7069960aa7cSTomi Valkeinen 7079960aa7cSTomi Valkeinen hdmi.audio_pdev = platform_device_register_data( 7089960aa7cSTomi Valkeinen dev, "omap-hdmi-audio", PLATFORM_DEVID_AUTO, 7099960aa7cSTomi Valkeinen &pdata, sizeof(pdata)); 7109960aa7cSTomi Valkeinen 7119960aa7cSTomi Valkeinen if (IS_ERR(hdmi.audio_pdev)) 7129960aa7cSTomi Valkeinen return PTR_ERR(hdmi.audio_pdev); 7139960aa7cSTomi Valkeinen 7149960aa7cSTomi Valkeinen return 0; 7159960aa7cSTomi Valkeinen } 7169960aa7cSTomi Valkeinen 7179960aa7cSTomi Valkeinen /* HDMI HW IP initialisation */ 7189960aa7cSTomi Valkeinen static int hdmi4_bind(struct device *dev, struct device *master, void *data) 7199960aa7cSTomi Valkeinen { 7209960aa7cSTomi Valkeinen struct platform_device *pdev = to_platform_device(dev); 7217b295257SLaurent Pinchart struct dss_device *dss = dss_get_device(master); 7229960aa7cSTomi Valkeinen int r; 7239960aa7cSTomi Valkeinen int irq; 7249960aa7cSTomi Valkeinen 7259960aa7cSTomi Valkeinen hdmi.pdev = pdev; 7268aea8e6aSLaurent Pinchart hdmi.dss = dss; 7279960aa7cSTomi Valkeinen dev_set_drvdata(&pdev->dev, &hdmi); 7289960aa7cSTomi Valkeinen 7299960aa7cSTomi Valkeinen mutex_init(&hdmi.lock); 7309960aa7cSTomi Valkeinen spin_lock_init(&hdmi.audio_playing_lock); 7319960aa7cSTomi Valkeinen 7329960aa7cSTomi Valkeinen r = hdmi_probe_of(pdev); 7339960aa7cSTomi Valkeinen if (r) 7349960aa7cSTomi Valkeinen return r; 7359960aa7cSTomi Valkeinen 736fe16bc51SLaurent Pinchart r = hdmi_wp_init(pdev, &hdmi.wp, 4); 7379960aa7cSTomi Valkeinen if (r) 7389960aa7cSTomi Valkeinen return r; 7399960aa7cSTomi Valkeinen 7407b295257SLaurent Pinchart r = hdmi_pll_init(dss, pdev, &hdmi.pll, &hdmi.wp); 7419960aa7cSTomi Valkeinen if (r) 7429960aa7cSTomi Valkeinen return r; 7439960aa7cSTomi Valkeinen 74437ea27b9SLaurent Pinchart r = hdmi_phy_init(pdev, &hdmi.phy, 4); 7459960aa7cSTomi Valkeinen if (r) 7469960aa7cSTomi Valkeinen goto err; 7479960aa7cSTomi Valkeinen 7489960aa7cSTomi Valkeinen r = hdmi4_core_init(pdev, &hdmi.core); 7499960aa7cSTomi Valkeinen if (r) 7509960aa7cSTomi Valkeinen goto err; 7519960aa7cSTomi Valkeinen 7521897e1a3SHans Verkuil r = hdmi4_cec_init(pdev, &hdmi.core, &hdmi.wp); 7531897e1a3SHans Verkuil if (r) 7541897e1a3SHans Verkuil goto err; 7551897e1a3SHans Verkuil 7569960aa7cSTomi Valkeinen irq = platform_get_irq(pdev, 0); 7579960aa7cSTomi Valkeinen if (irq < 0) { 7589960aa7cSTomi Valkeinen DSSERR("platform_get_irq failed\n"); 7599960aa7cSTomi Valkeinen r = -ENODEV; 7609960aa7cSTomi Valkeinen goto err; 7619960aa7cSTomi Valkeinen } 7629960aa7cSTomi Valkeinen 7639960aa7cSTomi Valkeinen r = devm_request_threaded_irq(&pdev->dev, irq, 7649960aa7cSTomi Valkeinen NULL, hdmi_irq_handler, 765f3096a4aSHans Verkuil IRQF_ONESHOT, "OMAP HDMI", &hdmi); 7669960aa7cSTomi Valkeinen if (r) { 7679960aa7cSTomi Valkeinen DSSERR("HDMI IRQ request failed\n"); 7689960aa7cSTomi Valkeinen goto err; 7699960aa7cSTomi Valkeinen } 7709960aa7cSTomi Valkeinen 7719960aa7cSTomi Valkeinen pm_runtime_enable(&pdev->dev); 7729960aa7cSTomi Valkeinen 7739960aa7cSTomi Valkeinen hdmi_init_output(pdev); 7749960aa7cSTomi Valkeinen 7759960aa7cSTomi Valkeinen r = hdmi_audio_register(&pdev->dev); 7769960aa7cSTomi Valkeinen if (r) { 7779960aa7cSTomi Valkeinen DSSERR("Registering HDMI audio failed\n"); 7789960aa7cSTomi Valkeinen hdmi_uninit_output(pdev); 7799960aa7cSTomi Valkeinen pm_runtime_disable(&pdev->dev); 7809960aa7cSTomi Valkeinen return r; 7819960aa7cSTomi Valkeinen } 7829960aa7cSTomi Valkeinen 783*f33656e1SLaurent Pinchart hdmi.debugfs = dss_debugfs_create_file("hdmi", hdmi_dump_regs, &hdmi); 7849960aa7cSTomi Valkeinen 7859960aa7cSTomi Valkeinen return 0; 7869960aa7cSTomi Valkeinen err: 7879960aa7cSTomi Valkeinen hdmi_pll_uninit(&hdmi.pll); 7889960aa7cSTomi Valkeinen return r; 7899960aa7cSTomi Valkeinen } 7909960aa7cSTomi Valkeinen 7919960aa7cSTomi Valkeinen static void hdmi4_unbind(struct device *dev, struct device *master, void *data) 7929960aa7cSTomi Valkeinen { 7939960aa7cSTomi Valkeinen struct platform_device *pdev = to_platform_device(dev); 7949960aa7cSTomi Valkeinen 795*f33656e1SLaurent Pinchart dss_debugfs_remove_file(hdmi.debugfs); 796*f33656e1SLaurent Pinchart 7979960aa7cSTomi Valkeinen if (hdmi.audio_pdev) 7989960aa7cSTomi Valkeinen platform_device_unregister(hdmi.audio_pdev); 7999960aa7cSTomi Valkeinen 8009960aa7cSTomi Valkeinen hdmi_uninit_output(pdev); 8019960aa7cSTomi Valkeinen 8021897e1a3SHans Verkuil hdmi4_cec_uninit(&hdmi.core); 8031897e1a3SHans Verkuil 8049960aa7cSTomi Valkeinen hdmi_pll_uninit(&hdmi.pll); 8059960aa7cSTomi Valkeinen 8069960aa7cSTomi Valkeinen pm_runtime_disable(&pdev->dev); 8079960aa7cSTomi Valkeinen } 8089960aa7cSTomi Valkeinen 8099960aa7cSTomi Valkeinen static const struct component_ops hdmi4_component_ops = { 8109960aa7cSTomi Valkeinen .bind = hdmi4_bind, 8119960aa7cSTomi Valkeinen .unbind = hdmi4_unbind, 8129960aa7cSTomi Valkeinen }; 8139960aa7cSTomi Valkeinen 8149960aa7cSTomi Valkeinen static int hdmi4_probe(struct platform_device *pdev) 8159960aa7cSTomi Valkeinen { 8169960aa7cSTomi Valkeinen return component_add(&pdev->dev, &hdmi4_component_ops); 8179960aa7cSTomi Valkeinen } 8189960aa7cSTomi Valkeinen 8199960aa7cSTomi Valkeinen static int hdmi4_remove(struct platform_device *pdev) 8209960aa7cSTomi Valkeinen { 8219960aa7cSTomi Valkeinen component_del(&pdev->dev, &hdmi4_component_ops); 8229960aa7cSTomi Valkeinen return 0; 8239960aa7cSTomi Valkeinen } 8249960aa7cSTomi Valkeinen 8259960aa7cSTomi Valkeinen static int hdmi_runtime_suspend(struct device *dev) 8269960aa7cSTomi Valkeinen { 8279960aa7cSTomi Valkeinen dispc_runtime_put(); 8289960aa7cSTomi Valkeinen 8299960aa7cSTomi Valkeinen return 0; 8309960aa7cSTomi Valkeinen } 8319960aa7cSTomi Valkeinen 8329960aa7cSTomi Valkeinen static int hdmi_runtime_resume(struct device *dev) 8339960aa7cSTomi Valkeinen { 8349960aa7cSTomi Valkeinen int r; 8359960aa7cSTomi Valkeinen 8369960aa7cSTomi Valkeinen r = dispc_runtime_get(); 8379960aa7cSTomi Valkeinen if (r < 0) 8389960aa7cSTomi Valkeinen return r; 8399960aa7cSTomi Valkeinen 8409960aa7cSTomi Valkeinen return 0; 8419960aa7cSTomi Valkeinen } 8429960aa7cSTomi Valkeinen 8439960aa7cSTomi Valkeinen static const struct dev_pm_ops hdmi_pm_ops = { 8449960aa7cSTomi Valkeinen .runtime_suspend = hdmi_runtime_suspend, 8459960aa7cSTomi Valkeinen .runtime_resume = hdmi_runtime_resume, 8469960aa7cSTomi Valkeinen }; 8479960aa7cSTomi Valkeinen 8489960aa7cSTomi Valkeinen static const struct of_device_id hdmi_of_match[] = { 8499960aa7cSTomi Valkeinen { .compatible = "ti,omap4-hdmi", }, 8509960aa7cSTomi Valkeinen {}, 8519960aa7cSTomi Valkeinen }; 8529960aa7cSTomi Valkeinen 853d66c36a3SAndrew F. Davis struct platform_driver omapdss_hdmi4hw_driver = { 8549960aa7cSTomi Valkeinen .probe = hdmi4_probe, 8559960aa7cSTomi Valkeinen .remove = hdmi4_remove, 8569960aa7cSTomi Valkeinen .driver = { 8579960aa7cSTomi Valkeinen .name = "omapdss_hdmi", 8589960aa7cSTomi Valkeinen .pm = &hdmi_pm_ops, 8599960aa7cSTomi Valkeinen .of_match_table = hdmi_of_match, 8609960aa7cSTomi Valkeinen .suppress_bind_attrs = true, 8619960aa7cSTomi Valkeinen }, 8629960aa7cSTomi Valkeinen }; 863