For mdp5, the irqs of hdmi/eDP/dsi0/dsi1 blocks get routed through the mdp block. In order to decouple hdmi/eDP/etc, register an irq domain in mdp5. When hdmi/dsi/etc are used with mdp4, they can directly setup their irqs in their DT nodes as normal. When used with mdp5, instead set the mdp device as the interrupt-parent, as in: mdp: qcom,mdss_mdp@fd900000 { compatible = "qcom,mdss_mdp"; interrupt-controller; #interrupt-cells = <1>; ... }; hdmi: qcom,hdmi_tx@fd922100 { compatible = "qcom,hdmi-tx-8074"; interrupt-parent = <&mdp>; interrupts = <8 0>; /* MDP5_HW_INTR_STATUS.INTR_HDMI */ ... }; There is a slight awkwardness, in that we cannot disable child irqs at the mdp level, they can only be cleared in the child block. So you must not use threaded irq handlers in the child. I'm not sure if there is a better way to deal with that. Signed-off-by: Rob Clark <robdclark@gmail.com>
199 lines
5.0 KiB
C
199 lines
5.0 KiB
C
/*
|
|
* Copyright (C) 2013 Red Hat
|
|
* Author: Rob Clark <robdclark@gmail.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/>.
|
|
*/
|
|
|
|
#include <linux/irqdomain.h>
|
|
#include <linux/irq.h>
|
|
|
|
#include "msm_drv.h"
|
|
#include "mdp5_kms.h"
|
|
|
|
void mdp5_set_irqmask(struct mdp_kms *mdp_kms, uint32_t irqmask)
|
|
{
|
|
mdp5_write(to_mdp5_kms(mdp_kms), REG_MDP5_INTR_EN, irqmask);
|
|
}
|
|
|
|
static void mdp5_irq_error_handler(struct mdp_irq *irq, uint32_t irqstatus)
|
|
{
|
|
DRM_ERROR("errors: %08x\n", irqstatus);
|
|
}
|
|
|
|
void mdp5_irq_preinstall(struct msm_kms *kms)
|
|
{
|
|
struct mdp5_kms *mdp5_kms = to_mdp5_kms(to_mdp_kms(kms));
|
|
mdp5_write(mdp5_kms, REG_MDP5_INTR_CLEAR, 0xffffffff);
|
|
}
|
|
|
|
int mdp5_irq_postinstall(struct msm_kms *kms)
|
|
{
|
|
struct mdp_kms *mdp_kms = to_mdp_kms(kms);
|
|
struct mdp5_kms *mdp5_kms = to_mdp5_kms(mdp_kms);
|
|
struct mdp_irq *error_handler = &mdp5_kms->error_handler;
|
|
|
|
error_handler->irq = mdp5_irq_error_handler;
|
|
error_handler->irqmask = MDP5_IRQ_INTF0_UNDER_RUN |
|
|
MDP5_IRQ_INTF1_UNDER_RUN |
|
|
MDP5_IRQ_INTF2_UNDER_RUN |
|
|
MDP5_IRQ_INTF3_UNDER_RUN;
|
|
|
|
mdp_irq_register(mdp_kms, error_handler);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void mdp5_irq_uninstall(struct msm_kms *kms)
|
|
{
|
|
struct mdp5_kms *mdp5_kms = to_mdp5_kms(to_mdp_kms(kms));
|
|
mdp5_write(mdp5_kms, REG_MDP5_INTR_EN, 0x00000000);
|
|
}
|
|
|
|
static void mdp5_irq_mdp(struct mdp_kms *mdp_kms)
|
|
{
|
|
struct mdp5_kms *mdp5_kms = to_mdp5_kms(mdp_kms);
|
|
struct drm_device *dev = mdp5_kms->dev;
|
|
struct msm_drm_private *priv = dev->dev_private;
|
|
unsigned int id;
|
|
uint32_t status;
|
|
|
|
status = mdp5_read(mdp5_kms, REG_MDP5_INTR_STATUS);
|
|
mdp5_write(mdp5_kms, REG_MDP5_INTR_CLEAR, status);
|
|
|
|
VERB("status=%08x", status);
|
|
|
|
mdp_dispatch_irqs(mdp_kms, status);
|
|
|
|
for (id = 0; id < priv->num_crtcs; id++)
|
|
if (status & mdp5_crtc_vblank(priv->crtcs[id]))
|
|
drm_handle_vblank(dev, id);
|
|
}
|
|
|
|
irqreturn_t mdp5_irq(struct msm_kms *kms)
|
|
{
|
|
struct mdp_kms *mdp_kms = to_mdp_kms(kms);
|
|
struct mdp5_kms *mdp5_kms = to_mdp5_kms(mdp_kms);
|
|
uint32_t intr;
|
|
|
|
intr = mdp5_read(mdp5_kms, REG_MDP5_HW_INTR_STATUS);
|
|
|
|
VERB("intr=%08x", intr);
|
|
|
|
if (intr & MDP5_HW_INTR_STATUS_INTR_MDP) {
|
|
mdp5_irq_mdp(mdp_kms);
|
|
intr &= ~MDP5_HW_INTR_STATUS_INTR_MDP;
|
|
}
|
|
|
|
while (intr) {
|
|
irq_hw_number_t hwirq = fls(intr) - 1;
|
|
generic_handle_irq(irq_find_mapping(
|
|
mdp5_kms->irqcontroller.domain, hwirq));
|
|
intr &= ~(1 << hwirq);
|
|
}
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
int mdp5_enable_vblank(struct msm_kms *kms, struct drm_crtc *crtc)
|
|
{
|
|
mdp_update_vblank_mask(to_mdp_kms(kms),
|
|
mdp5_crtc_vblank(crtc), true);
|
|
return 0;
|
|
}
|
|
|
|
void mdp5_disable_vblank(struct msm_kms *kms, struct drm_crtc *crtc)
|
|
{
|
|
mdp_update_vblank_mask(to_mdp_kms(kms),
|
|
mdp5_crtc_vblank(crtc), false);
|
|
}
|
|
|
|
/*
|
|
* interrupt-controller implementation, so sub-blocks (hdmi/eDP/dsi/etc)
|
|
* can register to get their irq's delivered
|
|
*/
|
|
|
|
#define VALID_IRQS (MDP5_HW_INTR_STATUS_INTR_DSI0 | \
|
|
MDP5_HW_INTR_STATUS_INTR_DSI1 | \
|
|
MDP5_HW_INTR_STATUS_INTR_HDMI | \
|
|
MDP5_HW_INTR_STATUS_INTR_EDP)
|
|
|
|
static void mdp5_hw_mask_irq(struct irq_data *irqd)
|
|
{
|
|
struct mdp5_kms *mdp5_kms = irq_data_get_irq_chip_data(irqd);
|
|
smp_mb__before_atomic();
|
|
clear_bit(irqd->hwirq, &mdp5_kms->irqcontroller.enabled_mask);
|
|
smp_mb__after_atomic();
|
|
}
|
|
|
|
static void mdp5_hw_unmask_irq(struct irq_data *irqd)
|
|
{
|
|
struct mdp5_kms *mdp5_kms = irq_data_get_irq_chip_data(irqd);
|
|
smp_mb__before_atomic();
|
|
set_bit(irqd->hwirq, &mdp5_kms->irqcontroller.enabled_mask);
|
|
smp_mb__after_atomic();
|
|
}
|
|
|
|
static struct irq_chip mdp5_hw_irq_chip = {
|
|
.name = "mdp5",
|
|
.irq_mask = mdp5_hw_mask_irq,
|
|
.irq_unmask = mdp5_hw_unmask_irq,
|
|
};
|
|
|
|
static int mdp5_hw_irqdomain_map(struct irq_domain *d,
|
|
unsigned int irq, irq_hw_number_t hwirq)
|
|
{
|
|
struct mdp5_kms *mdp5_kms = d->host_data;
|
|
|
|
if (!(VALID_IRQS & (1 << hwirq)))
|
|
return -EPERM;
|
|
|
|
irq_set_chip_and_handler(irq, &mdp5_hw_irq_chip, handle_level_irq);
|
|
irq_set_chip_data(irq, mdp5_kms);
|
|
set_irq_flags(irq, IRQF_VALID);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct irq_domain_ops mdp5_hw_irqdomain_ops = {
|
|
.map = mdp5_hw_irqdomain_map,
|
|
.xlate = irq_domain_xlate_onecell,
|
|
};
|
|
|
|
|
|
int mdp5_irq_domain_init(struct mdp5_kms *mdp5_kms)
|
|
{
|
|
struct device *dev = mdp5_kms->dev->dev;
|
|
struct irq_domain *d;
|
|
|
|
d = irq_domain_add_linear(dev->of_node, 32,
|
|
&mdp5_hw_irqdomain_ops, mdp5_kms);
|
|
if (!d) {
|
|
dev_err(dev, "mdp5 irq domain add failed\n");
|
|
return -ENXIO;
|
|
}
|
|
|
|
mdp5_kms->irqcontroller.enabled_mask = 0;
|
|
mdp5_kms->irqcontroller.domain = d;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void mdp5_irq_domain_fini(struct mdp5_kms *mdp5_kms)
|
|
{
|
|
if (mdp5_kms->irqcontroller.domain) {
|
|
irq_domain_remove(mdp5_kms->irqcontroller.domain);
|
|
mdp5_kms->irqcontroller.domain = NULL;
|
|
}
|
|
}
|