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_init_regulator(struct omap_hdmi *hdmi) 1129960aa7cSTomi Valkeinen { 1139960aa7cSTomi Valkeinen struct regulator *reg; 1149960aa7cSTomi Valkeinen 115ac767456SLaurent Pinchart if (hdmi->vdda_reg != NULL) 1169960aa7cSTomi Valkeinen return 0; 1179960aa7cSTomi Valkeinen 118ac767456SLaurent Pinchart reg = devm_regulator_get(&hdmi->pdev->dev, "vdda"); 1199960aa7cSTomi Valkeinen 1209960aa7cSTomi Valkeinen if (IS_ERR(reg)) { 1219960aa7cSTomi Valkeinen if (PTR_ERR(reg) != -EPROBE_DEFER) 1229960aa7cSTomi Valkeinen DSSERR("can't get VDDA regulator\n"); 1239960aa7cSTomi Valkeinen return PTR_ERR(reg); 1249960aa7cSTomi Valkeinen } 1259960aa7cSTomi Valkeinen 126ac767456SLaurent Pinchart hdmi->vdda_reg = reg; 1279960aa7cSTomi Valkeinen 1289960aa7cSTomi Valkeinen return 0; 1299960aa7cSTomi Valkeinen } 1309960aa7cSTomi Valkeinen 131ac767456SLaurent Pinchart static int hdmi_power_on_core(struct omap_hdmi *hdmi) 1329960aa7cSTomi Valkeinen { 1339960aa7cSTomi Valkeinen int r; 1349960aa7cSTomi Valkeinen 135ac767456SLaurent Pinchart if (hdmi->core.core_pwr_cnt++) 136a141a296SHans Verkuil return 0; 137a141a296SHans Verkuil 138ac767456SLaurent Pinchart r = regulator_enable(hdmi->vdda_reg); 1399960aa7cSTomi Valkeinen if (r) 140a141a296SHans Verkuil goto err_reg_enable; 1419960aa7cSTomi Valkeinen 142ac767456SLaurent Pinchart r = hdmi_runtime_get(hdmi); 1439960aa7cSTomi Valkeinen if (r) 1449960aa7cSTomi Valkeinen goto err_runtime_get; 1459960aa7cSTomi Valkeinen 146ac767456SLaurent Pinchart hdmi4_core_powerdown_disable(&hdmi->core); 1471d54ecf2SHans Verkuil 1489960aa7cSTomi Valkeinen /* Make selection of HDMI in DSS */ 149ac767456SLaurent Pinchart dss_select_hdmi_venc_clk_source(hdmi->dss, DSS_HDMI_M_PCLK); 1509960aa7cSTomi Valkeinen 151ac767456SLaurent Pinchart hdmi->core_enabled = true; 1529960aa7cSTomi Valkeinen 1539960aa7cSTomi Valkeinen return 0; 1549960aa7cSTomi Valkeinen 1559960aa7cSTomi Valkeinen err_runtime_get: 156ac767456SLaurent Pinchart regulator_disable(hdmi->vdda_reg); 157a141a296SHans Verkuil err_reg_enable: 158ac767456SLaurent Pinchart hdmi->core.core_pwr_cnt--; 1599960aa7cSTomi Valkeinen 1609960aa7cSTomi Valkeinen return r; 1619960aa7cSTomi Valkeinen } 1629960aa7cSTomi Valkeinen 163ac767456SLaurent Pinchart static void hdmi_power_off_core(struct omap_hdmi *hdmi) 1649960aa7cSTomi Valkeinen { 165ac767456SLaurent Pinchart if (--hdmi->core.core_pwr_cnt) 166a141a296SHans Verkuil return; 167a141a296SHans Verkuil 168ac767456SLaurent Pinchart hdmi->core_enabled = false; 1699960aa7cSTomi Valkeinen 170ac767456SLaurent Pinchart hdmi_runtime_put(hdmi); 171ac767456SLaurent Pinchart regulator_disable(hdmi->vdda_reg); 1729960aa7cSTomi Valkeinen } 1739960aa7cSTomi Valkeinen 174ac767456SLaurent Pinchart static int hdmi_power_on_full(struct omap_hdmi *hdmi) 1759960aa7cSTomi Valkeinen { 1769960aa7cSTomi Valkeinen int r; 177da11bbbbSPeter Ujfalusi struct videomode *vm; 178ac767456SLaurent Pinchart struct hdmi_wp_data *wp = &hdmi->wp; 1799960aa7cSTomi Valkeinen struct dss_pll_clock_info hdmi_cinfo = { 0 }; 180d11e5c82SLaurent Pinchart unsigned int pc; 1819960aa7cSTomi Valkeinen 182ac767456SLaurent Pinchart r = hdmi_power_on_core(hdmi); 1839960aa7cSTomi Valkeinen if (r) 1849960aa7cSTomi Valkeinen return r; 1859960aa7cSTomi Valkeinen 1869960aa7cSTomi Valkeinen /* disable and clear irqs */ 187f3096a4aSHans Verkuil hdmi_wp_clear_irqenable(wp, ~HDMI_IRQ_CORE); 188f3096a4aSHans Verkuil hdmi_wp_set_irqstatus(wp, ~HDMI_IRQ_CORE); 1899960aa7cSTomi Valkeinen 190ac767456SLaurent Pinchart vm = &hdmi->cfg.vm; 1919960aa7cSTomi Valkeinen 192da11bbbbSPeter Ujfalusi DSSDBG("hdmi_power_on hactive= %d vactive = %d\n", vm->hactive, 193da11bbbbSPeter Ujfalusi vm->vactive); 1949960aa7cSTomi Valkeinen 195da11bbbbSPeter Ujfalusi pc = vm->pixelclock; 196da11bbbbSPeter Ujfalusi if (vm->flags & DISPLAY_FLAGS_DOUBLECLK) 19767d8ffddSTomi Valkeinen pc *= 2; 19867d8ffddSTomi Valkeinen 199c107751dSTomi Valkeinen /* DSS_HDMI_TCLK is bitclk / 10 */ 200c107751dSTomi Valkeinen pc *= 10; 201c107751dSTomi Valkeinen 202ac767456SLaurent Pinchart dss_pll_calc_b(&hdmi->pll.pll, clk_get_rate(hdmi->pll.pll.clkin), 203c17dc0e3STomi Valkeinen pc, &hdmi_cinfo); 2049960aa7cSTomi Valkeinen 205ac767456SLaurent Pinchart r = dss_pll_enable(&hdmi->pll.pll); 2069960aa7cSTomi Valkeinen if (r) { 2079960aa7cSTomi Valkeinen DSSERR("Failed to enable PLL\n"); 2089960aa7cSTomi Valkeinen goto err_pll_enable; 2099960aa7cSTomi Valkeinen } 2109960aa7cSTomi Valkeinen 211ac767456SLaurent Pinchart r = dss_pll_set_config(&hdmi->pll.pll, &hdmi_cinfo); 2129960aa7cSTomi Valkeinen if (r) { 2139960aa7cSTomi Valkeinen DSSERR("Failed to configure PLL\n"); 2149960aa7cSTomi Valkeinen goto err_pll_cfg; 2159960aa7cSTomi Valkeinen } 2169960aa7cSTomi Valkeinen 217ac767456SLaurent Pinchart r = hdmi_phy_configure(&hdmi->phy, hdmi_cinfo.clkdco, 2189960aa7cSTomi Valkeinen hdmi_cinfo.clkout[0]); 2199960aa7cSTomi Valkeinen if (r) { 2209960aa7cSTomi Valkeinen DSSDBG("Failed to configure PHY\n"); 2219960aa7cSTomi Valkeinen goto err_phy_cfg; 2229960aa7cSTomi Valkeinen } 2239960aa7cSTomi Valkeinen 2249960aa7cSTomi Valkeinen r = hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON); 2259960aa7cSTomi Valkeinen if (r) 2269960aa7cSTomi Valkeinen goto err_phy_pwr; 2279960aa7cSTomi Valkeinen 228ac767456SLaurent Pinchart hdmi4_configure(&hdmi->core, &hdmi->wp, &hdmi->cfg); 2299960aa7cSTomi Valkeinen 2309960aa7cSTomi Valkeinen /* tv size */ 231ac767456SLaurent Pinchart dss_mgr_set_timings(&hdmi->output, vm); 2329960aa7cSTomi Valkeinen 233ac767456SLaurent Pinchart r = dss_mgr_enable(&hdmi->output); 2349960aa7cSTomi Valkeinen if (r) 2359960aa7cSTomi Valkeinen goto err_mgr_enable; 2369960aa7cSTomi Valkeinen 237ac767456SLaurent Pinchart r = hdmi_wp_video_start(&hdmi->wp); 2384e4b53ceSTomi Valkeinen if (r) 2394e4b53ceSTomi Valkeinen goto err_vid_enable; 2404e4b53ceSTomi Valkeinen 2419960aa7cSTomi Valkeinen hdmi_wp_set_irqenable(wp, 2429960aa7cSTomi Valkeinen HDMI_IRQ_LINK_CONNECT | HDMI_IRQ_LINK_DISCONNECT); 2439960aa7cSTomi Valkeinen 2449960aa7cSTomi Valkeinen return 0; 2459960aa7cSTomi Valkeinen 2469960aa7cSTomi Valkeinen err_vid_enable: 247ac767456SLaurent Pinchart dss_mgr_disable(&hdmi->output); 2484e4b53ceSTomi Valkeinen err_mgr_enable: 249ac767456SLaurent Pinchart hdmi_wp_set_phy_pwr(&hdmi->wp, HDMI_PHYPWRCMD_OFF); 2509960aa7cSTomi Valkeinen err_phy_pwr: 2519960aa7cSTomi Valkeinen err_phy_cfg: 2529960aa7cSTomi Valkeinen err_pll_cfg: 253ac767456SLaurent Pinchart dss_pll_disable(&hdmi->pll.pll); 2549960aa7cSTomi Valkeinen err_pll_enable: 255ac767456SLaurent Pinchart hdmi_power_off_core(hdmi); 2569960aa7cSTomi Valkeinen return -EIO; 2579960aa7cSTomi Valkeinen } 2589960aa7cSTomi Valkeinen 259ac767456SLaurent Pinchart static void hdmi_power_off_full(struct omap_hdmi *hdmi) 2609960aa7cSTomi Valkeinen { 261ac767456SLaurent Pinchart hdmi_wp_clear_irqenable(&hdmi->wp, ~HDMI_IRQ_CORE); 2629960aa7cSTomi Valkeinen 263ac767456SLaurent Pinchart hdmi_wp_video_stop(&hdmi->wp); 2649960aa7cSTomi Valkeinen 265ac767456SLaurent Pinchart dss_mgr_disable(&hdmi->output); 2664e4b53ceSTomi Valkeinen 267ac767456SLaurent Pinchart hdmi_wp_set_phy_pwr(&hdmi->wp, HDMI_PHYPWRCMD_OFF); 2689960aa7cSTomi Valkeinen 269ac767456SLaurent Pinchart dss_pll_disable(&hdmi->pll.pll); 2709960aa7cSTomi Valkeinen 271ac767456SLaurent Pinchart hdmi_power_off_core(hdmi); 2729960aa7cSTomi Valkeinen } 2739960aa7cSTomi Valkeinen 2749960aa7cSTomi Valkeinen static int hdmi_display_check_timing(struct omap_dss_device *dssdev, 275da11bbbbSPeter Ujfalusi struct videomode *vm) 2769960aa7cSTomi Valkeinen { 277ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 278ac767456SLaurent Pinchart 279ac767456SLaurent Pinchart if (!dispc_mgr_timings_ok(hdmi->dss->dispc, dssdev->dispc_channel, vm)) 2809960aa7cSTomi Valkeinen return -EINVAL; 2819960aa7cSTomi Valkeinen 2829960aa7cSTomi Valkeinen return 0; 2839960aa7cSTomi Valkeinen } 2849960aa7cSTomi Valkeinen 2859960aa7cSTomi Valkeinen static void hdmi_display_set_timing(struct omap_dss_device *dssdev, 286da11bbbbSPeter Ujfalusi struct videomode *vm) 2879960aa7cSTomi Valkeinen { 288ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 2899960aa7cSTomi Valkeinen 290ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 2919960aa7cSTomi Valkeinen 292ac767456SLaurent Pinchart hdmi->cfg.vm = *vm; 2939960aa7cSTomi Valkeinen 294ac767456SLaurent Pinchart dispc_set_tv_pclk(hdmi->dss->dispc, vm->pixelclock); 295ac767456SLaurent Pinchart 296ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 2979960aa7cSTomi Valkeinen } 2989960aa7cSTomi Valkeinen 2999960aa7cSTomi Valkeinen static void hdmi_display_get_timings(struct omap_dss_device *dssdev, 300da11bbbbSPeter Ujfalusi struct videomode *vm) 3019960aa7cSTomi Valkeinen { 302ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 303ac767456SLaurent Pinchart 304ac767456SLaurent Pinchart *vm = hdmi->cfg.vm; 3059960aa7cSTomi Valkeinen } 3069960aa7cSTomi Valkeinen 307f33656e1SLaurent Pinchart static int hdmi_dump_regs(struct seq_file *s, void *p) 3089960aa7cSTomi Valkeinen { 309ac767456SLaurent Pinchart struct omap_hdmi *hdmi = s->private; 3109960aa7cSTomi Valkeinen 311ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 312ac767456SLaurent Pinchart 313ac767456SLaurent Pinchart if (hdmi_runtime_get(hdmi)) { 314ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 315f33656e1SLaurent Pinchart return 0; 3169960aa7cSTomi Valkeinen } 3179960aa7cSTomi Valkeinen 318ac767456SLaurent Pinchart hdmi_wp_dump(&hdmi->wp, s); 319ac767456SLaurent Pinchart hdmi_pll_dump(&hdmi->pll, s); 320ac767456SLaurent Pinchart hdmi_phy_dump(&hdmi->phy, s); 321ac767456SLaurent Pinchart hdmi4_core_dump(&hdmi->core, s); 3229960aa7cSTomi Valkeinen 323ac767456SLaurent Pinchart hdmi_runtime_put(hdmi); 324ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 325f33656e1SLaurent Pinchart return 0; 3269960aa7cSTomi Valkeinen } 3279960aa7cSTomi Valkeinen 328ac767456SLaurent Pinchart static int read_edid(struct omap_hdmi *hdmi, u8 *buf, int len) 3299960aa7cSTomi Valkeinen { 3309960aa7cSTomi Valkeinen int r; 3319960aa7cSTomi Valkeinen 332ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 3339960aa7cSTomi Valkeinen 334ac767456SLaurent Pinchart r = hdmi_runtime_get(hdmi); 3359960aa7cSTomi Valkeinen BUG_ON(r); 3369960aa7cSTomi Valkeinen 337ac767456SLaurent Pinchart r = hdmi4_read_edid(&hdmi->core, buf, len); 3389960aa7cSTomi Valkeinen 339ac767456SLaurent Pinchart hdmi_runtime_put(hdmi); 340ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 3419960aa7cSTomi Valkeinen 3429960aa7cSTomi Valkeinen return r; 3439960aa7cSTomi Valkeinen } 3449960aa7cSTomi Valkeinen 3459960aa7cSTomi Valkeinen static void hdmi_start_audio_stream(struct omap_hdmi *hd) 3469960aa7cSTomi Valkeinen { 3479960aa7cSTomi Valkeinen hdmi_wp_audio_enable(&hd->wp, true); 3489960aa7cSTomi Valkeinen hdmi4_audio_start(&hd->core, &hd->wp); 3499960aa7cSTomi Valkeinen } 3509960aa7cSTomi Valkeinen 3519960aa7cSTomi Valkeinen static void hdmi_stop_audio_stream(struct omap_hdmi *hd) 3529960aa7cSTomi Valkeinen { 3539960aa7cSTomi Valkeinen hdmi4_audio_stop(&hd->core, &hd->wp); 3549960aa7cSTomi Valkeinen hdmi_wp_audio_enable(&hd->wp, false); 3559960aa7cSTomi Valkeinen } 3569960aa7cSTomi Valkeinen 3579960aa7cSTomi Valkeinen static int hdmi_display_enable(struct omap_dss_device *dssdev) 3589960aa7cSTomi Valkeinen { 359ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 3609960aa7cSTomi Valkeinen unsigned long flags; 3619960aa7cSTomi Valkeinen int r = 0; 3629960aa7cSTomi Valkeinen 3639960aa7cSTomi Valkeinen DSSDBG("ENTER hdmi_display_enable\n"); 3649960aa7cSTomi Valkeinen 365ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 3669960aa7cSTomi Valkeinen 367ac767456SLaurent Pinchart if (!dssdev->dispc_channel_connected) { 3689960aa7cSTomi Valkeinen DSSERR("failed to enable display: no output/manager\n"); 3699960aa7cSTomi Valkeinen r = -ENODEV; 3709960aa7cSTomi Valkeinen goto err0; 3719960aa7cSTomi Valkeinen } 3729960aa7cSTomi Valkeinen 373ac767456SLaurent Pinchart r = hdmi_power_on_full(hdmi); 3749960aa7cSTomi Valkeinen if (r) { 3759960aa7cSTomi Valkeinen DSSERR("failed to power on device\n"); 3769960aa7cSTomi Valkeinen goto err0; 3779960aa7cSTomi Valkeinen } 3789960aa7cSTomi Valkeinen 379ac767456SLaurent Pinchart if (hdmi->audio_configured) { 380ac767456SLaurent Pinchart r = hdmi4_audio_config(&hdmi->core, &hdmi->wp, 381ac767456SLaurent Pinchart &hdmi->audio_config, 382ac767456SLaurent Pinchart hdmi->cfg.vm.pixelclock); 3839960aa7cSTomi Valkeinen if (r) { 3849960aa7cSTomi Valkeinen DSSERR("Error restoring audio configuration: %d", r); 385ac767456SLaurent Pinchart hdmi->audio_abort_cb(&hdmi->pdev->dev); 386ac767456SLaurent Pinchart hdmi->audio_configured = false; 3879960aa7cSTomi Valkeinen } 3889960aa7cSTomi Valkeinen } 3899960aa7cSTomi Valkeinen 390ac767456SLaurent Pinchart spin_lock_irqsave(&hdmi->audio_playing_lock, flags); 391ac767456SLaurent Pinchart if (hdmi->audio_configured && hdmi->audio_playing) 392ac767456SLaurent Pinchart hdmi_start_audio_stream(hdmi); 393ac767456SLaurent Pinchart hdmi->display_enabled = true; 394ac767456SLaurent Pinchart spin_unlock_irqrestore(&hdmi->audio_playing_lock, flags); 3959960aa7cSTomi Valkeinen 396ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 3979960aa7cSTomi Valkeinen return 0; 3989960aa7cSTomi Valkeinen 3999960aa7cSTomi Valkeinen err0: 400ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 4019960aa7cSTomi Valkeinen return r; 4029960aa7cSTomi Valkeinen } 4039960aa7cSTomi Valkeinen 4049960aa7cSTomi Valkeinen static void hdmi_display_disable(struct omap_dss_device *dssdev) 4059960aa7cSTomi Valkeinen { 406ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 4079960aa7cSTomi Valkeinen unsigned long flags; 4089960aa7cSTomi Valkeinen 4099960aa7cSTomi Valkeinen DSSDBG("Enter hdmi_display_disable\n"); 4109960aa7cSTomi Valkeinen 411ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 4129960aa7cSTomi Valkeinen 413ac767456SLaurent Pinchart spin_lock_irqsave(&hdmi->audio_playing_lock, flags); 414ac767456SLaurent Pinchart hdmi_stop_audio_stream(hdmi); 415ac767456SLaurent Pinchart hdmi->display_enabled = false; 416ac767456SLaurent Pinchart spin_unlock_irqrestore(&hdmi->audio_playing_lock, flags); 4179960aa7cSTomi Valkeinen 418ac767456SLaurent Pinchart hdmi_power_off_full(hdmi); 4199960aa7cSTomi Valkeinen 420ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 4219960aa7cSTomi Valkeinen } 4229960aa7cSTomi Valkeinen 423ac767456SLaurent Pinchart int hdmi4_core_enable(struct hdmi_core_data *core) 4249960aa7cSTomi Valkeinen { 425ac767456SLaurent Pinchart struct omap_hdmi *hdmi = container_of(core, struct omap_hdmi, core); 4269960aa7cSTomi Valkeinen int r = 0; 4279960aa7cSTomi Valkeinen 4285bebbbfeSHans Verkuil DSSDBG("ENTER omapdss_hdmi4_core_enable\n"); 4299960aa7cSTomi Valkeinen 430ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 4319960aa7cSTomi Valkeinen 432ac767456SLaurent Pinchart r = hdmi_power_on_core(hdmi); 4339960aa7cSTomi Valkeinen if (r) { 4349960aa7cSTomi Valkeinen DSSERR("failed to power on device\n"); 4359960aa7cSTomi Valkeinen goto err0; 4369960aa7cSTomi Valkeinen } 4379960aa7cSTomi Valkeinen 438ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 4399960aa7cSTomi Valkeinen return 0; 4409960aa7cSTomi Valkeinen 4419960aa7cSTomi Valkeinen err0: 442ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 4439960aa7cSTomi Valkeinen return r; 4449960aa7cSTomi Valkeinen } 4459960aa7cSTomi Valkeinen 446ac767456SLaurent Pinchart void hdmi4_core_disable(struct hdmi_core_data *core) 4479960aa7cSTomi Valkeinen { 448ac767456SLaurent Pinchart struct omap_hdmi *hdmi = container_of(core, struct omap_hdmi, core); 449ac767456SLaurent Pinchart 4505bebbbfeSHans Verkuil DSSDBG("Enter omapdss_hdmi4_core_disable\n"); 4519960aa7cSTomi Valkeinen 452ac767456SLaurent Pinchart mutex_lock(&hdmi->lock); 4539960aa7cSTomi Valkeinen 454ac767456SLaurent Pinchart hdmi_power_off_core(hdmi); 4559960aa7cSTomi Valkeinen 456ac767456SLaurent Pinchart mutex_unlock(&hdmi->lock); 4579960aa7cSTomi Valkeinen } 4589960aa7cSTomi Valkeinen 4599960aa7cSTomi Valkeinen static int hdmi_connect(struct omap_dss_device *dssdev, 4609960aa7cSTomi Valkeinen struct omap_dss_device *dst) 4619960aa7cSTomi Valkeinen { 462ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 4639960aa7cSTomi Valkeinen int r; 4649960aa7cSTomi Valkeinen 465ac767456SLaurent Pinchart r = hdmi_init_regulator(hdmi); 4669960aa7cSTomi Valkeinen if (r) 4679960aa7cSTomi Valkeinen return r; 4689960aa7cSTomi Valkeinen 469ac767456SLaurent Pinchart r = dss_mgr_connect(&hdmi->output, dssdev); 4709960aa7cSTomi Valkeinen if (r) 4719960aa7cSTomi Valkeinen return r; 4729960aa7cSTomi Valkeinen 4739960aa7cSTomi Valkeinen r = omapdss_output_set_device(dssdev, dst); 4749960aa7cSTomi Valkeinen if (r) { 4759960aa7cSTomi Valkeinen DSSERR("failed to connect output to new device: %s\n", 4769960aa7cSTomi Valkeinen dst->name); 477ac767456SLaurent Pinchart dss_mgr_disconnect(&hdmi->output, dssdev); 4789960aa7cSTomi Valkeinen return r; 4799960aa7cSTomi Valkeinen } 4809960aa7cSTomi Valkeinen 4819960aa7cSTomi Valkeinen return 0; 4829960aa7cSTomi Valkeinen } 4839960aa7cSTomi Valkeinen 4849960aa7cSTomi Valkeinen static void hdmi_disconnect(struct omap_dss_device *dssdev, 4859960aa7cSTomi Valkeinen struct omap_dss_device *dst) 4869960aa7cSTomi Valkeinen { 487ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 488ac767456SLaurent Pinchart 4899960aa7cSTomi Valkeinen WARN_ON(dst != dssdev->dst); 4909960aa7cSTomi Valkeinen 4919960aa7cSTomi Valkeinen if (dst != dssdev->dst) 4929960aa7cSTomi Valkeinen return; 4939960aa7cSTomi Valkeinen 4949960aa7cSTomi Valkeinen omapdss_output_unset_device(dssdev); 4959960aa7cSTomi Valkeinen 496ac767456SLaurent Pinchart dss_mgr_disconnect(&hdmi->output, dssdev); 4979960aa7cSTomi Valkeinen } 4989960aa7cSTomi Valkeinen 4999960aa7cSTomi Valkeinen static int hdmi_read_edid(struct omap_dss_device *dssdev, 5009960aa7cSTomi Valkeinen u8 *edid, int len) 5019960aa7cSTomi Valkeinen { 502ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 5039960aa7cSTomi Valkeinen bool need_enable; 5049960aa7cSTomi Valkeinen int r; 5059960aa7cSTomi Valkeinen 506ac767456SLaurent Pinchart need_enable = hdmi->core_enabled == false; 5079960aa7cSTomi Valkeinen 5089960aa7cSTomi Valkeinen if (need_enable) { 509ac767456SLaurent Pinchart r = hdmi4_core_enable(&hdmi->core); 5109960aa7cSTomi Valkeinen if (r) 5119960aa7cSTomi Valkeinen return r; 5129960aa7cSTomi Valkeinen } 5139960aa7cSTomi Valkeinen 514ac767456SLaurent Pinchart r = read_edid(hdmi, edid, len); 5151897e1a3SHans Verkuil if (r >= 256) 516ac767456SLaurent Pinchart hdmi4_cec_set_phys_addr(&hdmi->core, 5171897e1a3SHans Verkuil cec_get_edid_phys_addr(edid, r, NULL)); 5181897e1a3SHans Verkuil else 519ac767456SLaurent Pinchart hdmi4_cec_set_phys_addr(&hdmi->core, CEC_PHYS_ADDR_INVALID); 5209960aa7cSTomi Valkeinen if (need_enable) 521ac767456SLaurent Pinchart hdmi4_core_disable(&hdmi->core); 5229960aa7cSTomi Valkeinen 5239960aa7cSTomi Valkeinen return r; 5249960aa7cSTomi Valkeinen } 5259960aa7cSTomi Valkeinen 526019114efSHans Verkuil static void hdmi_lost_hotplug(struct omap_dss_device *dssdev) 527019114efSHans Verkuil { 528ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 529ac767456SLaurent Pinchart 530ac767456SLaurent Pinchart hdmi4_cec_set_phys_addr(&hdmi->core, CEC_PHYS_ADDR_INVALID); 531019114efSHans Verkuil } 532019114efSHans Verkuil 5339960aa7cSTomi Valkeinen static int hdmi_set_infoframe(struct omap_dss_device *dssdev, 5349960aa7cSTomi Valkeinen const struct hdmi_avi_infoframe *avi) 5359960aa7cSTomi Valkeinen { 536ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 537ac767456SLaurent Pinchart 538ac767456SLaurent Pinchart hdmi->cfg.infoframe = *avi; 5399960aa7cSTomi Valkeinen return 0; 5409960aa7cSTomi Valkeinen } 5419960aa7cSTomi Valkeinen 5429960aa7cSTomi Valkeinen static int hdmi_set_hdmi_mode(struct omap_dss_device *dssdev, 5439960aa7cSTomi Valkeinen bool hdmi_mode) 5449960aa7cSTomi Valkeinen { 545ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev); 546ac767456SLaurent Pinchart 547ac767456SLaurent Pinchart hdmi->cfg.hdmi_dvi_mode = hdmi_mode ? HDMI_HDMI : HDMI_DVI; 5489960aa7cSTomi Valkeinen return 0; 5499960aa7cSTomi Valkeinen } 5509960aa7cSTomi Valkeinen 5519960aa7cSTomi Valkeinen static const struct omapdss_hdmi_ops hdmi_ops = { 5529960aa7cSTomi Valkeinen .connect = hdmi_connect, 5539960aa7cSTomi Valkeinen .disconnect = hdmi_disconnect, 5549960aa7cSTomi Valkeinen 5559960aa7cSTomi Valkeinen .enable = hdmi_display_enable, 5569960aa7cSTomi Valkeinen .disable = hdmi_display_disable, 5579960aa7cSTomi Valkeinen 5589960aa7cSTomi Valkeinen .check_timings = hdmi_display_check_timing, 5599960aa7cSTomi Valkeinen .set_timings = hdmi_display_set_timing, 5609960aa7cSTomi Valkeinen .get_timings = hdmi_display_get_timings, 5619960aa7cSTomi Valkeinen 5629960aa7cSTomi Valkeinen .read_edid = hdmi_read_edid, 563019114efSHans Verkuil .lost_hotplug = hdmi_lost_hotplug, 5649960aa7cSTomi Valkeinen .set_infoframe = hdmi_set_infoframe, 5659960aa7cSTomi Valkeinen .set_hdmi_mode = hdmi_set_hdmi_mode, 5669960aa7cSTomi Valkeinen }; 5679960aa7cSTomi Valkeinen 568ac767456SLaurent Pinchart static void hdmi_init_output(struct omap_hdmi *hdmi) 5699960aa7cSTomi Valkeinen { 570ac767456SLaurent Pinchart struct omap_dss_device *out = &hdmi->output; 5719960aa7cSTomi Valkeinen 572ac767456SLaurent Pinchart out->dev = &hdmi->pdev->dev; 5739960aa7cSTomi Valkeinen out->id = OMAP_DSS_OUTPUT_HDMI; 5749960aa7cSTomi Valkeinen out->output_type = OMAP_DISPLAY_TYPE_HDMI; 5759960aa7cSTomi Valkeinen out->name = "hdmi.0"; 5769960aa7cSTomi Valkeinen out->dispc_channel = OMAP_DSS_CHANNEL_DIGIT; 5779960aa7cSTomi Valkeinen out->ops.hdmi = &hdmi_ops; 5789960aa7cSTomi Valkeinen out->owner = THIS_MODULE; 5799960aa7cSTomi Valkeinen 5809960aa7cSTomi Valkeinen omapdss_register_output(out); 5819960aa7cSTomi Valkeinen } 5829960aa7cSTomi Valkeinen 583ac767456SLaurent Pinchart static void hdmi_uninit_output(struct omap_hdmi *hdmi) 5849960aa7cSTomi Valkeinen { 585ac767456SLaurent Pinchart struct omap_dss_device *out = &hdmi->output; 5869960aa7cSTomi Valkeinen 5879960aa7cSTomi Valkeinen omapdss_unregister_output(out); 5889960aa7cSTomi Valkeinen } 5899960aa7cSTomi Valkeinen 590ac767456SLaurent Pinchart static int hdmi_probe_of(struct omap_hdmi *hdmi) 5919960aa7cSTomi Valkeinen { 592ac767456SLaurent Pinchart struct platform_device *pdev = hdmi->pdev; 5939960aa7cSTomi Valkeinen struct device_node *node = pdev->dev.of_node; 5949960aa7cSTomi Valkeinen struct device_node *ep; 5959960aa7cSTomi Valkeinen int r; 5969960aa7cSTomi Valkeinen 59709bffa6eSRob Herring ep = of_graph_get_endpoint_by_regs(node, 0, 0); 5989960aa7cSTomi Valkeinen if (!ep) 5999960aa7cSTomi Valkeinen return 0; 6009960aa7cSTomi Valkeinen 601ac767456SLaurent Pinchart r = hdmi_parse_lanes_of(pdev, ep, &hdmi->phy); 6029960aa7cSTomi Valkeinen if (r) 6039960aa7cSTomi Valkeinen goto err; 6049960aa7cSTomi Valkeinen 6059960aa7cSTomi Valkeinen of_node_put(ep); 6069960aa7cSTomi Valkeinen return 0; 6079960aa7cSTomi Valkeinen 6089960aa7cSTomi Valkeinen err: 6099960aa7cSTomi Valkeinen of_node_put(ep); 6109960aa7cSTomi Valkeinen return r; 6119960aa7cSTomi Valkeinen } 6129960aa7cSTomi Valkeinen 6139960aa7cSTomi Valkeinen /* Audio callbacks */ 6149960aa7cSTomi Valkeinen static int hdmi_audio_startup(struct device *dev, 6159960aa7cSTomi Valkeinen void (*abort_cb)(struct device *dev)) 6169960aa7cSTomi Valkeinen { 6179960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 6189960aa7cSTomi Valkeinen 6199960aa7cSTomi Valkeinen mutex_lock(&hd->lock); 6209960aa7cSTomi Valkeinen 621c1899cb3SJyri Sarha WARN_ON(hd->audio_abort_cb != NULL); 6229960aa7cSTomi Valkeinen 6239960aa7cSTomi Valkeinen hd->audio_abort_cb = abort_cb; 6249960aa7cSTomi Valkeinen 6259960aa7cSTomi Valkeinen mutex_unlock(&hd->lock); 6269960aa7cSTomi Valkeinen 627c1899cb3SJyri Sarha return 0; 6289960aa7cSTomi Valkeinen } 6299960aa7cSTomi Valkeinen 6309960aa7cSTomi Valkeinen static int hdmi_audio_shutdown(struct device *dev) 6319960aa7cSTomi Valkeinen { 6329960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 6339960aa7cSTomi Valkeinen 6349960aa7cSTomi Valkeinen mutex_lock(&hd->lock); 6359960aa7cSTomi Valkeinen hd->audio_abort_cb = NULL; 6369960aa7cSTomi Valkeinen hd->audio_configured = false; 6379960aa7cSTomi Valkeinen hd->audio_playing = false; 6389960aa7cSTomi Valkeinen mutex_unlock(&hd->lock); 6399960aa7cSTomi Valkeinen 6409960aa7cSTomi Valkeinen return 0; 6419960aa7cSTomi Valkeinen } 6429960aa7cSTomi Valkeinen 6439960aa7cSTomi Valkeinen static int hdmi_audio_start(struct device *dev) 6449960aa7cSTomi Valkeinen { 6459960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 6469960aa7cSTomi Valkeinen unsigned long flags; 6479960aa7cSTomi Valkeinen 6489960aa7cSTomi Valkeinen spin_lock_irqsave(&hd->audio_playing_lock, flags); 6499960aa7cSTomi Valkeinen 650c1899cb3SJyri Sarha if (hd->display_enabled) { 651c1899cb3SJyri Sarha if (!hdmi_mode_has_audio(&hd->cfg)) 652c1899cb3SJyri Sarha DSSERR("%s: Video mode does not support audio\n", 653c1899cb3SJyri Sarha __func__); 6549960aa7cSTomi Valkeinen hdmi_start_audio_stream(hd); 655c1899cb3SJyri Sarha } 6569960aa7cSTomi Valkeinen hd->audio_playing = true; 6579960aa7cSTomi Valkeinen 6589960aa7cSTomi Valkeinen spin_unlock_irqrestore(&hd->audio_playing_lock, flags); 6599960aa7cSTomi Valkeinen return 0; 6609960aa7cSTomi Valkeinen } 6619960aa7cSTomi Valkeinen 6629960aa7cSTomi Valkeinen static void hdmi_audio_stop(struct device *dev) 6639960aa7cSTomi Valkeinen { 6649960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 6659960aa7cSTomi Valkeinen unsigned long flags; 6669960aa7cSTomi Valkeinen 6679960aa7cSTomi Valkeinen WARN_ON(!hdmi_mode_has_audio(&hd->cfg)); 6689960aa7cSTomi Valkeinen 6699960aa7cSTomi Valkeinen spin_lock_irqsave(&hd->audio_playing_lock, flags); 6709960aa7cSTomi Valkeinen 6719960aa7cSTomi Valkeinen if (hd->display_enabled) 6729960aa7cSTomi Valkeinen hdmi_stop_audio_stream(hd); 6739960aa7cSTomi Valkeinen hd->audio_playing = false; 6749960aa7cSTomi Valkeinen 6759960aa7cSTomi Valkeinen spin_unlock_irqrestore(&hd->audio_playing_lock, flags); 6769960aa7cSTomi Valkeinen } 6779960aa7cSTomi Valkeinen 6789960aa7cSTomi Valkeinen static int hdmi_audio_config(struct device *dev, 6799960aa7cSTomi Valkeinen struct omap_dss_audio *dss_audio) 6809960aa7cSTomi Valkeinen { 6819960aa7cSTomi Valkeinen struct omap_hdmi *hd = dev_get_drvdata(dev); 682*77eeac24STomi Valkeinen int ret = 0; 6839960aa7cSTomi Valkeinen 6849960aa7cSTomi Valkeinen mutex_lock(&hd->lock); 6859960aa7cSTomi Valkeinen 686c1899cb3SJyri Sarha if (hd->display_enabled) { 687c1899cb3SJyri Sarha ret = hdmi4_audio_config(&hd->core, &hd->wp, dss_audio, 688c1899cb3SJyri Sarha hd->cfg.vm.pixelclock); 689c1899cb3SJyri Sarha if (ret) 6909960aa7cSTomi Valkeinen goto out; 6919960aa7cSTomi Valkeinen } 6929960aa7cSTomi Valkeinen 6939960aa7cSTomi Valkeinen hd->audio_configured = true; 6949960aa7cSTomi Valkeinen hd->audio_config = *dss_audio; 6959960aa7cSTomi Valkeinen out: 6969960aa7cSTomi Valkeinen mutex_unlock(&hd->lock); 6979960aa7cSTomi Valkeinen 6989960aa7cSTomi Valkeinen return ret; 6999960aa7cSTomi Valkeinen } 7009960aa7cSTomi Valkeinen 7019960aa7cSTomi Valkeinen static const struct omap_hdmi_audio_ops hdmi_audio_ops = { 7029960aa7cSTomi Valkeinen .audio_startup = hdmi_audio_startup, 7039960aa7cSTomi Valkeinen .audio_shutdown = hdmi_audio_shutdown, 7049960aa7cSTomi Valkeinen .audio_start = hdmi_audio_start, 7059960aa7cSTomi Valkeinen .audio_stop = hdmi_audio_stop, 7069960aa7cSTomi Valkeinen .audio_config = hdmi_audio_config, 7079960aa7cSTomi Valkeinen }; 7089960aa7cSTomi Valkeinen 709ac767456SLaurent Pinchart static int hdmi_audio_register(struct omap_hdmi *hdmi) 7109960aa7cSTomi Valkeinen { 7119960aa7cSTomi Valkeinen struct omap_hdmi_audio_pdata pdata = { 712ac767456SLaurent Pinchart .dev = &hdmi->pdev->dev, 713d20fa5a0SLaurent Pinchart .version = 4, 714ac767456SLaurent Pinchart .audio_dma_addr = hdmi_wp_get_audio_dma_addr(&hdmi->wp), 7159960aa7cSTomi Valkeinen .ops = &hdmi_audio_ops, 7169960aa7cSTomi Valkeinen }; 7179960aa7cSTomi Valkeinen 718ac767456SLaurent Pinchart hdmi->audio_pdev = platform_device_register_data( 719ac767456SLaurent Pinchart &hdmi->pdev->dev, "omap-hdmi-audio", PLATFORM_DEVID_AUTO, 7209960aa7cSTomi Valkeinen &pdata, sizeof(pdata)); 7219960aa7cSTomi Valkeinen 722ac767456SLaurent Pinchart if (IS_ERR(hdmi->audio_pdev)) 723ac767456SLaurent Pinchart return PTR_ERR(hdmi->audio_pdev); 7249960aa7cSTomi Valkeinen 7259960aa7cSTomi Valkeinen return 0; 7269960aa7cSTomi Valkeinen } 7279960aa7cSTomi Valkeinen 7289960aa7cSTomi Valkeinen /* HDMI HW IP initialisation */ 7299960aa7cSTomi Valkeinen static int hdmi4_bind(struct device *dev, struct device *master, void *data) 7309960aa7cSTomi Valkeinen { 7319960aa7cSTomi Valkeinen struct platform_device *pdev = to_platform_device(dev); 7327b295257SLaurent Pinchart struct dss_device *dss = dss_get_device(master); 733ac767456SLaurent Pinchart struct omap_hdmi *hdmi; 7349960aa7cSTomi Valkeinen int r; 7359960aa7cSTomi Valkeinen int irq; 7369960aa7cSTomi Valkeinen 737ac767456SLaurent Pinchart hdmi = kzalloc(sizeof(*hdmi), GFP_KERNEL); 738ac767456SLaurent Pinchart if (!hdmi) 739ac767456SLaurent Pinchart return -ENOMEM; 7409960aa7cSTomi Valkeinen 741ac767456SLaurent Pinchart hdmi->pdev = pdev; 742ac767456SLaurent Pinchart hdmi->dss = dss; 743ac767456SLaurent Pinchart dev_set_drvdata(&pdev->dev, hdmi); 7449960aa7cSTomi Valkeinen 745ac767456SLaurent Pinchart mutex_init(&hdmi->lock); 746ac767456SLaurent Pinchart spin_lock_init(&hdmi->audio_playing_lock); 747ac767456SLaurent Pinchart 748ac767456SLaurent Pinchart r = hdmi_probe_of(hdmi); 7499960aa7cSTomi Valkeinen if (r) 750ac767456SLaurent Pinchart goto err_free; 7519960aa7cSTomi Valkeinen 752ac767456SLaurent Pinchart r = hdmi_wp_init(pdev, &hdmi->wp, 4); 7539960aa7cSTomi Valkeinen if (r) 754ac767456SLaurent Pinchart goto err_free; 7559960aa7cSTomi Valkeinen 756ac767456SLaurent Pinchart r = hdmi_pll_init(dss, pdev, &hdmi->pll, &hdmi->wp); 7579960aa7cSTomi Valkeinen if (r) 758ac767456SLaurent Pinchart goto err_free; 7599960aa7cSTomi Valkeinen 760ac767456SLaurent Pinchart r = hdmi_phy_init(pdev, &hdmi->phy, 4); 7619960aa7cSTomi Valkeinen if (r) 762ac767456SLaurent Pinchart goto err_pll; 7639960aa7cSTomi Valkeinen 764ac767456SLaurent Pinchart r = hdmi4_core_init(pdev, &hdmi->core); 7659960aa7cSTomi Valkeinen if (r) 766ac767456SLaurent Pinchart goto err_pll; 7679960aa7cSTomi Valkeinen 768ac767456SLaurent Pinchart r = hdmi4_cec_init(pdev, &hdmi->core, &hdmi->wp); 7691897e1a3SHans Verkuil if (r) 770ac767456SLaurent Pinchart goto err_pll; 7711897e1a3SHans Verkuil 7729960aa7cSTomi Valkeinen irq = platform_get_irq(pdev, 0); 7739960aa7cSTomi Valkeinen if (irq < 0) { 7749960aa7cSTomi Valkeinen DSSERR("platform_get_irq failed\n"); 7759960aa7cSTomi Valkeinen r = -ENODEV; 776ac767456SLaurent Pinchart goto err_pll; 7779960aa7cSTomi Valkeinen } 7789960aa7cSTomi Valkeinen 7799960aa7cSTomi Valkeinen r = devm_request_threaded_irq(&pdev->dev, irq, 7809960aa7cSTomi Valkeinen NULL, hdmi_irq_handler, 781ac767456SLaurent Pinchart IRQF_ONESHOT, "OMAP HDMI", hdmi); 7829960aa7cSTomi Valkeinen if (r) { 7839960aa7cSTomi Valkeinen DSSERR("HDMI IRQ request failed\n"); 784ac767456SLaurent Pinchart goto err_pll; 7859960aa7cSTomi Valkeinen } 7869960aa7cSTomi Valkeinen 7879960aa7cSTomi Valkeinen pm_runtime_enable(&pdev->dev); 7889960aa7cSTomi Valkeinen 789ac767456SLaurent Pinchart hdmi_init_output(hdmi); 7909960aa7cSTomi Valkeinen 791ac767456SLaurent Pinchart r = hdmi_audio_register(hdmi); 7929960aa7cSTomi Valkeinen if (r) { 7939960aa7cSTomi Valkeinen DSSERR("Registering HDMI audio failed\n"); 794ac767456SLaurent Pinchart hdmi_uninit_output(hdmi); 7959960aa7cSTomi Valkeinen pm_runtime_disable(&pdev->dev); 7969960aa7cSTomi Valkeinen return r; 7979960aa7cSTomi Valkeinen } 7989960aa7cSTomi Valkeinen 799ac767456SLaurent Pinchart hdmi->debugfs = dss_debugfs_create_file(dss, "hdmi", hdmi_dump_regs, 800ac767456SLaurent Pinchart hdmi); 8019960aa7cSTomi Valkeinen 8029960aa7cSTomi Valkeinen return 0; 803ac767456SLaurent Pinchart 804ac767456SLaurent Pinchart err_pll: 805ac767456SLaurent Pinchart hdmi_pll_uninit(&hdmi->pll); 806ac767456SLaurent Pinchart err_free: 807ac767456SLaurent Pinchart kfree(hdmi); 8089960aa7cSTomi Valkeinen return r; 8099960aa7cSTomi Valkeinen } 8109960aa7cSTomi Valkeinen 8119960aa7cSTomi Valkeinen static void hdmi4_unbind(struct device *dev, struct device *master, void *data) 8129960aa7cSTomi Valkeinen { 813ac767456SLaurent Pinchart struct omap_hdmi *hdmi = dev_get_drvdata(dev); 8149960aa7cSTomi Valkeinen 815ac767456SLaurent Pinchart dss_debugfs_remove_file(hdmi->debugfs); 816f33656e1SLaurent Pinchart 817ac767456SLaurent Pinchart if (hdmi->audio_pdev) 818ac767456SLaurent Pinchart platform_device_unregister(hdmi->audio_pdev); 8199960aa7cSTomi Valkeinen 820ac767456SLaurent Pinchart hdmi_uninit_output(hdmi); 8219960aa7cSTomi Valkeinen 822ac767456SLaurent Pinchart hdmi4_cec_uninit(&hdmi->core); 8231897e1a3SHans Verkuil 824ac767456SLaurent Pinchart hdmi_pll_uninit(&hdmi->pll); 8259960aa7cSTomi Valkeinen 826ac767456SLaurent Pinchart pm_runtime_disable(dev); 827ac767456SLaurent Pinchart 828ac767456SLaurent Pinchart kfree(hdmi); 8299960aa7cSTomi Valkeinen } 8309960aa7cSTomi Valkeinen 8319960aa7cSTomi Valkeinen static const struct component_ops hdmi4_component_ops = { 8329960aa7cSTomi Valkeinen .bind = hdmi4_bind, 8339960aa7cSTomi Valkeinen .unbind = hdmi4_unbind, 8349960aa7cSTomi Valkeinen }; 8359960aa7cSTomi Valkeinen 8369960aa7cSTomi Valkeinen static int hdmi4_probe(struct platform_device *pdev) 8379960aa7cSTomi Valkeinen { 8389960aa7cSTomi Valkeinen return component_add(&pdev->dev, &hdmi4_component_ops); 8399960aa7cSTomi Valkeinen } 8409960aa7cSTomi Valkeinen 8419960aa7cSTomi Valkeinen static int hdmi4_remove(struct platform_device *pdev) 8429960aa7cSTomi Valkeinen { 8439960aa7cSTomi Valkeinen component_del(&pdev->dev, &hdmi4_component_ops); 8449960aa7cSTomi Valkeinen return 0; 8459960aa7cSTomi Valkeinen } 8469960aa7cSTomi Valkeinen 8479960aa7cSTomi Valkeinen static int hdmi_runtime_suspend(struct device *dev) 8489960aa7cSTomi Valkeinen { 84950638ae5SLaurent Pinchart struct omap_hdmi *hdmi = dev_get_drvdata(dev); 85050638ae5SLaurent Pinchart 85150638ae5SLaurent Pinchart dispc_runtime_put(hdmi->dss->dispc); 8529960aa7cSTomi Valkeinen 8539960aa7cSTomi Valkeinen return 0; 8549960aa7cSTomi Valkeinen } 8559960aa7cSTomi Valkeinen 8569960aa7cSTomi Valkeinen static int hdmi_runtime_resume(struct device *dev) 8579960aa7cSTomi Valkeinen { 85850638ae5SLaurent Pinchart struct omap_hdmi *hdmi = dev_get_drvdata(dev); 8599960aa7cSTomi Valkeinen int r; 8609960aa7cSTomi Valkeinen 86150638ae5SLaurent Pinchart r = dispc_runtime_get(hdmi->dss->dispc); 8629960aa7cSTomi Valkeinen if (r < 0) 8639960aa7cSTomi Valkeinen return r; 8649960aa7cSTomi Valkeinen 8659960aa7cSTomi Valkeinen return 0; 8669960aa7cSTomi Valkeinen } 8679960aa7cSTomi Valkeinen 8689960aa7cSTomi Valkeinen static const struct dev_pm_ops hdmi_pm_ops = { 8699960aa7cSTomi Valkeinen .runtime_suspend = hdmi_runtime_suspend, 8709960aa7cSTomi Valkeinen .runtime_resume = hdmi_runtime_resume, 8719960aa7cSTomi Valkeinen }; 8729960aa7cSTomi Valkeinen 8739960aa7cSTomi Valkeinen static const struct of_device_id hdmi_of_match[] = { 8749960aa7cSTomi Valkeinen { .compatible = "ti,omap4-hdmi", }, 8759960aa7cSTomi Valkeinen {}, 8769960aa7cSTomi Valkeinen }; 8779960aa7cSTomi Valkeinen 878d66c36a3SAndrew F. Davis struct platform_driver omapdss_hdmi4hw_driver = { 8799960aa7cSTomi Valkeinen .probe = hdmi4_probe, 8809960aa7cSTomi Valkeinen .remove = hdmi4_remove, 8819960aa7cSTomi Valkeinen .driver = { 8829960aa7cSTomi Valkeinen .name = "omapdss_hdmi", 8839960aa7cSTomi Valkeinen .pm = &hdmi_pm_ops, 8849960aa7cSTomi Valkeinen .of_match_table = hdmi_of_match, 8859960aa7cSTomi Valkeinen .suppress_bind_attrs = true, 8869960aa7cSTomi Valkeinen }, 8879960aa7cSTomi Valkeinen }; 888