1 /*
2  * Copyright (C) 2013 Red Hat
3  * Author: Rob Clark <robdclark@gmail.com>
4  *
5  * This program is free software; you can redistribute it and/or modify it
6  * under the terms of the GNU General Public License version 2 as published by
7  * the Free Software Foundation.
8  *
9  * This program is distributed in the hope that it will be useful, but WITHOUT
10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
12  * more details.
13  *
14  * You should have received a copy of the GNU General Public License along with
15  * this program.  If not, see <http://www.gnu.org/licenses/>.
16  */
17 
18 
19 #include "msm_drv.h"
20 #include "mdp4_kms.h"
21 
mdp4_set_irqmask(struct mdp_kms * mdp_kms,uint32_t irqmask)22 void mdp4_set_irqmask(struct mdp_kms *mdp_kms, uint32_t irqmask)
23 {
24 	mdp4_write(to_mdp4_kms(mdp_kms), REG_MDP4_INTR_ENABLE, irqmask);
25 }
26 
mdp4_irq_error_handler(struct mdp_irq * irq,uint32_t irqstatus)27 static void mdp4_irq_error_handler(struct mdp_irq *irq, uint32_t irqstatus)
28 {
29 	DRM_ERROR("errors: %08x\n", irqstatus);
30 }
31 
mdp4_irq_preinstall(struct msm_kms * kms)32 void mdp4_irq_preinstall(struct msm_kms *kms)
33 {
34 	struct mdp4_kms *mdp4_kms = to_mdp4_kms(to_mdp_kms(kms));
35 	mdp4_enable(mdp4_kms);
36 	mdp4_write(mdp4_kms, REG_MDP4_INTR_CLEAR, 0xffffffff);
37 	mdp4_write(mdp4_kms, REG_MDP4_INTR_ENABLE, 0x00000000);
38 	mdp4_disable(mdp4_kms);
39 }
40 
mdp4_irq_postinstall(struct msm_kms * kms)41 int mdp4_irq_postinstall(struct msm_kms *kms)
42 {
43 	struct mdp_kms *mdp_kms = to_mdp_kms(kms);
44 	struct mdp4_kms *mdp4_kms = to_mdp4_kms(mdp_kms);
45 	struct mdp_irq *error_handler = &mdp4_kms->error_handler;
46 
47 	error_handler->irq = mdp4_irq_error_handler;
48 	error_handler->irqmask = MDP4_IRQ_PRIMARY_INTF_UDERRUN |
49 			MDP4_IRQ_EXTERNAL_INTF_UDERRUN;
50 
51 	mdp_irq_register(mdp_kms, error_handler);
52 
53 	return 0;
54 }
55 
mdp4_irq_uninstall(struct msm_kms * kms)56 void mdp4_irq_uninstall(struct msm_kms *kms)
57 {
58 	struct mdp4_kms *mdp4_kms = to_mdp4_kms(to_mdp_kms(kms));
59 	mdp4_enable(mdp4_kms);
60 	mdp4_write(mdp4_kms, REG_MDP4_INTR_ENABLE, 0x00000000);
61 	mdp4_disable(mdp4_kms);
62 }
63 
mdp4_irq(struct msm_kms * kms)64 irqreturn_t mdp4_irq(struct msm_kms *kms)
65 {
66 	struct mdp_kms *mdp_kms = to_mdp_kms(kms);
67 	struct mdp4_kms *mdp4_kms = to_mdp4_kms(mdp_kms);
68 	struct drm_device *dev = mdp4_kms->dev;
69 	struct msm_drm_private *priv = dev->dev_private;
70 	unsigned int id;
71 	uint32_t status;
72 
73 	status = mdp4_read(mdp4_kms, REG_MDP4_INTR_STATUS);
74 	mdp4_write(mdp4_kms, REG_MDP4_INTR_CLEAR, status);
75 
76 	VERB("status=%08x", status);
77 
78 	mdp_dispatch_irqs(mdp_kms, status);
79 
80 	for (id = 0; id < priv->num_crtcs; id++)
81 		if (status & mdp4_crtc_vblank(priv->crtcs[id]))
82 			drm_handle_vblank(dev, id);
83 
84 	return IRQ_HANDLED;
85 }
86 
mdp4_enable_vblank(struct msm_kms * kms,struct drm_crtc * crtc)87 int mdp4_enable_vblank(struct msm_kms *kms, struct drm_crtc *crtc)
88 {
89 	mdp_update_vblank_mask(to_mdp_kms(kms),
90 			mdp4_crtc_vblank(crtc), true);
91 	return 0;
92 }
93 
mdp4_disable_vblank(struct msm_kms * kms,struct drm_crtc * crtc)94 void mdp4_disable_vblank(struct msm_kms *kms, struct drm_crtc *crtc)
95 {
96 	mdp_update_vblank_mask(to_mdp_kms(kms),
97 			mdp4_crtc_vblank(crtc), false);
98 }
99