1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (C) 2018 Texas Instruments Incorporated - https://www.ti.com/
4 * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
5 */
6
7 #include <linux/platform_device.h>
8
9 #include <drm/drm_drv.h>
10 #include <drm/drm_print.h>
11
12 #include "tidss_crtc.h"
13 #include "tidss_dispc.h"
14 #include "tidss_drv.h"
15 #include "tidss_irq.h"
16 #include "tidss_plane.h"
17
tidss_irq_update(struct tidss_device * tidss)18 static void tidss_irq_update(struct tidss_device *tidss)
19 {
20 assert_spin_locked(&tidss->irq_lock);
21
22 dispc_set_irqenable(tidss->dispc, tidss->irq_mask);
23 }
24
tidss_irq_enable_vblank(struct drm_crtc * crtc)25 void tidss_irq_enable_vblank(struct drm_crtc *crtc)
26 {
27 struct drm_device *ddev = crtc->dev;
28 struct tidss_device *tidss = to_tidss(ddev);
29 struct tidss_crtc *tcrtc = to_tidss_crtc(crtc);
30 u32 hw_videoport = tcrtc->hw_videoport;
31 unsigned long flags;
32
33 spin_lock_irqsave(&tidss->irq_lock, flags);
34 tidss->irq_mask |= DSS_IRQ_VP_VSYNC_EVEN(hw_videoport) |
35 DSS_IRQ_VP_VSYNC_ODD(hw_videoport);
36 tidss_irq_update(tidss);
37 spin_unlock_irqrestore(&tidss->irq_lock, flags);
38 }
39
tidss_irq_disable_vblank(struct drm_crtc * crtc)40 void tidss_irq_disable_vblank(struct drm_crtc *crtc)
41 {
42 struct drm_device *ddev = crtc->dev;
43 struct tidss_device *tidss = to_tidss(ddev);
44 struct tidss_crtc *tcrtc = to_tidss_crtc(crtc);
45 u32 hw_videoport = tcrtc->hw_videoport;
46 unsigned long flags;
47
48 spin_lock_irqsave(&tidss->irq_lock, flags);
49 tidss->irq_mask &= ~(DSS_IRQ_VP_VSYNC_EVEN(hw_videoport) |
50 DSS_IRQ_VP_VSYNC_ODD(hw_videoport));
51 tidss_irq_update(tidss);
52 spin_unlock_irqrestore(&tidss->irq_lock, flags);
53 }
54
tidss_irq_handler(int irq,void * arg)55 static irqreturn_t tidss_irq_handler(int irq, void *arg)
56 {
57 struct drm_device *ddev = (struct drm_device *)arg;
58 struct tidss_device *tidss = to_tidss(ddev);
59 unsigned int id;
60 dispc_irq_t irqstatus;
61
62 spin_lock(&tidss->irq_lock);
63 irqstatus = dispc_read_and_clear_irqstatus(tidss->dispc);
64 spin_unlock(&tidss->irq_lock);
65
66 for (id = 0; id < tidss->num_crtcs; id++) {
67 struct drm_crtc *crtc = tidss->crtcs[id];
68 struct tidss_crtc *tcrtc = to_tidss_crtc(crtc);
69 u32 hw_videoport = tcrtc->hw_videoport;
70
71 if (irqstatus & (DSS_IRQ_VP_VSYNC_EVEN(hw_videoport) |
72 DSS_IRQ_VP_VSYNC_ODD(hw_videoport)))
73 tidss_crtc_vblank_irq(crtc);
74
75 if (irqstatus & (DSS_IRQ_VP_FRAME_DONE(hw_videoport)))
76 tidss_crtc_framedone_irq(crtc);
77
78 if (irqstatus & DSS_IRQ_VP_SYNC_LOST(hw_videoport))
79 tidss_crtc_error_irq(crtc, irqstatus);
80 }
81
82 for (unsigned int i = 0; i < tidss->num_planes; ++i) {
83 struct drm_plane *plane = tidss->planes[i];
84 struct tidss_plane *tplane = to_tidss_plane(plane);
85
86 if (irqstatus & DSS_IRQ_PLANE_FIFO_UNDERFLOW(tplane->hw_plane_id))
87 tidss_plane_error_irq(plane, irqstatus);
88 }
89
90 return IRQ_HANDLED;
91 }
92
tidss_irq_resume(struct tidss_device * tidss)93 void tidss_irq_resume(struct tidss_device *tidss)
94 {
95 unsigned long flags;
96
97 spin_lock_irqsave(&tidss->irq_lock, flags);
98 tidss_irq_update(tidss);
99 spin_unlock_irqrestore(&tidss->irq_lock, flags);
100 }
101
tidss_irq_install(struct drm_device * ddev,unsigned int irq)102 int tidss_irq_install(struct drm_device *ddev, unsigned int irq)
103 {
104 struct tidss_device *tidss = to_tidss(ddev);
105 int ret;
106
107 if (irq == IRQ_NOTCONNECTED)
108 return -ENOTCONN;
109
110 ret = request_irq(irq, tidss_irq_handler, 0, ddev->driver->name, ddev);
111 if (ret)
112 return ret;
113
114 tidss->irq_mask = 0;
115
116 for (unsigned int i = 0; i < tidss->num_crtcs; ++i) {
117 struct tidss_crtc *tcrtc = to_tidss_crtc(tidss->crtcs[i]);
118
119 tidss->irq_mask |= DSS_IRQ_VP_SYNC_LOST(tcrtc->hw_videoport);
120
121 tidss->irq_mask |= DSS_IRQ_VP_FRAME_DONE(tcrtc->hw_videoport);
122 }
123
124 for (unsigned int i = 0; i < tidss->num_planes; ++i) {
125 struct tidss_plane *tplane = to_tidss_plane(tidss->planes[i]);
126
127 tidss->irq_mask |= DSS_IRQ_PLANE_FIFO_UNDERFLOW(tplane->hw_plane_id);
128 }
129
130 return 0;
131 }
132
tidss_irq_uninstall(struct drm_device * ddev)133 void tidss_irq_uninstall(struct drm_device *ddev)
134 {
135 struct tidss_device *tidss = to_tidss(ddev);
136
137 free_irq(tidss->irq, ddev);
138 }
139