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 48ac767456SLaurent Pinchart static int hdmi_runtime_get(struct omap_hdmi *hdmi) 499960aa7cSTomi Valkeinen { 509960aa7cSTomi Valkeinen int r; 519960aa7cSTomi Valkeinen 529960aa7cSTomi Valkeinen DSSDBG("hdmi_runtime_get\n"); 539960aa7cSTomi Valkeinen 54ac767456SLaurent Pinchart r = pm_runtime_get_sync(&hdmi->pdev->dev); 559960aa7cSTomi Valkeinen WARN_ON(r < 0); 569960aa7cSTomi Valkeinen if (r < 0) 579960aa7cSTomi Valkeinen return r; 589960aa7cSTomi Valkeinen 599960aa7cSTomi Valkeinen return 0; 609960aa7cSTomi Valkeinen } 619960aa7cSTomi Valkeinen 62ac767456SLaurent Pinchart static void hdmi_runtime_put(struct omap_hdmi *hdmi) 639960aa7cSTomi Valkeinen { 649960aa7cSTomi Valkeinen int r; 659960aa7cSTomi Valkeinen 669960aa7cSTomi Valkeinen DSSDBG("hdmi_runtime_put\n"); 679960aa7cSTomi Valkeinen 68ac767456SLaurent Pinchart r = pm_runtime_put_sync(&hdmi->pdev->dev); 699960aa7cSTomi Valkeinen WARN_ON(r < 0 && r != -ENOSYS); 709960aa7cSTomi Valkeinen } 719960aa7cSTomi Valkeinen 729960aa7cSTomi Valkeinen static irqreturn_t hdmi_irq_handler(int irq, void *data) 739960aa7cSTomi Valkeinen { 74f3096a4aSHans Verkuil struct omap_hdmi *hdmi = data; 75f3096a4aSHans Verkuil struct hdmi_wp_data *wp = &hdmi->wp; 769960aa7cSTomi Valkeinen u32 irqstatus; 779960aa7cSTomi Valkeinen 789960aa7cSTomi Valkeinen irqstatus = hdmi_wp_get_irqstatus(wp); 799960aa7cSTomi Valkeinen hdmi_wp_set_irqstatus(wp, irqstatus); 809960aa7cSTomi Valkeinen 819960aa7cSTomi Valkeinen if ((irqstatus & HDMI_IRQ_LINK_CONNECT) && 829960aa7cSTomi Valkeinen irqstatus & HDMI_IRQ_LINK_DISCONNECT) { 839960aa7cSTomi Valkeinen /* 849960aa7cSTomi Valkeinen * If we get both connect and disconnect interrupts at the same 859960aa7cSTomi Valkeinen * time, turn off the PHY, clear interrupts, and restart, which 869960aa7cSTomi Valkeinen * raises connect interrupt if a cable is connected, or nothing 879960aa7cSTomi Valkeinen * if cable is not connected. 889960aa7cSTomi Valkeinen */ 899960aa7cSTomi Valkeinen hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_OFF); 909960aa7cSTomi Valkeinen 919960aa7cSTomi Valkeinen hdmi_wp_set_irqstatus(wp, HDMI_IRQ_LINK_CONNECT | 929960aa7cSTomi Valkeinen HDMI_IRQ_LINK_DISCONNECT); 939960aa7cSTomi Valkeinen 949960aa7cSTomi Valkeinen hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON); 959960aa7cSTomi Valkeinen } else if (irqstatus & HDMI_IRQ_LINK_CONNECT) { 969960aa7cSTomi Valkeinen hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_TXON); 979960aa7cSTomi Valkeinen } else if (irqstatus & HDMI_IRQ_LINK_DISCONNECT) { 989960aa7cSTomi Valkeinen hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON); 999960aa7cSTomi Valkeinen } 1001897e1a3SHans Verkuil if (irqstatus & HDMI_IRQ_CORE) { 1011897e1a3SHans Verkuil u32 intr4 = hdmi_read_reg(hdmi->core.base, HDMI_CORE_SYS_INTR4); 1021897e1a3SHans Verkuil 1031897e1a3SHans Verkuil hdmi_write_reg(hdmi->core.base, HDMI_CORE_SYS_INTR4, intr4); 1041897e1a3SHans Verkuil if (intr4 & 8) 1051897e1a3SHans Verkuil hdmi4_cec_irq(&hdmi->core); 1061897e1a3SHans Verkuil } 1079960aa7cSTomi Valkeinen 1089960aa7cSTomi Valkeinen return IRQ_HANDLED; 1099960aa7cSTomi Valkeinen } 1109960aa7cSTomi Valkeinen 111ac767456SLaurent Pinchart static int hdmi_power_on_core(struct omap_hdmi *hdmi) 1129960aa7cSTomi Valkeinen { 1139960aa7cSTomi Valkeinen int r; 1149960aa7cSTomi Valkeinen 115ac767456SLaurent Pinchart if (hdmi->core.core_pwr_cnt++) 116a141a296SHans Verkuil return 0; 117a141a296SHans Verkuil 118ac767456SLaurent Pinchart r = regulator_enable(hdmi->vdda_reg); 1199960aa7cSTomi Valkeinen if (r) 120a141a296SHans Verkuil goto err_reg_enable; 1219960aa7cSTomi Valkeinen 122ac767456SLaurent Pinchart r = hdmi_runtime_get(hdmi); 1239960aa7cSTomi Valkeinen if (r) 1249960aa7cSTomi Valkeinen goto err_runtime_get; 1259960aa7cSTomi Valkeinen 126ac767456SLaurent Pinchart hdmi4_core_powerdown_disable(&hdmi->core); 1271d54ecf2SHans Verkuil 1289960aa7cSTomi Valkeinen /* Make selection of HDMI in DSS */ 129ac767456SLaurent Pinchart dss_select_hdmi_venc_clk_source(hdmi->dss, DSS_HDMI_M_PCLK); 1309960aa7cSTomi Valkeinen 131ac767456SLaurent Pinchart hdmi->core_enabled = true; 1329960aa7cSTomi Valkeinen 1339960aa7cSTomi Valkeinen return 0; 1349960aa7cSTomi Valkeinen 1359960aa7cSTomi Valkeinen err_runtime_get: 136ac767456SLaurent Pinchart regulator_disable(hdmi->vdda_reg); 137a141a296SHans Verkuil err_reg_enable: 138ac767456SLaurent Pinchart hdmi->core.core_pwr_cnt--; 1399960aa7cSTomi Valkeinen 1409960aa7cSTomi Valkeinen return r; 1419960aa7cSTomi Valkeinen } 1429960aa7cSTomi Valkeinen 143ac767456SLaurent Pinchart static void hdmi_power_off_core(struct omap_hdmi *hdmi) 1449960aa7cSTomi Valkeinen { 145ac767456SLaurent Pinchart if (--hdmi->core.core_pwr_cnt) 146a141a296SHans Verkuil return; 147a141a296SHans Verkuil 148ac767456SLaurent Pinchart hdmi->core_enabled = false; 1499960aa7cSTomi Valkeinen 150ac767456SLaurent Pinchart hdmi_runtime_put(hdmi); 151ac767456SLaurent Pinchart regulator_disable(hdmi->vdda_reg); 1529960aa7cSTomi Valkeinen } 1539960aa7cSTomi Valkeinen 154ac767456SLaurent Pinchart static int hdmi_power_on_full(struct omap_hdmi *hdmi) 1559960aa7cSTomi Valkeinen { 1569960aa7cSTomi Valkeinen int r; 15795e472daSLaurent Pinchart const struct videomode *vm; 158ac767456SLaurent Pinchart struct hdmi_wp_data *wp = &hdmi->wp; 1599960aa7cSTomi Valkeinen struct dss_pll_clock_info hdmi_cinfo = { 0 }; 160d11e5c82SLaurent Pinchart unsigned int pc; 1619960aa7cSTomi Valkeinen 162ac767456SLaurent Pinchart r = hdmi_power_on_core(hdmi); 1639960aa7cSTomi Valkeinen if (r) 1649960aa7cSTomi Valkeinen return r; 1659960aa7cSTomi Valkeinen 1669960aa7cSTomi Valkeinen /* disable and clear irqs */ 167f3096a4aSHans Verkuil hdmi_wp_clear_irqenable(wp, ~HDMI_IRQ_CORE); 168f3096a4aSHans Verkuil hdmi_wp_set_irqstatus(wp, ~HDMI_IRQ_CORE); 1699960aa7cSTomi Valkeinen 170ac767456SLaurent Pinchart vm = &hdmi->cfg.vm; 1719960aa7cSTomi Valkeinen 172da11bbbbSPeter Ujfalusi DSSDBG("hdmi_power_on hactive= %d vactive = %d\n", vm->hactive, 173da11bbbbSPeter Ujfalusi vm->vactive); 1749960aa7cSTomi Valkeinen 175da11bbbbSPeter Ujfalusi pc = vm->pixelclock; 176da11bbbbSPeter Ujfalusi if (vm->flags & DISPLAY_FLAGS_DOUBLECLK) 17767d8ffddSTomi Valkeinen pc *= 2; 17867d8ffddSTomi Valkeinen 179c107751dSTomi Valkeinen /* DSS_HDMI_TCLK is bitclk / 10 */ 180c107751dSTomi Valkeinen pc *= 10; 181c107751dSTomi Valkeinen 182ac767456SLaurent Pinchart dss_pll_calc_b(&hdmi->pll.pll, clk_get_rate(hdmi->pll.pll.clkin), 183c17dc0e3STomi Valkeinen pc, &hdmi_cinfo); 1849960aa7cSTomi Valkeinen 185ac767456SLaurent Pinchart r = dss_pll_enable(&hdmi->pll.pll); 1869960aa7cSTomi Valkeinen if (r) { 1879960aa7cSTomi Valkeinen DSSERR("Failed to enable PLL\n"); 1889960aa7cSTomi Valkeinen goto err_pll_enable; 1899960aa7cSTomi Valkeinen } 1909960aa7cSTomi Valkeinen 191ac767456SLaurent Pinchart r = dss_pll_set_config(&hdmi->pll.pll, &hdmi_cinfo); 1929960aa7cSTomi Valkeinen if (r) { 1939960aa7cSTomi Valkeinen DSSERR("Failed to configure PLL\n"); 1949960aa7cSTomi Valkeinen goto err_pll_cfg; 1959960aa7cSTomi Valkeinen } 1969960aa7cSTomi Valkeinen 197ac767456SLaurent Pinchart r = hdmi_phy_configure(&hdmi->phy, hdmi_cinfo.clkdco, 1989960aa7cSTomi Valkeinen hdmi_cinfo.clkout[0]); 1999960aa7cSTomi Valkeinen if (r) { 2009960aa7cSTomi Valkeinen DSSDBG("Failed to configure PHY\n"); 2019960aa7cSTomi Valkeinen goto err_phy_cfg; 2029960aa7cSTomi Valkeinen } 2039960aa7cSTomi Valkeinen 2049960aa7cSTomi Valkeinen r = hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON); 2059960aa7cSTomi Valkeinen if (r) 2069960aa7cSTomi Valkeinen goto err_phy_pwr; 2079960aa7cSTomi Valkeinen 208ac767456SLaurent Pinchart hdmi4_configure(&hdmi->core, &hdmi->wp, &hdmi->cfg); 2099960aa7cSTomi Valkeinen 210ac767456SLaurent Pinchart r = dss_mgr_enable(&hdmi->output); 2119960aa7cSTomi Valkeinen if (r) 2129960aa7cSTomi Valkeinen goto err_mgr_enable; 2139960aa7cSTomi Valkeinen 214ac767456SLaurent Pinchart r = hdmi_wp_video_start(&hdmi->wp); 2154e4b53ceSTomi Valkeinen if (r) 2164e4b53ceSTomi Valkeinen goto err_vid_enable; 2174e4b53ceSTomi Valkeinen 2189960aa7cSTomi Valkeinen hdmi_wp_set_irqenable(wp, 2199960aa7cSTomi Valkeinen HDMI_IRQ_LINK_CONNECT | HDMI_IRQ_LINK_DISCONNECT); 2209960aa7cSTomi Valkeinen 2219960aa7cSTomi Valkeinen return 0; 2229960aa7cSTomi Valkeinen 2239960aa7cSTomi Valkeinen err_vid_enable: 224ac767456SLaurent Pinchart dss_mgr_disable(&hdmi->output); 2254e4b53ceSTomi Valkeinen err_mgr_enable: 226ac767456SLaurent Pinchart hdmi_wp_set_phy_pwr(&hdmi->wp, HDMI_PHYPWRCMD_OFF); 2279960aa7cSTomi Valkeinen err_phy_pwr: 2289960aa7cSTomi Valkeinen err_phy_cfg: 2299960aa7cSTomi Valkeinen err_pll_cfg: 230ac767456SLaurent Pinchart dss_pll_disable(&hdmi->pll.pll); 2319960aa7cSTomi Valkeinen err_pll_enable: 232ac767456SLaurent Pinchart hdmi_power_off_core(hdmi); 2339960aa7cSTomi Valkeinen return -EIO; 2349960aa7cSTomi Valkeinen } 2359960aa7cSTomi Valkeinen 236ac767456SLaurent Pinchart static void hdmi_power_off_full(struct omap_hdmi *hdmi) 2379960aa7cSTomi Valkeinen { 238ac767456SLaurent Pinchart hdmi_wp_clear_irqenable(&hdmi->wp, ~HDMI_IRQ_CORE); 2399960aa7cSTomi Valkeinen 240ac767456SLaurent Pinchart hdmi_wp_video_stop(&hdmi->wp); 2419960aa7cSTomi Valkeinen 242ac767456SLaurent Pinchart dss_mgr_disable(&hdmi->output); 2434e4b53ceSTomi Valkeinen 244ac767456SLaurent Pinchart hdmi_wp_set_phy_pwr(&hdmi->wp, HDMI_PHYPWRCMD_OFF); 2459960aa7cSTomi Valkeinen 246ac767456SLaurent Pinchart dss_pll_disable(&hdmi->pll.pll); 2479960aa7cSTomi Valkeinen 248ac767456SLaurent Pinchart hdmi_power_off_core(hdmi); 2499960aa7cSTomi Valkeinen } 2509960aa7cSTomi Valkeinen 251ec68cd5aSLaurent Pinchart static void hdmi_display_set_timings(struct omap_dss_device *dssdev, 2528fe1d361SLaurent Pinchart const struct videomode *vm) 2539960aa7cSTomi Valkeinen { 254ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 2559960aa7cSTomi Valkeinen 256ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 2579960aa7cSTomi Valkeinen 258ac767456SLaurent Pinchart hdmi->cfg.vm = *vm; 2599960aa7cSTomi Valkeinen 260ac767456SLaurent Pinchart dispc_set_tv_pclk(hdmi->dss->dispc, vm->pixelclock); 261ac767456SLaurent Pinchart 262ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 2639960aa7cSTomi Valkeinen } 2649960aa7cSTomi Valkeinen 265f33656e1SLaurent Pinchart static int hdmi_dump_regs(struct seq_file *s, void *p) 2669960aa7cSTomi Valkeinen { 267ac767456SLaurent Pinchart struct omap_hdmi *hdmi = s->private; 2689960aa7cSTomi Valkeinen 269ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 270ac767456SLaurent Pinchart 271ac767456SLaurent Pinchart if (hdmi_runtime_get(hdmi)) { 272ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 273f33656e1SLaurent Pinchart return 0; 2749960aa7cSTomi Valkeinen } 2759960aa7cSTomi Valkeinen 276ac767456SLaurent Pinchart hdmi_wp_dump(&hdmi->wp, s); 277ac767456SLaurent Pinchart hdmi_pll_dump(&hdmi->pll, s); 278ac767456SLaurent Pinchart hdmi_phy_dump(&hdmi->phy, s); 279ac767456SLaurent Pinchart hdmi4_core_dump(&hdmi->core, s); 2809960aa7cSTomi Valkeinen 281ac767456SLaurent Pinchart hdmi_runtime_put(hdmi); 282ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 283f33656e1SLaurent Pinchart return 0; 2849960aa7cSTomi Valkeinen } 2859960aa7cSTomi Valkeinen 286ac767456SLaurent Pinchart static int read_edid(struct omap_hdmi *hdmi, u8 *buf, int len) 2879960aa7cSTomi Valkeinen { 2889960aa7cSTomi Valkeinen int r; 2899960aa7cSTomi Valkeinen 290ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 2919960aa7cSTomi Valkeinen 292ac767456SLaurent Pinchart r = hdmi_runtime_get(hdmi); 2939960aa7cSTomi Valkeinen BUG_ON(r); 2949960aa7cSTomi Valkeinen 295ac767456SLaurent Pinchart r = hdmi4_read_edid(&hdmi->core, buf, len); 2969960aa7cSTomi Valkeinen 297ac767456SLaurent Pinchart hdmi_runtime_put(hdmi); 298ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 2999960aa7cSTomi Valkeinen 3009960aa7cSTomi Valkeinen return r; 3019960aa7cSTomi Valkeinen } 3029960aa7cSTomi Valkeinen 3039960aa7cSTomi Valkeinen static void hdmi_start_audio_stream(struct omap_hdmi *hd) 3049960aa7cSTomi Valkeinen { 3059960aa7cSTomi Valkeinen hdmi_wp_audio_enable(&hd->wp, true); 3069960aa7cSTomi Valkeinen hdmi4_audio_start(&hd->core, &hd->wp); 3079960aa7cSTomi Valkeinen } 3089960aa7cSTomi Valkeinen 3099960aa7cSTomi Valkeinen static void hdmi_stop_audio_stream(struct omap_hdmi *hd) 3109960aa7cSTomi Valkeinen { 3119960aa7cSTomi Valkeinen hdmi4_audio_stop(&hd->core, &hd->wp); 3129960aa7cSTomi Valkeinen hdmi_wp_audio_enable(&hd->wp, false); 3139960aa7cSTomi Valkeinen } 3149960aa7cSTomi Valkeinen 31519b4200dSLaurent Pinchart static void hdmi_display_enable(struct omap_dss_device *dssdev) 3169960aa7cSTomi Valkeinen { 317ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 3189960aa7cSTomi Valkeinen unsigned long flags; 31919b4200dSLaurent Pinchart int r; 3209960aa7cSTomi Valkeinen 3219960aa7cSTomi Valkeinen DSSDBG("ENTER hdmi_display_enable\n"); 3229960aa7cSTomi Valkeinen 323ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 3249960aa7cSTomi Valkeinen 325ac767456SLaurent Pinchart r = hdmi_power_on_full(hdmi); 3269960aa7cSTomi Valkeinen if (r) { 3279960aa7cSTomi Valkeinen DSSERR("failed to power on device\n"); 32819b4200dSLaurent Pinchart goto done; 3299960aa7cSTomi Valkeinen } 3309960aa7cSTomi Valkeinen 331ac767456SLaurent Pinchart if (hdmi->audio_configured) { 332ac767456SLaurent Pinchart r = hdmi4_audio_config(&hdmi->core, &hdmi->wp, 333ac767456SLaurent Pinchart &hdmi->audio_config, 334ac767456SLaurent Pinchart hdmi->cfg.vm.pixelclock); 3359960aa7cSTomi Valkeinen if (r) { 3369960aa7cSTomi Valkeinen DSSERR("Error restoring audio configuration: %d", r); 337ac767456SLaurent Pinchart hdmi->audio_abort_cb(&hdmi->pdev->dev); 338ac767456SLaurent Pinchart hdmi->audio_configured = false; 3399960aa7cSTomi Valkeinen } 3409960aa7cSTomi Valkeinen } 3419960aa7cSTomi Valkeinen 342ac767456SLaurent Pinchart spin_lock_irqsave(&hdmi->audio_playing_lock, flags); 343ac767456SLaurent Pinchart if (hdmi->audio_configured && hdmi->audio_playing) 344ac767456SLaurent Pinchart hdmi_start_audio_stream(hdmi); 345ac767456SLaurent Pinchart hdmi->display_enabled = true; 346ac767456SLaurent Pinchart spin_unlock_irqrestore(&hdmi->audio_playing_lock, flags); 3479960aa7cSTomi Valkeinen 34819b4200dSLaurent Pinchart done: 349ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 3509960aa7cSTomi Valkeinen } 3519960aa7cSTomi Valkeinen 3529960aa7cSTomi Valkeinen static void hdmi_display_disable(struct omap_dss_device *dssdev) 3539960aa7cSTomi Valkeinen { 354ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 3559960aa7cSTomi Valkeinen unsigned long flags; 3569960aa7cSTomi Valkeinen 3579960aa7cSTomi Valkeinen DSSDBG("Enter hdmi_display_disable\n"); 3589960aa7cSTomi Valkeinen 359ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 3609960aa7cSTomi Valkeinen 361ac767456SLaurent Pinchart spin_lock_irqsave(&hdmi->audio_playing_lock, flags); 362ac767456SLaurent Pinchart hdmi_stop_audio_stream(hdmi); 363ac767456SLaurent Pinchart hdmi->display_enabled = false; 364ac767456SLaurent Pinchart spin_unlock_irqrestore(&hdmi->audio_playing_lock, flags); 3659960aa7cSTomi Valkeinen 366ac767456SLaurent Pinchart hdmi_power_off_full(hdmi); 3679960aa7cSTomi Valkeinen 368ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 3699960aa7cSTomi Valkeinen } 3709960aa7cSTomi Valkeinen 371ac767456SLaurent Pinchart int hdmi4_core_enable(struct hdmi_core_data *core) 3729960aa7cSTomi Valkeinen { 373ac767456SLaurent Pinchart struct omap_hdmi *hdmi = container_of(core, struct omap_hdmi, core); 3749960aa7cSTomi Valkeinen int r = 0; 3759960aa7cSTomi Valkeinen 3765bebbbfeSHans Verkuil DSSDBG("ENTER omapdss_hdmi4_core_enable\n"); 3779960aa7cSTomi Valkeinen 378ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 3799960aa7cSTomi Valkeinen 380ac767456SLaurent Pinchart r = hdmi_power_on_core(hdmi); 3819960aa7cSTomi Valkeinen if (r) { 3829960aa7cSTomi Valkeinen DSSERR("failed to power on device\n"); 3839960aa7cSTomi Valkeinen goto err0; 3849960aa7cSTomi Valkeinen } 3859960aa7cSTomi Valkeinen 386ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 3879960aa7cSTomi Valkeinen return 0; 3889960aa7cSTomi Valkeinen 3899960aa7cSTomi Valkeinen err0: 390ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 3919960aa7cSTomi Valkeinen return r; 3929960aa7cSTomi Valkeinen } 3939960aa7cSTomi Valkeinen 394ac767456SLaurent Pinchart void hdmi4_core_disable(struct hdmi_core_data *core) 3959960aa7cSTomi Valkeinen { 396ac767456SLaurent Pinchart struct omap_hdmi *hdmi = container_of(core, struct omap_hdmi, core); 397ac767456SLaurent Pinchart 3985bebbbfeSHans Verkuil DSSDBG("Enter omapdss_hdmi4_core_disable\n"); 3999960aa7cSTomi Valkeinen 400ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 4019960aa7cSTomi Valkeinen 402ac767456SLaurent Pinchart hdmi_power_off_core(hdmi); 4039960aa7cSTomi Valkeinen 404ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 4059960aa7cSTomi Valkeinen } 4069960aa7cSTomi Valkeinen 407511afb44SLaurent Pinchart static int hdmi_connect(struct omap_dss_device *src, 4089960aa7cSTomi Valkeinen struct omap_dss_device *dst) 4099960aa7cSTomi Valkeinen { 410f8a8eabbSLaurent Pinchart return omapdss_device_connect(dst->dss, dst, dst->next); 41171316556SLaurent Pinchart } 41271316556SLaurent Pinchart 413511afb44SLaurent Pinchart static void hdmi_disconnect(struct omap_dss_device *src, 4149960aa7cSTomi Valkeinen struct omap_dss_device *dst) 4159960aa7cSTomi Valkeinen { 416511afb44SLaurent Pinchart omapdss_device_disconnect(dst, dst->next); 4179960aa7cSTomi Valkeinen } 4189960aa7cSTomi Valkeinen 4199960aa7cSTomi Valkeinen static int hdmi_read_edid(struct omap_dss_device *dssdev, 4209960aa7cSTomi Valkeinen u8 *edid, int len) 4219960aa7cSTomi Valkeinen { 422ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 4239960aa7cSTomi Valkeinen bool need_enable; 4249960aa7cSTomi Valkeinen int r; 4259960aa7cSTomi Valkeinen 426ac767456SLaurent Pinchart need_enable = hdmi->core_enabled == false; 4279960aa7cSTomi Valkeinen 4289960aa7cSTomi Valkeinen if (need_enable) { 429ac767456SLaurent Pinchart r = hdmi4_core_enable(&hdmi->core); 4309960aa7cSTomi Valkeinen if (r) 4319960aa7cSTomi Valkeinen return r; 4329960aa7cSTomi Valkeinen } 4339960aa7cSTomi Valkeinen 434ac767456SLaurent Pinchart r = read_edid(hdmi, edid, len); 4351897e1a3SHans Verkuil if (r >= 256) 436ac767456SLaurent Pinchart hdmi4_cec_set_phys_addr(&hdmi->core, 4371897e1a3SHans Verkuil cec_get_edid_phys_addr(edid, r, NULL)); 4381897e1a3SHans Verkuil else 439ac767456SLaurent Pinchart hdmi4_cec_set_phys_addr(&hdmi->core, CEC_PHYS_ADDR_INVALID); 4409960aa7cSTomi Valkeinen if (need_enable) 441ac767456SLaurent Pinchart hdmi4_core_disable(&hdmi->core); 4429960aa7cSTomi Valkeinen 4439960aa7cSTomi Valkeinen return r; 4449960aa7cSTomi Valkeinen } 4459960aa7cSTomi Valkeinen 446019114efSHans Verkuil static void hdmi_lost_hotplug(struct omap_dss_device *dssdev) 447019114efSHans Verkuil { 448ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 449ac767456SLaurent Pinchart 450ac767456SLaurent Pinchart hdmi4_cec_set_phys_addr(&hdmi->core, CEC_PHYS_ADDR_INVALID); 451019114efSHans Verkuil } 452019114efSHans Verkuil 4539960aa7cSTomi Valkeinen static int hdmi_set_infoframe(struct omap_dss_device *dssdev, 4549960aa7cSTomi Valkeinen const struct hdmi_avi_infoframe *avi) 4559960aa7cSTomi Valkeinen { 456ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 457ac767456SLaurent Pinchart 458ac767456SLaurent Pinchart hdmi->cfg.infoframe = *avi; 4599960aa7cSTomi Valkeinen return 0; 4609960aa7cSTomi Valkeinen } 4619960aa7cSTomi Valkeinen 4629960aa7cSTomi Valkeinen static int hdmi_set_hdmi_mode(struct omap_dss_device *dssdev, 4639960aa7cSTomi Valkeinen bool hdmi_mode) 4649960aa7cSTomi Valkeinen { 465ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 466ac767456SLaurent Pinchart 467ac767456SLaurent Pinchart hdmi->cfg.hdmi_dvi_mode = hdmi_mode ? HDMI_HDMI : HDMI_DVI; 4689960aa7cSTomi Valkeinen return 0; 4699960aa7cSTomi Valkeinen } 4709960aa7cSTomi Valkeinen 471b93109d7SLaurent Pinchart static const struct omap_dss_device_ops hdmi_ops = { 4729960aa7cSTomi Valkeinen .connect = hdmi_connect, 4739960aa7cSTomi Valkeinen .disconnect = hdmi_disconnect, 4749960aa7cSTomi Valkeinen 4759960aa7cSTomi Valkeinen .enable = hdmi_display_enable, 4769960aa7cSTomi Valkeinen .disable = hdmi_display_disable, 4779960aa7cSTomi Valkeinen 478ec68cd5aSLaurent Pinchart .set_timings = hdmi_display_set_timings, 4799960aa7cSTomi Valkeinen 4809960aa7cSTomi Valkeinen .read_edid = hdmi_read_edid, 48183910ad3SLaurent Pinchart 48283910ad3SLaurent Pinchart .hdmi = { 483019114efSHans Verkuil .lost_hotplug = hdmi_lost_hotplug, 4849960aa7cSTomi Valkeinen .set_infoframe = hdmi_set_infoframe, 4859960aa7cSTomi Valkeinen .set_hdmi_mode = hdmi_set_hdmi_mode, 486b93109d7SLaurent Pinchart }, 4879960aa7cSTomi Valkeinen }; 4889960aa7cSTomi Valkeinen 4895fc15d98SLaurent Pinchart /* ----------------------------------------------------------------------------- 4905fc15d98SLaurent Pinchart * Audio Callbacks 4915fc15d98SLaurent Pinchart */ 4929960aa7cSTomi Valkeinen 4939960aa7cSTomi Valkeinen static int hdmi_audio_startup(struct device *dev, 4949960aa7cSTomi Valkeinen void (*abort_cb)(struct device *dev)) 4959960aa7cSTomi Valkeinen { 4969960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 4979960aa7cSTomi Valkeinen 4989960aa7cSTomi Valkeinen mutex_lock(&hd->lock); 4999960aa7cSTomi Valkeinen 500c1899cb3SJyri Sarha WARN_ON(hd->audio_abort_cb != NULL); 5019960aa7cSTomi Valkeinen 5029960aa7cSTomi Valkeinen hd->audio_abort_cb = abort_cb; 5039960aa7cSTomi Valkeinen 5049960aa7cSTomi Valkeinen mutex_unlock(&hd->lock); 5059960aa7cSTomi Valkeinen 506c1899cb3SJyri Sarha return 0; 5079960aa7cSTomi Valkeinen } 5089960aa7cSTomi Valkeinen 5099960aa7cSTomi Valkeinen static int hdmi_audio_shutdown(struct device *dev) 5109960aa7cSTomi Valkeinen { 5119960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 5129960aa7cSTomi Valkeinen 5139960aa7cSTomi Valkeinen mutex_lock(&hd->lock); 5149960aa7cSTomi Valkeinen hd->audio_abort_cb = NULL; 5159960aa7cSTomi Valkeinen hd->audio_configured = false; 5169960aa7cSTomi Valkeinen hd->audio_playing = false; 5179960aa7cSTomi Valkeinen mutex_unlock(&hd->lock); 5189960aa7cSTomi Valkeinen 5199960aa7cSTomi Valkeinen return 0; 5209960aa7cSTomi Valkeinen } 5219960aa7cSTomi Valkeinen 5229960aa7cSTomi Valkeinen static int hdmi_audio_start(struct device *dev) 5239960aa7cSTomi Valkeinen { 5249960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 5259960aa7cSTomi Valkeinen unsigned long flags; 5269960aa7cSTomi Valkeinen 5279960aa7cSTomi Valkeinen spin_lock_irqsave(&hd->audio_playing_lock, flags); 5289960aa7cSTomi Valkeinen 529c1899cb3SJyri Sarha if (hd->display_enabled) { 530c1899cb3SJyri Sarha if (!hdmi_mode_has_audio(&hd->cfg)) 531c1899cb3SJyri Sarha DSSERR("%s: Video mode does not support audio\n", 532c1899cb3SJyri Sarha __func__); 5339960aa7cSTomi Valkeinen hdmi_start_audio_stream(hd); 534c1899cb3SJyri Sarha } 5359960aa7cSTomi Valkeinen hd->audio_playing = true; 5369960aa7cSTomi Valkeinen 5379960aa7cSTomi Valkeinen spin_unlock_irqrestore(&hd->audio_playing_lock, flags); 5389960aa7cSTomi Valkeinen return 0; 5399960aa7cSTomi Valkeinen } 5409960aa7cSTomi Valkeinen 5419960aa7cSTomi Valkeinen static void hdmi_audio_stop(struct device *dev) 5429960aa7cSTomi Valkeinen { 5439960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 5449960aa7cSTomi Valkeinen unsigned long flags; 5459960aa7cSTomi Valkeinen 5469960aa7cSTomi Valkeinen WARN_ON(!hdmi_mode_has_audio(&hd->cfg)); 5479960aa7cSTomi Valkeinen 5489960aa7cSTomi Valkeinen spin_lock_irqsave(&hd->audio_playing_lock, flags); 5499960aa7cSTomi Valkeinen 5509960aa7cSTomi Valkeinen if (hd->display_enabled) 5519960aa7cSTomi Valkeinen hdmi_stop_audio_stream(hd); 5529960aa7cSTomi Valkeinen hd->audio_playing = false; 5539960aa7cSTomi Valkeinen 5549960aa7cSTomi Valkeinen spin_unlock_irqrestore(&hd->audio_playing_lock, flags); 5559960aa7cSTomi Valkeinen } 5569960aa7cSTomi Valkeinen 5579960aa7cSTomi Valkeinen static int hdmi_audio_config(struct device *dev, 5589960aa7cSTomi Valkeinen struct omap_dss_audio *dss_audio) 5599960aa7cSTomi Valkeinen { 5609960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 56177eeac24STomi Valkeinen int ret = 0; 5629960aa7cSTomi Valkeinen 5639960aa7cSTomi Valkeinen mutex_lock(&hd->lock); 5649960aa7cSTomi Valkeinen 565c1899cb3SJyri Sarha if (hd->display_enabled) { 566c1899cb3SJyri Sarha ret = hdmi4_audio_config(&hd->core, &hd->wp, dss_audio, 567c1899cb3SJyri Sarha hd->cfg.vm.pixelclock); 568c1899cb3SJyri Sarha if (ret) 5699960aa7cSTomi Valkeinen goto out; 5709960aa7cSTomi Valkeinen } 5719960aa7cSTomi Valkeinen 5729960aa7cSTomi Valkeinen hd->audio_configured = true; 5739960aa7cSTomi Valkeinen hd->audio_config = *dss_audio; 5749960aa7cSTomi Valkeinen out: 5759960aa7cSTomi Valkeinen mutex_unlock(&hd->lock); 5769960aa7cSTomi Valkeinen 5779960aa7cSTomi Valkeinen return ret; 5789960aa7cSTomi Valkeinen } 5799960aa7cSTomi Valkeinen 5809960aa7cSTomi Valkeinen static const struct omap_hdmi_audio_ops hdmi_audio_ops = { 5819960aa7cSTomi Valkeinen .audio_startup = hdmi_audio_startup, 5829960aa7cSTomi Valkeinen .audio_shutdown = hdmi_audio_shutdown, 5839960aa7cSTomi Valkeinen .audio_start = hdmi_audio_start, 5849960aa7cSTomi Valkeinen .audio_stop = hdmi_audio_stop, 5859960aa7cSTomi Valkeinen .audio_config = hdmi_audio_config, 5869960aa7cSTomi Valkeinen }; 5879960aa7cSTomi Valkeinen 588ac767456SLaurent Pinchart static int hdmi_audio_register(struct omap_hdmi *hdmi) 5899960aa7cSTomi Valkeinen { 5909960aa7cSTomi Valkeinen struct omap_hdmi_audio_pdata pdata = { 591ac767456SLaurent Pinchart .dev = &hdmi->pdev->dev, 592d20fa5a0SLaurent Pinchart .version = 4, 593ac767456SLaurent Pinchart .audio_dma_addr = hdmi_wp_get_audio_dma_addr(&hdmi->wp), 5949960aa7cSTomi Valkeinen .ops = &hdmi_audio_ops, 5959960aa7cSTomi Valkeinen }; 5969960aa7cSTomi Valkeinen 597ac767456SLaurent Pinchart hdmi->audio_pdev = platform_device_register_data( 598ac767456SLaurent Pinchart &hdmi->pdev->dev, "omap-hdmi-audio", PLATFORM_DEVID_AUTO, 5999960aa7cSTomi Valkeinen &pdata, sizeof(pdata)); 6009960aa7cSTomi Valkeinen 601ac767456SLaurent Pinchart if (IS_ERR(hdmi->audio_pdev)) 602ac767456SLaurent Pinchart return PTR_ERR(hdmi->audio_pdev); 6039960aa7cSTomi Valkeinen 6049960aa7cSTomi Valkeinen return 0; 6059960aa7cSTomi Valkeinen } 6069960aa7cSTomi Valkeinen 6075fc15d98SLaurent Pinchart /* ----------------------------------------------------------------------------- 6085fc15d98SLaurent Pinchart * Component Bind & Unbind 6095fc15d98SLaurent Pinchart */ 6105fc15d98SLaurent Pinchart 6119960aa7cSTomi Valkeinen static int hdmi4_bind(struct device *dev, struct device *master, void *data) 6129960aa7cSTomi Valkeinen { 6137b295257SLaurent Pinchart struct dss_device *dss = dss_get_device(master); 6145fc15d98SLaurent Pinchart struct omap_hdmi *hdmi = dev_get_drvdata(dev); 6159960aa7cSTomi Valkeinen int r; 6169960aa7cSTomi Valkeinen 617ac767456SLaurent Pinchart hdmi->dss = dss; 6189960aa7cSTomi Valkeinen 619f8523b64SLaurent Pinchart r = hdmi_runtime_get(hdmi); 6209960aa7cSTomi Valkeinen if (r) 6215fc15d98SLaurent Pinchart return r; 6229960aa7cSTomi Valkeinen 623f8523b64SLaurent Pinchart r = hdmi_pll_init(dss, hdmi->pdev, &hdmi->pll, &hdmi->wp); 624f8523b64SLaurent Pinchart if (r) 625f8523b64SLaurent Pinchart goto err_runtime_put; 626f8523b64SLaurent Pinchart 6275fc15d98SLaurent Pinchart r = hdmi4_cec_init(hdmi->pdev, &hdmi->core, &hdmi->wp); 6289960aa7cSTomi Valkeinen if (r) 6295fc15d98SLaurent Pinchart goto err_pll_uninit; 6309960aa7cSTomi Valkeinen 631ac767456SLaurent Pinchart r = hdmi_audio_register(hdmi); 6329960aa7cSTomi Valkeinen if (r) { 6339960aa7cSTomi Valkeinen DSSERR("Registering HDMI audio failed\n"); 6345fc15d98SLaurent Pinchart goto err_cec_uninit; 6359960aa7cSTomi Valkeinen } 6369960aa7cSTomi Valkeinen 637ac767456SLaurent Pinchart hdmi->debugfs = dss_debugfs_create_file(dss, "hdmi", hdmi_dump_regs, 638ac767456SLaurent Pinchart hdmi); 6399960aa7cSTomi Valkeinen 640f8523b64SLaurent Pinchart hdmi_runtime_put(hdmi); 641f8523b64SLaurent Pinchart 6429960aa7cSTomi Valkeinen return 0; 643ac767456SLaurent Pinchart 6445fc15d98SLaurent Pinchart err_cec_uninit: 6455fc15d98SLaurent Pinchart hdmi4_cec_uninit(&hdmi->core); 6465fc15d98SLaurent Pinchart err_pll_uninit: 647ac767456SLaurent Pinchart hdmi_pll_uninit(&hdmi->pll); 648f8523b64SLaurent Pinchart err_runtime_put: 649f8523b64SLaurent Pinchart hdmi_runtime_put(hdmi); 6509960aa7cSTomi Valkeinen return r; 6519960aa7cSTomi Valkeinen } 6529960aa7cSTomi Valkeinen 6539960aa7cSTomi Valkeinen static void hdmi4_unbind(struct device *dev, struct device *master, void *data) 6549960aa7cSTomi Valkeinen { 655ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dev_get_drvdata(dev); 6569960aa7cSTomi Valkeinen 657ac767456SLaurent Pinchart dss_debugfs_remove_file(hdmi->debugfs); 658f33656e1SLaurent Pinchart 659ac767456SLaurent Pinchart if (hdmi->audio_pdev) 660ac767456SLaurent Pinchart platform_device_unregister(hdmi->audio_pdev); 6619960aa7cSTomi Valkeinen 662ac767456SLaurent Pinchart hdmi4_cec_uninit(&hdmi->core); 663ac767456SLaurent Pinchart hdmi_pll_uninit(&hdmi->pll); 6649960aa7cSTomi Valkeinen } 6659960aa7cSTomi Valkeinen 6669960aa7cSTomi Valkeinen static const struct component_ops hdmi4_component_ops = { 6679960aa7cSTomi Valkeinen .bind = hdmi4_bind, 6689960aa7cSTomi Valkeinen .unbind = hdmi4_unbind, 6699960aa7cSTomi Valkeinen }; 6709960aa7cSTomi Valkeinen 6715fc15d98SLaurent Pinchart /* ----------------------------------------------------------------------------- 6725fc15d98SLaurent Pinchart * Probe & Remove, Suspend & Resume 6735fc15d98SLaurent Pinchart */ 6745fc15d98SLaurent Pinchart 67527d62452SLaurent Pinchart static int hdmi4_init_output(struct omap_hdmi *hdmi) 6765fc15d98SLaurent Pinchart { 6775fc15d98SLaurent Pinchart struct omap_dss_device *out = &hdmi->output; 67871316556SLaurent Pinchart int r; 6795fc15d98SLaurent Pinchart 6805fc15d98SLaurent Pinchart out->dev = &hdmi->pdev->dev; 6815fc15d98SLaurent Pinchart out->id = OMAP_DSS_OUTPUT_HDMI; 6825fc15d98SLaurent Pinchart out->output_type = OMAP_DISPLAY_TYPE_HDMI; 6835fc15d98SLaurent Pinchart out->name = "hdmi.0"; 6845fc15d98SLaurent Pinchart out->dispc_channel = OMAP_DSS_CHANNEL_DIGIT; 6855fc15d98SLaurent Pinchart out->ops = &hdmi_ops; 6865fc15d98SLaurent Pinchart out->owner = THIS_MODULE; 6875fc15d98SLaurent Pinchart out->of_ports = BIT(0); 68890279e95SLaurent Pinchart out->ops_flags = OMAP_DSS_DEVICE_OP_EDID; 6895fc15d98SLaurent Pinchart 690*d17eb453SLaurent Pinchart r = omapdss_device_init_output(out); 691*d17eb453SLaurent Pinchart if (r < 0) 69271316556SLaurent Pinchart return r; 69371316556SLaurent Pinchart 6945fc15d98SLaurent Pinchart omapdss_device_register(out); 69527d62452SLaurent Pinchart 69627d62452SLaurent Pinchart return 0; 6975fc15d98SLaurent Pinchart } 6985fc15d98SLaurent Pinchart 6995fc15d98SLaurent Pinchart static void hdmi4_uninit_output(struct omap_hdmi *hdmi) 7005fc15d98SLaurent Pinchart { 7015fc15d98SLaurent Pinchart struct omap_dss_device *out = &hdmi->output; 7025fc15d98SLaurent Pinchart 7035fc15d98SLaurent Pinchart omapdss_device_unregister(out); 704*d17eb453SLaurent Pinchart omapdss_device_cleanup_output(out); 7055fc15d98SLaurent Pinchart } 7065fc15d98SLaurent Pinchart 7075fc15d98SLaurent Pinchart static int hdmi4_probe_of(struct omap_hdmi *hdmi) 7085fc15d98SLaurent Pinchart { 7095fc15d98SLaurent Pinchart struct platform_device *pdev = hdmi->pdev; 7105fc15d98SLaurent Pinchart struct device_node *node = pdev->dev.of_node; 7115fc15d98SLaurent Pinchart struct device_node *ep; 7125fc15d98SLaurent Pinchart int r; 7135fc15d98SLaurent Pinchart 7145fc15d98SLaurent Pinchart ep = of_graph_get_endpoint_by_regs(node, 0, 0); 7155fc15d98SLaurent Pinchart if (!ep) 7165fc15d98SLaurent Pinchart return 0; 7175fc15d98SLaurent Pinchart 7185fc15d98SLaurent Pinchart r = hdmi_parse_lanes_of(pdev, ep, &hdmi->phy); 7195fc15d98SLaurent Pinchart of_node_put(ep); 7205fc15d98SLaurent Pinchart return r; 7215fc15d98SLaurent Pinchart } 7225fc15d98SLaurent Pinchart 7239960aa7cSTomi Valkeinen static int hdmi4_probe(struct platform_device *pdev) 7249960aa7cSTomi Valkeinen { 7255fc15d98SLaurent Pinchart struct omap_hdmi *hdmi; 7265fc15d98SLaurent Pinchart int irq; 7275fc15d98SLaurent Pinchart int r; 7285fc15d98SLaurent Pinchart 7295fc15d98SLaurent Pinchart hdmi = kzalloc(sizeof(*hdmi), GFP_KERNEL); 7305fc15d98SLaurent Pinchart if (!hdmi) 7315fc15d98SLaurent Pinchart return -ENOMEM; 7325fc15d98SLaurent Pinchart 7335fc15d98SLaurent Pinchart hdmi->pdev = pdev; 7345fc15d98SLaurent Pinchart 7355fc15d98SLaurent Pinchart dev_set_drvdata(&pdev->dev, hdmi); 7365fc15d98SLaurent Pinchart 7375fc15d98SLaurent Pinchart mutex_init(&hdmi->lock); 7385fc15d98SLaurent Pinchart spin_lock_init(&hdmi->audio_playing_lock); 7395fc15d98SLaurent Pinchart 7405fc15d98SLaurent Pinchart r = hdmi4_probe_of(hdmi); 7415fc15d98SLaurent Pinchart if (r) 7425fc15d98SLaurent Pinchart goto err_free; 7435fc15d98SLaurent Pinchart 7445fc15d98SLaurent Pinchart r = hdmi_wp_init(pdev, &hdmi->wp, 4); 7455fc15d98SLaurent Pinchart if (r) 7465fc15d98SLaurent Pinchart goto err_free; 7475fc15d98SLaurent Pinchart 7485fc15d98SLaurent Pinchart r = hdmi_phy_init(pdev, &hdmi->phy, 4); 7495fc15d98SLaurent Pinchart if (r) 7505fc15d98SLaurent Pinchart goto err_free; 7515fc15d98SLaurent Pinchart 7525fc15d98SLaurent Pinchart r = hdmi4_core_init(pdev, &hdmi->core); 7535fc15d98SLaurent Pinchart if (r) 7545fc15d98SLaurent Pinchart goto err_free; 7555fc15d98SLaurent Pinchart 7565fc15d98SLaurent Pinchart irq = platform_get_irq(pdev, 0); 7575fc15d98SLaurent Pinchart if (irq < 0) { 7585fc15d98SLaurent Pinchart DSSERR("platform_get_irq failed\n"); 7595fc15d98SLaurent Pinchart r = -ENODEV; 7605fc15d98SLaurent Pinchart goto err_free; 7615fc15d98SLaurent Pinchart } 7625fc15d98SLaurent Pinchart 7635fc15d98SLaurent Pinchart r = devm_request_threaded_irq(&pdev->dev, irq, 7645fc15d98SLaurent Pinchart NULL, hdmi_irq_handler, 7655fc15d98SLaurent Pinchart IRQF_ONESHOT, "OMAP HDMI", hdmi); 7665fc15d98SLaurent Pinchart if (r) { 7675fc15d98SLaurent Pinchart DSSERR("HDMI IRQ request failed\n"); 7685fc15d98SLaurent Pinchart goto err_free; 7695fc15d98SLaurent Pinchart } 7705fc15d98SLaurent Pinchart 7718a36357aSLaurent Pinchart hdmi->vdda_reg = devm_regulator_get(&pdev->dev, "vdda"); 7728a36357aSLaurent Pinchart if (IS_ERR(hdmi->vdda_reg)) { 7738a36357aSLaurent Pinchart r = PTR_ERR(hdmi->vdda_reg); 7748a36357aSLaurent Pinchart if (r != -EPROBE_DEFER) 7758a36357aSLaurent Pinchart DSSERR("can't get VDDA regulator\n"); 7768a36357aSLaurent Pinchart goto err_free; 7778a36357aSLaurent Pinchart } 7788a36357aSLaurent Pinchart 7795fc15d98SLaurent Pinchart pm_runtime_enable(&pdev->dev); 7805fc15d98SLaurent Pinchart 78127d62452SLaurent Pinchart r = hdmi4_init_output(hdmi); 78227d62452SLaurent Pinchart if (r) 78327d62452SLaurent Pinchart goto err_pm_disable; 7845fc15d98SLaurent Pinchart 7855fc15d98SLaurent Pinchart r = component_add(&pdev->dev, &hdmi4_component_ops); 7865fc15d98SLaurent Pinchart if (r) 7875fc15d98SLaurent Pinchart goto err_uninit_output; 7885fc15d98SLaurent Pinchart 7895fc15d98SLaurent Pinchart return 0; 7905fc15d98SLaurent Pinchart 7915fc15d98SLaurent Pinchart err_uninit_output: 7925fc15d98SLaurent Pinchart hdmi4_uninit_output(hdmi); 79327d62452SLaurent Pinchart err_pm_disable: 7945fc15d98SLaurent Pinchart pm_runtime_disable(&pdev->dev); 7955fc15d98SLaurent Pinchart err_free: 7965fc15d98SLaurent Pinchart kfree(hdmi); 7975fc15d98SLaurent Pinchart return r; 7989960aa7cSTomi Valkeinen } 7999960aa7cSTomi Valkeinen 8009960aa7cSTomi Valkeinen static int hdmi4_remove(struct platform_device *pdev) 8019960aa7cSTomi Valkeinen { 8025fc15d98SLaurent Pinchart struct omap_hdmi *hdmi = platform_get_drvdata(pdev); 8035fc15d98SLaurent Pinchart 8049960aa7cSTomi Valkeinen component_del(&pdev->dev, &hdmi4_component_ops); 8055fc15d98SLaurent Pinchart 8065fc15d98SLaurent Pinchart hdmi4_uninit_output(hdmi); 8075fc15d98SLaurent Pinchart 8085fc15d98SLaurent Pinchart pm_runtime_disable(&pdev->dev); 8095fc15d98SLaurent Pinchart 8105fc15d98SLaurent Pinchart kfree(hdmi); 8119960aa7cSTomi Valkeinen return 0; 8129960aa7cSTomi Valkeinen } 8139960aa7cSTomi Valkeinen 8149960aa7cSTomi Valkeinen static const struct of_device_id hdmi_of_match[] = { 8159960aa7cSTomi Valkeinen { .compatible = "ti,omap4-hdmi", }, 8169960aa7cSTomi Valkeinen {}, 8179960aa7cSTomi Valkeinen }; 8189960aa7cSTomi Valkeinen 819d66c36a3SAndrew F. Davis struct platform_driver omapdss_hdmi4hw_driver = { 8209960aa7cSTomi Valkeinen .probe = hdmi4_probe, 8219960aa7cSTomi Valkeinen .remove = hdmi4_remove, 8229960aa7cSTomi Valkeinen .driver = { 8239960aa7cSTomi Valkeinen .name = "omapdss_hdmi", 8249960aa7cSTomi Valkeinen .of_match_table = hdmi_of_match, 8259960aa7cSTomi Valkeinen .suppress_bind_attrs = true, 8269960aa7cSTomi Valkeinen }, 8279960aa7cSTomi Valkeinen }; 828