mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-26 15:35:04 +07:00
77eeac24b1
audio_config function for both HDMI4 and HDMI5 return uninitialized value as the error code if the display is not currently enabled. For some reason this has not caused any issues. Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ti.com> Link: https://patchwork.freedesktop.org/patch/msgid/20180329104038.29154-1-tomi.valkeinen@ti.com Reviewed-by: Emil Velikov <emil.velikov@collabora.com> Reviewed-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Signed-off-by: Sean Paul <seanpaul@chromium.org>
880 lines
18 KiB
C
880 lines
18 KiB
C
/*
|
|
* HDMI driver for OMAP5
|
|
*
|
|
* Copyright (C) 2014 Texas Instruments Incorporated - http://www.ti.com/
|
|
*
|
|
* Authors:
|
|
* Yong Zhi
|
|
* Mythri pk
|
|
* Archit Taneja <archit@ti.com>
|
|
* Tomi Valkeinen <tomi.valkeinen@ti.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License version 2 as published by
|
|
* the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along with
|
|
* this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#define DSS_SUBSYS_NAME "HDMI"
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/err.h>
|
|
#include <linux/io.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/string.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/regulator/consumer.h>
|
|
#include <linux/component.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_graph.h>
|
|
#include <sound/omap-hdmi-audio.h>
|
|
|
|
#include "omapdss.h"
|
|
#include "hdmi5_core.h"
|
|
#include "dss.h"
|
|
|
|
static int hdmi_runtime_get(struct omap_hdmi *hdmi)
|
|
{
|
|
int r;
|
|
|
|
DSSDBG("hdmi_runtime_get\n");
|
|
|
|
r = pm_runtime_get_sync(&hdmi->pdev->dev);
|
|
WARN_ON(r < 0);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void hdmi_runtime_put(struct omap_hdmi *hdmi)
|
|
{
|
|
int r;
|
|
|
|
DSSDBG("hdmi_runtime_put\n");
|
|
|
|
r = pm_runtime_put_sync(&hdmi->pdev->dev);
|
|
WARN_ON(r < 0 && r != -ENOSYS);
|
|
}
|
|
|
|
static irqreturn_t hdmi_irq_handler(int irq, void *data)
|
|
{
|
|
struct omap_hdmi *hdmi = data;
|
|
struct hdmi_wp_data *wp = &hdmi->wp;
|
|
u32 irqstatus;
|
|
|
|
irqstatus = hdmi_wp_get_irqstatus(wp);
|
|
hdmi_wp_set_irqstatus(wp, irqstatus);
|
|
|
|
if ((irqstatus & HDMI_IRQ_LINK_CONNECT) &&
|
|
irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
|
|
u32 v;
|
|
/*
|
|
* If we get both connect and disconnect interrupts at the same
|
|
* time, turn off the PHY, clear interrupts, and restart, which
|
|
* raises connect interrupt if a cable is connected, or nothing
|
|
* if cable is not connected.
|
|
*/
|
|
|
|
hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_OFF);
|
|
|
|
/*
|
|
* We always get bogus CONNECT & DISCONNECT interrupts when
|
|
* setting the PHY to LDOON. To ignore those, we force the RXDET
|
|
* line to 0 until the PHY power state has been changed.
|
|
*/
|
|
v = hdmi_read_reg(hdmi->phy.base, HDMI_TXPHY_PAD_CFG_CTRL);
|
|
v = FLD_MOD(v, 1, 15, 15); /* FORCE_RXDET_HIGH */
|
|
v = FLD_MOD(v, 0, 14, 7); /* RXDET_LINE */
|
|
hdmi_write_reg(hdmi->phy.base, HDMI_TXPHY_PAD_CFG_CTRL, v);
|
|
|
|
hdmi_wp_set_irqstatus(wp, HDMI_IRQ_LINK_CONNECT |
|
|
HDMI_IRQ_LINK_DISCONNECT);
|
|
|
|
hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
|
|
|
|
REG_FLD_MOD(hdmi->phy.base, HDMI_TXPHY_PAD_CFG_CTRL, 0, 15, 15);
|
|
|
|
} else if (irqstatus & HDMI_IRQ_LINK_CONNECT) {
|
|
hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_TXON);
|
|
} else if (irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
|
|
hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
|
|
}
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static int hdmi_init_regulator(struct omap_hdmi *hdmi)
|
|
{
|
|
struct regulator *reg;
|
|
|
|
if (hdmi->vdda_reg != NULL)
|
|
return 0;
|
|
|
|
reg = devm_regulator_get(&hdmi->pdev->dev, "vdda");
|
|
if (IS_ERR(reg)) {
|
|
DSSERR("can't get VDDA regulator\n");
|
|
return PTR_ERR(reg);
|
|
}
|
|
|
|
hdmi->vdda_reg = reg;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int hdmi_power_on_core(struct omap_hdmi *hdmi)
|
|
{
|
|
int r;
|
|
|
|
r = regulator_enable(hdmi->vdda_reg);
|
|
if (r)
|
|
return r;
|
|
|
|
r = hdmi_runtime_get(hdmi);
|
|
if (r)
|
|
goto err_runtime_get;
|
|
|
|
/* Make selection of HDMI in DSS */
|
|
dss_select_hdmi_venc_clk_source(hdmi->dss, DSS_HDMI_M_PCLK);
|
|
|
|
hdmi->core_enabled = true;
|
|
|
|
return 0;
|
|
|
|
err_runtime_get:
|
|
regulator_disable(hdmi->vdda_reg);
|
|
|
|
return r;
|
|
}
|
|
|
|
static void hdmi_power_off_core(struct omap_hdmi *hdmi)
|
|
{
|
|
hdmi->core_enabled = false;
|
|
|
|
hdmi_runtime_put(hdmi);
|
|
regulator_disable(hdmi->vdda_reg);
|
|
}
|
|
|
|
static int hdmi_power_on_full(struct omap_hdmi *hdmi)
|
|
{
|
|
int r;
|
|
struct videomode *vm;
|
|
struct dss_pll_clock_info hdmi_cinfo = { 0 };
|
|
unsigned int pc;
|
|
|
|
r = hdmi_power_on_core(hdmi);
|
|
if (r)
|
|
return r;
|
|
|
|
vm = &hdmi->cfg.vm;
|
|
|
|
DSSDBG("hdmi_power_on hactive= %d vactive = %d\n", vm->hactive,
|
|
vm->vactive);
|
|
|
|
pc = vm->pixelclock;
|
|
if (vm->flags & DISPLAY_FLAGS_DOUBLECLK)
|
|
pc *= 2;
|
|
|
|
/* DSS_HDMI_TCLK is bitclk / 10 */
|
|
pc *= 10;
|
|
|
|
dss_pll_calc_b(&hdmi->pll.pll, clk_get_rate(hdmi->pll.pll.clkin),
|
|
pc, &hdmi_cinfo);
|
|
|
|
/* disable and clear irqs */
|
|
hdmi_wp_clear_irqenable(&hdmi->wp, 0xffffffff);
|
|
hdmi_wp_set_irqstatus(&hdmi->wp,
|
|
hdmi_wp_get_irqstatus(&hdmi->wp));
|
|
|
|
r = dss_pll_enable(&hdmi->pll.pll);
|
|
if (r) {
|
|
DSSERR("Failed to enable PLL\n");
|
|
goto err_pll_enable;
|
|
}
|
|
|
|
r = dss_pll_set_config(&hdmi->pll.pll, &hdmi_cinfo);
|
|
if (r) {
|
|
DSSERR("Failed to configure PLL\n");
|
|
goto err_pll_cfg;
|
|
}
|
|
|
|
r = hdmi_phy_configure(&hdmi->phy, hdmi_cinfo.clkdco,
|
|
hdmi_cinfo.clkout[0]);
|
|
if (r) {
|
|
DSSDBG("Failed to start PHY\n");
|
|
goto err_phy_cfg;
|
|
}
|
|
|
|
r = hdmi_wp_set_phy_pwr(&hdmi->wp, HDMI_PHYPWRCMD_LDOON);
|
|
if (r)
|
|
goto err_phy_pwr;
|
|
|
|
hdmi5_configure(&hdmi->core, &hdmi->wp, &hdmi->cfg);
|
|
|
|
/* tv size */
|
|
dss_mgr_set_timings(&hdmi->output, vm);
|
|
|
|
r = dss_mgr_enable(&hdmi->output);
|
|
if (r)
|
|
goto err_mgr_enable;
|
|
|
|
r = hdmi_wp_video_start(&hdmi->wp);
|
|
if (r)
|
|
goto err_vid_enable;
|
|
|
|
hdmi_wp_set_irqenable(&hdmi->wp,
|
|
HDMI_IRQ_LINK_CONNECT | HDMI_IRQ_LINK_DISCONNECT);
|
|
|
|
return 0;
|
|
|
|
err_vid_enable:
|
|
dss_mgr_disable(&hdmi->output);
|
|
err_mgr_enable:
|
|
hdmi_wp_set_phy_pwr(&hdmi->wp, HDMI_PHYPWRCMD_OFF);
|
|
err_phy_pwr:
|
|
err_phy_cfg:
|
|
err_pll_cfg:
|
|
dss_pll_disable(&hdmi->pll.pll);
|
|
err_pll_enable:
|
|
hdmi_power_off_core(hdmi);
|
|
return -EIO;
|
|
}
|
|
|
|
static void hdmi_power_off_full(struct omap_hdmi *hdmi)
|
|
{
|
|
hdmi_wp_clear_irqenable(&hdmi->wp, 0xffffffff);
|
|
|
|
hdmi_wp_video_stop(&hdmi->wp);
|
|
|
|
dss_mgr_disable(&hdmi->output);
|
|
|
|
hdmi_wp_set_phy_pwr(&hdmi->wp, HDMI_PHYPWRCMD_OFF);
|
|
|
|
dss_pll_disable(&hdmi->pll.pll);
|
|
|
|
hdmi_power_off_core(hdmi);
|
|
}
|
|
|
|
static int hdmi_display_check_timing(struct omap_dss_device *dssdev,
|
|
struct videomode *vm)
|
|
{
|
|
struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
|
|
|
|
if (!dispc_mgr_timings_ok(hdmi->dss->dispc, dssdev->dispc_channel, vm))
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void hdmi_display_set_timing(struct omap_dss_device *dssdev,
|
|
struct videomode *vm)
|
|
{
|
|
struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
|
|
|
|
mutex_lock(&hdmi->lock);
|
|
|
|
hdmi->cfg.vm = *vm;
|
|
|
|
dispc_set_tv_pclk(hdmi->dss->dispc, vm->pixelclock);
|
|
|
|
mutex_unlock(&hdmi->lock);
|
|
}
|
|
|
|
static void hdmi_display_get_timings(struct omap_dss_device *dssdev,
|
|
struct videomode *vm)
|
|
{
|
|
struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
|
|
|
|
*vm = hdmi->cfg.vm;
|
|
}
|
|
|
|
static int hdmi_dump_regs(struct seq_file *s, void *p)
|
|
{
|
|
struct omap_hdmi *hdmi = s->private;
|
|
|
|
mutex_lock(&hdmi->lock);
|
|
|
|
if (hdmi_runtime_get(hdmi)) {
|
|
mutex_unlock(&hdmi->lock);
|
|
return 0;
|
|
}
|
|
|
|
hdmi_wp_dump(&hdmi->wp, s);
|
|
hdmi_pll_dump(&hdmi->pll, s);
|
|
hdmi_phy_dump(&hdmi->phy, s);
|
|
hdmi5_core_dump(&hdmi->core, s);
|
|
|
|
hdmi_runtime_put(hdmi);
|
|
mutex_unlock(&hdmi->lock);
|
|
return 0;
|
|
}
|
|
|
|
static int read_edid(struct omap_hdmi *hdmi, u8 *buf, int len)
|
|
{
|
|
int r;
|
|
int idlemode;
|
|
|
|
mutex_lock(&hdmi->lock);
|
|
|
|
r = hdmi_runtime_get(hdmi);
|
|
BUG_ON(r);
|
|
|
|
idlemode = REG_GET(hdmi->wp.base, HDMI_WP_SYSCONFIG, 3, 2);
|
|
/* No-idle mode */
|
|
REG_FLD_MOD(hdmi->wp.base, HDMI_WP_SYSCONFIG, 1, 3, 2);
|
|
|
|
r = hdmi5_read_edid(&hdmi->core, buf, len);
|
|
|
|
REG_FLD_MOD(hdmi->wp.base, HDMI_WP_SYSCONFIG, idlemode, 3, 2);
|
|
|
|
hdmi_runtime_put(hdmi);
|
|
mutex_unlock(&hdmi->lock);
|
|
|
|
return r;
|
|
}
|
|
|
|
static void hdmi_start_audio_stream(struct omap_hdmi *hd)
|
|
{
|
|
REG_FLD_MOD(hd->wp.base, HDMI_WP_SYSCONFIG, 1, 3, 2);
|
|
hdmi_wp_audio_enable(&hd->wp, true);
|
|
hdmi_wp_audio_core_req_enable(&hd->wp, true);
|
|
}
|
|
|
|
static void hdmi_stop_audio_stream(struct omap_hdmi *hd)
|
|
{
|
|
hdmi_wp_audio_core_req_enable(&hd->wp, false);
|
|
hdmi_wp_audio_enable(&hd->wp, false);
|
|
REG_FLD_MOD(hd->wp.base, HDMI_WP_SYSCONFIG, hd->wp_idlemode, 3, 2);
|
|
}
|
|
|
|
static int hdmi_display_enable(struct omap_dss_device *dssdev)
|
|
{
|
|
struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
|
|
unsigned long flags;
|
|
int r = 0;
|
|
|
|
DSSDBG("ENTER hdmi_display_enable\n");
|
|
|
|
mutex_lock(&hdmi->lock);
|
|
|
|
if (!dssdev->dispc_channel_connected) {
|
|
DSSERR("failed to enable display: no output/manager\n");
|
|
r = -ENODEV;
|
|
goto err0;
|
|
}
|
|
|
|
r = hdmi_power_on_full(hdmi);
|
|
if (r) {
|
|
DSSERR("failed to power on device\n");
|
|
goto err0;
|
|
}
|
|
|
|
if (hdmi->audio_configured) {
|
|
r = hdmi5_audio_config(&hdmi->core, &hdmi->wp,
|
|
&hdmi->audio_config,
|
|
hdmi->cfg.vm.pixelclock);
|
|
if (r) {
|
|
DSSERR("Error restoring audio configuration: %d", r);
|
|
hdmi->audio_abort_cb(&hdmi->pdev->dev);
|
|
hdmi->audio_configured = false;
|
|
}
|
|
}
|
|
|
|
spin_lock_irqsave(&hdmi->audio_playing_lock, flags);
|
|
if (hdmi->audio_configured && hdmi->audio_playing)
|
|
hdmi_start_audio_stream(hdmi);
|
|
hdmi->display_enabled = true;
|
|
spin_unlock_irqrestore(&hdmi->audio_playing_lock, flags);
|
|
|
|
mutex_unlock(&hdmi->lock);
|
|
return 0;
|
|
|
|
err0:
|
|
mutex_unlock(&hdmi->lock);
|
|
return r;
|
|
}
|
|
|
|
static void hdmi_display_disable(struct omap_dss_device *dssdev)
|
|
{
|
|
struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
|
|
unsigned long flags;
|
|
|
|
DSSDBG("Enter hdmi_display_disable\n");
|
|
|
|
mutex_lock(&hdmi->lock);
|
|
|
|
spin_lock_irqsave(&hdmi->audio_playing_lock, flags);
|
|
hdmi_stop_audio_stream(hdmi);
|
|
hdmi->display_enabled = false;
|
|
spin_unlock_irqrestore(&hdmi->audio_playing_lock, flags);
|
|
|
|
hdmi_power_off_full(hdmi);
|
|
|
|
mutex_unlock(&hdmi->lock);
|
|
}
|
|
|
|
static int hdmi_core_enable(struct omap_hdmi *hdmi)
|
|
{
|
|
int r = 0;
|
|
|
|
DSSDBG("ENTER omapdss_hdmi_core_enable\n");
|
|
|
|
mutex_lock(&hdmi->lock);
|
|
|
|
r = hdmi_power_on_core(hdmi);
|
|
if (r) {
|
|
DSSERR("failed to power on device\n");
|
|
goto err0;
|
|
}
|
|
|
|
mutex_unlock(&hdmi->lock);
|
|
return 0;
|
|
|
|
err0:
|
|
mutex_unlock(&hdmi->lock);
|
|
return r;
|
|
}
|
|
|
|
static void hdmi_core_disable(struct omap_hdmi *hdmi)
|
|
{
|
|
DSSDBG("Enter omapdss_hdmi_core_disable\n");
|
|
|
|
mutex_lock(&hdmi->lock);
|
|
|
|
hdmi_power_off_core(hdmi);
|
|
|
|
mutex_unlock(&hdmi->lock);
|
|
}
|
|
|
|
static int hdmi_connect(struct omap_dss_device *dssdev,
|
|
struct omap_dss_device *dst)
|
|
{
|
|
struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
|
|
int r;
|
|
|
|
r = hdmi_init_regulator(hdmi);
|
|
if (r)
|
|
return r;
|
|
|
|
r = dss_mgr_connect(&hdmi->output, dssdev);
|
|
if (r)
|
|
return r;
|
|
|
|
r = omapdss_output_set_device(dssdev, dst);
|
|
if (r) {
|
|
DSSERR("failed to connect output to new device: %s\n",
|
|
dst->name);
|
|
dss_mgr_disconnect(&hdmi->output, dssdev);
|
|
return r;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void hdmi_disconnect(struct omap_dss_device *dssdev,
|
|
struct omap_dss_device *dst)
|
|
{
|
|
struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
|
|
|
|
WARN_ON(dst != dssdev->dst);
|
|
|
|
if (dst != dssdev->dst)
|
|
return;
|
|
|
|
omapdss_output_unset_device(dssdev);
|
|
|
|
dss_mgr_disconnect(&hdmi->output, dssdev);
|
|
}
|
|
|
|
static int hdmi_read_edid(struct omap_dss_device *dssdev,
|
|
u8 *edid, int len)
|
|
{
|
|
struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
|
|
bool need_enable;
|
|
int r;
|
|
|
|
need_enable = hdmi->core_enabled == false;
|
|
|
|
if (need_enable) {
|
|
r = hdmi_core_enable(hdmi);
|
|
if (r)
|
|
return r;
|
|
}
|
|
|
|
r = read_edid(hdmi, edid, len);
|
|
|
|
if (need_enable)
|
|
hdmi_core_disable(hdmi);
|
|
|
|
return r;
|
|
}
|
|
|
|
static int hdmi_set_infoframe(struct omap_dss_device *dssdev,
|
|
const struct hdmi_avi_infoframe *avi)
|
|
{
|
|
struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
|
|
|
|
hdmi->cfg.infoframe = *avi;
|
|
return 0;
|
|
}
|
|
|
|
static int hdmi_set_hdmi_mode(struct omap_dss_device *dssdev,
|
|
bool hdmi_mode)
|
|
{
|
|
struct omap_hdmi *hdmi = dssdev_to_hdmi(dssdev);
|
|
|
|
hdmi->cfg.hdmi_dvi_mode = hdmi_mode ? HDMI_HDMI : HDMI_DVI;
|
|
return 0;
|
|
}
|
|
|
|
static const struct omapdss_hdmi_ops hdmi_ops = {
|
|
.connect = hdmi_connect,
|
|
.disconnect = hdmi_disconnect,
|
|
|
|
.enable = hdmi_display_enable,
|
|
.disable = hdmi_display_disable,
|
|
|
|
.check_timings = hdmi_display_check_timing,
|
|
.set_timings = hdmi_display_set_timing,
|
|
.get_timings = hdmi_display_get_timings,
|
|
|
|
.read_edid = hdmi_read_edid,
|
|
.set_infoframe = hdmi_set_infoframe,
|
|
.set_hdmi_mode = hdmi_set_hdmi_mode,
|
|
};
|
|
|
|
static void hdmi_init_output(struct omap_hdmi *hdmi)
|
|
{
|
|
struct omap_dss_device *out = &hdmi->output;
|
|
|
|
out->dev = &hdmi->pdev->dev;
|
|
out->id = OMAP_DSS_OUTPUT_HDMI;
|
|
out->output_type = OMAP_DISPLAY_TYPE_HDMI;
|
|
out->name = "hdmi.0";
|
|
out->dispc_channel = OMAP_DSS_CHANNEL_DIGIT;
|
|
out->ops.hdmi = &hdmi_ops;
|
|
out->owner = THIS_MODULE;
|
|
|
|
omapdss_register_output(out);
|
|
}
|
|
|
|
static void hdmi_uninit_output(struct omap_hdmi *hdmi)
|
|
{
|
|
struct omap_dss_device *out = &hdmi->output;
|
|
|
|
omapdss_unregister_output(out);
|
|
}
|
|
|
|
static int hdmi_probe_of(struct omap_hdmi *hdmi)
|
|
{
|
|
struct platform_device *pdev = hdmi->pdev;
|
|
struct device_node *node = pdev->dev.of_node;
|
|
struct device_node *ep;
|
|
int r;
|
|
|
|
ep = of_graph_get_endpoint_by_regs(node, 0, 0);
|
|
if (!ep)
|
|
return 0;
|
|
|
|
r = hdmi_parse_lanes_of(pdev, ep, &hdmi->phy);
|
|
if (r)
|
|
goto err;
|
|
|
|
of_node_put(ep);
|
|
return 0;
|
|
|
|
err:
|
|
of_node_put(ep);
|
|
return r;
|
|
}
|
|
|
|
/* Audio callbacks */
|
|
static int hdmi_audio_startup(struct device *dev,
|
|
void (*abort_cb)(struct device *dev))
|
|
{
|
|
struct omap_hdmi *hd = dev_get_drvdata(dev);
|
|
|
|
mutex_lock(&hd->lock);
|
|
|
|
WARN_ON(hd->audio_abort_cb != NULL);
|
|
|
|
hd->audio_abort_cb = abort_cb;
|
|
|
|
mutex_unlock(&hd->lock);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int hdmi_audio_shutdown(struct device *dev)
|
|
{
|
|
struct omap_hdmi *hd = dev_get_drvdata(dev);
|
|
|
|
mutex_lock(&hd->lock);
|
|
hd->audio_abort_cb = NULL;
|
|
hd->audio_configured = false;
|
|
hd->audio_playing = false;
|
|
mutex_unlock(&hd->lock);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int hdmi_audio_start(struct device *dev)
|
|
{
|
|
struct omap_hdmi *hd = dev_get_drvdata(dev);
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&hd->audio_playing_lock, flags);
|
|
|
|
if (hd->display_enabled) {
|
|
if (!hdmi_mode_has_audio(&hd->cfg))
|
|
DSSERR("%s: Video mode does not support audio\n",
|
|
__func__);
|
|
hdmi_start_audio_stream(hd);
|
|
}
|
|
hd->audio_playing = true;
|
|
|
|
spin_unlock_irqrestore(&hd->audio_playing_lock, flags);
|
|
return 0;
|
|
}
|
|
|
|
static void hdmi_audio_stop(struct device *dev)
|
|
{
|
|
struct omap_hdmi *hd = dev_get_drvdata(dev);
|
|
unsigned long flags;
|
|
|
|
if (!hdmi_mode_has_audio(&hd->cfg))
|
|
DSSERR("%s: Video mode does not support audio\n", __func__);
|
|
|
|
spin_lock_irqsave(&hd->audio_playing_lock, flags);
|
|
|
|
if (hd->display_enabled)
|
|
hdmi_stop_audio_stream(hd);
|
|
hd->audio_playing = false;
|
|
|
|
spin_unlock_irqrestore(&hd->audio_playing_lock, flags);
|
|
}
|
|
|
|
static int hdmi_audio_config(struct device *dev,
|
|
struct omap_dss_audio *dss_audio)
|
|
{
|
|
struct omap_hdmi *hd = dev_get_drvdata(dev);
|
|
int ret = 0;
|
|
|
|
mutex_lock(&hd->lock);
|
|
|
|
if (hd->display_enabled) {
|
|
ret = hdmi5_audio_config(&hd->core, &hd->wp, dss_audio,
|
|
hd->cfg.vm.pixelclock);
|
|
if (ret)
|
|
goto out;
|
|
}
|
|
|
|
hd->audio_configured = true;
|
|
hd->audio_config = *dss_audio;
|
|
out:
|
|
mutex_unlock(&hd->lock);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static const struct omap_hdmi_audio_ops hdmi_audio_ops = {
|
|
.audio_startup = hdmi_audio_startup,
|
|
.audio_shutdown = hdmi_audio_shutdown,
|
|
.audio_start = hdmi_audio_start,
|
|
.audio_stop = hdmi_audio_stop,
|
|
.audio_config = hdmi_audio_config,
|
|
};
|
|
|
|
static int hdmi_audio_register(struct omap_hdmi *hdmi)
|
|
{
|
|
struct omap_hdmi_audio_pdata pdata = {
|
|
.dev = &hdmi->pdev->dev,
|
|
.version = 5,
|
|
.audio_dma_addr = hdmi_wp_get_audio_dma_addr(&hdmi->wp),
|
|
.ops = &hdmi_audio_ops,
|
|
};
|
|
|
|
hdmi->audio_pdev = platform_device_register_data(
|
|
&hdmi->pdev->dev, "omap-hdmi-audio", PLATFORM_DEVID_AUTO,
|
|
&pdata, sizeof(pdata));
|
|
|
|
if (IS_ERR(hdmi->audio_pdev))
|
|
return PTR_ERR(hdmi->audio_pdev);
|
|
|
|
hdmi_runtime_get(hdmi);
|
|
hdmi->wp_idlemode =
|
|
REG_GET(hdmi->wp.base, HDMI_WP_SYSCONFIG, 3, 2);
|
|
hdmi_runtime_put(hdmi);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* HDMI HW IP initialisation */
|
|
static int hdmi5_bind(struct device *dev, struct device *master, void *data)
|
|
{
|
|
struct platform_device *pdev = to_platform_device(dev);
|
|
struct dss_device *dss = dss_get_device(master);
|
|
struct omap_hdmi *hdmi;
|
|
int r;
|
|
int irq;
|
|
|
|
hdmi = kzalloc(sizeof(*hdmi), GFP_KERNEL);
|
|
if (!hdmi)
|
|
return -ENOMEM;
|
|
|
|
hdmi->pdev = pdev;
|
|
hdmi->dss = dss;
|
|
dev_set_drvdata(&pdev->dev, hdmi);
|
|
|
|
mutex_init(&hdmi->lock);
|
|
spin_lock_init(&hdmi->audio_playing_lock);
|
|
|
|
r = hdmi_probe_of(hdmi);
|
|
if (r)
|
|
goto err_free;
|
|
|
|
r = hdmi_wp_init(pdev, &hdmi->wp, 5);
|
|
if (r)
|
|
goto err_free;
|
|
|
|
r = hdmi_pll_init(dss, pdev, &hdmi->pll, &hdmi->wp);
|
|
if (r)
|
|
goto err_free;
|
|
|
|
r = hdmi_phy_init(pdev, &hdmi->phy, 5);
|
|
if (r)
|
|
goto err_pll;
|
|
|
|
r = hdmi5_core_init(pdev, &hdmi->core);
|
|
if (r)
|
|
goto err_pll;
|
|
|
|
irq = platform_get_irq(pdev, 0);
|
|
if (irq < 0) {
|
|
DSSERR("platform_get_irq failed\n");
|
|
r = -ENODEV;
|
|
goto err_pll;
|
|
}
|
|
|
|
r = devm_request_threaded_irq(&pdev->dev, irq,
|
|
NULL, hdmi_irq_handler,
|
|
IRQF_ONESHOT, "OMAP HDMI", hdmi);
|
|
if (r) {
|
|
DSSERR("HDMI IRQ request failed\n");
|
|
goto err_pll;
|
|
}
|
|
|
|
pm_runtime_enable(&pdev->dev);
|
|
|
|
hdmi_init_output(hdmi);
|
|
|
|
r = hdmi_audio_register(hdmi);
|
|
if (r) {
|
|
DSSERR("Registering HDMI audio failed %d\n", r);
|
|
hdmi_uninit_output(hdmi);
|
|
pm_runtime_disable(&pdev->dev);
|
|
return r;
|
|
}
|
|
|
|
hdmi->debugfs = dss_debugfs_create_file(dss, "hdmi", hdmi_dump_regs,
|
|
hdmi);
|
|
|
|
return 0;
|
|
|
|
err_pll:
|
|
hdmi_pll_uninit(&hdmi->pll);
|
|
err_free:
|
|
kfree(hdmi);
|
|
return r;
|
|
}
|
|
|
|
static void hdmi5_unbind(struct device *dev, struct device *master, void *data)
|
|
{
|
|
struct omap_hdmi *hdmi = dev_get_drvdata(dev);
|
|
|
|
dss_debugfs_remove_file(hdmi->debugfs);
|
|
|
|
if (hdmi->audio_pdev)
|
|
platform_device_unregister(hdmi->audio_pdev);
|
|
|
|
hdmi_uninit_output(hdmi);
|
|
|
|
hdmi_pll_uninit(&hdmi->pll);
|
|
|
|
pm_runtime_disable(dev);
|
|
|
|
kfree(hdmi);
|
|
}
|
|
|
|
static const struct component_ops hdmi5_component_ops = {
|
|
.bind = hdmi5_bind,
|
|
.unbind = hdmi5_unbind,
|
|
};
|
|
|
|
static int hdmi5_probe(struct platform_device *pdev)
|
|
{
|
|
return component_add(&pdev->dev, &hdmi5_component_ops);
|
|
}
|
|
|
|
static int hdmi5_remove(struct platform_device *pdev)
|
|
{
|
|
component_del(&pdev->dev, &hdmi5_component_ops);
|
|
return 0;
|
|
}
|
|
|
|
static int hdmi_runtime_suspend(struct device *dev)
|
|
{
|
|
struct omap_hdmi *hdmi = dev_get_drvdata(dev);
|
|
|
|
dispc_runtime_put(hdmi->dss->dispc);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int hdmi_runtime_resume(struct device *dev)
|
|
{
|
|
struct omap_hdmi *hdmi = dev_get_drvdata(dev);
|
|
int r;
|
|
|
|
r = dispc_runtime_get(hdmi->dss->dispc);
|
|
if (r < 0)
|
|
return r;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dev_pm_ops hdmi_pm_ops = {
|
|
.runtime_suspend = hdmi_runtime_suspend,
|
|
.runtime_resume = hdmi_runtime_resume,
|
|
};
|
|
|
|
static const struct of_device_id hdmi_of_match[] = {
|
|
{ .compatible = "ti,omap5-hdmi", },
|
|
{ .compatible = "ti,dra7-hdmi", },
|
|
{},
|
|
};
|
|
|
|
struct platform_driver omapdss_hdmi5hw_driver = {
|
|
.probe = hdmi5_probe,
|
|
.remove = hdmi5_remove,
|
|
.driver = {
|
|
.name = "omapdss_hdmi5",
|
|
.pm = &hdmi_pm_ops,
|
|
.of_match_table = hdmi_of_match,
|
|
.suppress_bind_attrs = true,
|
|
},
|
|
};
|