1 // SPDX-License-Identifier: GPL-2.0-only
3 * Copyright (c) 2016, The Linux Foundation. All rights reserved.
6 #include <linux/irqdomain.h>
12 #define to_mdp5_mdss(x) container_of(x, struct mdp5_mdss, base)
17 void __iomem *mmio, *vbif;
19 struct regulator *vdd;
23 struct clk *vsync_clk;
26 volatile unsigned long enabled_mask;
27 struct irq_domain *domain;
31 static inline void mdss_write(struct mdp5_mdss *mdp5_mdss, u32 reg, u32 data)
33 msm_writel(data, mdp5_mdss->mmio + reg);
36 static inline u32 mdss_read(struct mdp5_mdss *mdp5_mdss, u32 reg)
38 return msm_readl(mdp5_mdss->mmio + reg);
41 static irqreturn_t mdss_irq(int irq, void *arg)
43 struct mdp5_mdss *mdp5_mdss = arg;
46 intr = mdss_read(mdp5_mdss, REG_MDSS_HW_INTR_STATUS);
48 VERB("intr=%08x", intr);
51 irq_hw_number_t hwirq = fls(intr) - 1;
53 generic_handle_domain_irq(mdp5_mdss->irqcontroller.domain, hwirq);
54 intr &= ~(1 << hwirq);
61 * interrupt-controller implementation, so sub-blocks (MDP/HDMI/eDP/DSI/etc)
62 * can register to get their irq's delivered
65 #define VALID_IRQS (MDSS_HW_INTR_STATUS_INTR_MDP | \
66 MDSS_HW_INTR_STATUS_INTR_DSI0 | \
67 MDSS_HW_INTR_STATUS_INTR_DSI1 | \
68 MDSS_HW_INTR_STATUS_INTR_HDMI | \
69 MDSS_HW_INTR_STATUS_INTR_EDP)
71 static void mdss_hw_mask_irq(struct irq_data *irqd)
73 struct mdp5_mdss *mdp5_mdss = irq_data_get_irq_chip_data(irqd);
75 smp_mb__before_atomic();
76 clear_bit(irqd->hwirq, &mdp5_mdss->irqcontroller.enabled_mask);
77 smp_mb__after_atomic();
80 static void mdss_hw_unmask_irq(struct irq_data *irqd)
82 struct mdp5_mdss *mdp5_mdss = irq_data_get_irq_chip_data(irqd);
84 smp_mb__before_atomic();
85 set_bit(irqd->hwirq, &mdp5_mdss->irqcontroller.enabled_mask);
86 smp_mb__after_atomic();
89 static struct irq_chip mdss_hw_irq_chip = {
91 .irq_mask = mdss_hw_mask_irq,
92 .irq_unmask = mdss_hw_unmask_irq,
95 static int mdss_hw_irqdomain_map(struct irq_domain *d, unsigned int irq,
96 irq_hw_number_t hwirq)
98 struct mdp5_mdss *mdp5_mdss = d->host_data;
100 if (!(VALID_IRQS & (1 << hwirq)))
103 irq_set_chip_and_handler(irq, &mdss_hw_irq_chip, handle_level_irq);
104 irq_set_chip_data(irq, mdp5_mdss);
109 static const struct irq_domain_ops mdss_hw_irqdomain_ops = {
110 .map = mdss_hw_irqdomain_map,
111 .xlate = irq_domain_xlate_onecell,
115 static int mdss_irq_domain_init(struct mdp5_mdss *mdp5_mdss)
117 struct device *dev = mdp5_mdss->base.dev->dev;
118 struct irq_domain *d;
120 d = irq_domain_add_linear(dev->of_node, 32, &mdss_hw_irqdomain_ops,
123 DRM_DEV_ERROR(dev, "mdss irq domain add failed\n");
127 mdp5_mdss->irqcontroller.enabled_mask = 0;
128 mdp5_mdss->irqcontroller.domain = d;
133 static int mdp5_mdss_enable(struct msm_mdss *mdss)
135 struct mdp5_mdss *mdp5_mdss = to_mdp5_mdss(mdss);
138 clk_prepare_enable(mdp5_mdss->ahb_clk);
139 if (mdp5_mdss->axi_clk)
140 clk_prepare_enable(mdp5_mdss->axi_clk);
141 if (mdp5_mdss->vsync_clk)
142 clk_prepare_enable(mdp5_mdss->vsync_clk);
147 static int mdp5_mdss_disable(struct msm_mdss *mdss)
149 struct mdp5_mdss *mdp5_mdss = to_mdp5_mdss(mdss);
152 if (mdp5_mdss->vsync_clk)
153 clk_disable_unprepare(mdp5_mdss->vsync_clk);
154 if (mdp5_mdss->axi_clk)
155 clk_disable_unprepare(mdp5_mdss->axi_clk);
156 clk_disable_unprepare(mdp5_mdss->ahb_clk);
161 static int msm_mdss_get_clocks(struct mdp5_mdss *mdp5_mdss)
163 struct platform_device *pdev =
164 to_platform_device(mdp5_mdss->base.dev->dev);
166 mdp5_mdss->ahb_clk = msm_clk_get(pdev, "iface");
167 if (IS_ERR(mdp5_mdss->ahb_clk))
168 mdp5_mdss->ahb_clk = NULL;
170 mdp5_mdss->axi_clk = msm_clk_get(pdev, "bus");
171 if (IS_ERR(mdp5_mdss->axi_clk))
172 mdp5_mdss->axi_clk = NULL;
174 mdp5_mdss->vsync_clk = msm_clk_get(pdev, "vsync");
175 if (IS_ERR(mdp5_mdss->vsync_clk))
176 mdp5_mdss->vsync_clk = NULL;
181 static void mdp5_mdss_destroy(struct drm_device *dev)
183 struct msm_drm_private *priv = dev->dev_private;
184 struct mdp5_mdss *mdp5_mdss = to_mdp5_mdss(priv->mdss);
189 irq_domain_remove(mdp5_mdss->irqcontroller.domain);
190 mdp5_mdss->irqcontroller.domain = NULL;
192 regulator_disable(mdp5_mdss->vdd);
194 pm_runtime_disable(dev->dev);
197 static const struct msm_mdss_funcs mdss_funcs = {
198 .enable = mdp5_mdss_enable,
199 .disable = mdp5_mdss_disable,
200 .destroy = mdp5_mdss_destroy,
203 int mdp5_mdss_init(struct drm_device *dev)
205 struct platform_device *pdev = to_platform_device(dev->dev);
206 struct msm_drm_private *priv = dev->dev_private;
207 struct mdp5_mdss *mdp5_mdss;
212 if (!of_device_is_compatible(dev->dev->of_node, "qcom,mdss"))
215 mdp5_mdss = devm_kzalloc(dev->dev, sizeof(*mdp5_mdss), GFP_KERNEL);
221 mdp5_mdss->base.dev = dev;
223 mdp5_mdss->mmio = msm_ioremap(pdev, "mdss_phys", "MDSS");
224 if (IS_ERR(mdp5_mdss->mmio)) {
225 ret = PTR_ERR(mdp5_mdss->mmio);
229 mdp5_mdss->vbif = msm_ioremap(pdev, "vbif_phys", "VBIF");
230 if (IS_ERR(mdp5_mdss->vbif)) {
231 ret = PTR_ERR(mdp5_mdss->vbif);
235 ret = msm_mdss_get_clocks(mdp5_mdss);
237 DRM_DEV_ERROR(dev->dev, "failed to get clocks: %d\n", ret);
241 /* Regulator to enable GDSCs in downstream kernels */
242 mdp5_mdss->vdd = devm_regulator_get(dev->dev, "vdd");
243 if (IS_ERR(mdp5_mdss->vdd)) {
244 ret = PTR_ERR(mdp5_mdss->vdd);
248 ret = regulator_enable(mdp5_mdss->vdd);
250 DRM_DEV_ERROR(dev->dev, "failed to enable regulator vdd: %d\n",
255 ret = devm_request_irq(dev->dev, platform_get_irq(pdev, 0),
256 mdss_irq, 0, "mdss_isr", mdp5_mdss);
258 DRM_DEV_ERROR(dev->dev, "failed to init irq: %d\n", ret);
262 ret = mdss_irq_domain_init(mdp5_mdss);
264 DRM_DEV_ERROR(dev->dev, "failed to init sub-block irqs: %d\n", ret);
268 mdp5_mdss->base.funcs = &mdss_funcs;
269 priv->mdss = &mdp5_mdss->base;
271 pm_runtime_enable(dev->dev);
275 regulator_disable(mdp5_mdss->vdd);