e5bea2d398b688ea0b5c8ead40af97ca632dcc49
[openwrt/openwrt.git] /
1 From d437ee67754fc53a2e7309d2f2aaf37c040f5f89 Mon Sep 17 00:00:00 2001
2 From: Dave Stevenson <dave.stevenson@raspberrypi.org>
3 Date: Tue, 4 Jun 2019 12:14:30 +0100
4 Subject: [PATCH 656/782] drm: vc4: Add status of which display is updated
5 through vblank
6
7 Previously multiple displays were slaved off the same SMI
8 interrupt, triggered by HVS channel 1 (HDMI0).
9 This doesn't work if you only have a DPI or DSI screen (HVS channel
10 0), and gives slightly erroneous results with dual HDMI as the
11 events for HDMI1 are incorrect.
12
13 Use SMIDSW0 and SMIDSW1 registers to denote which display has
14 triggered the vblank.
15 Handling should be backwards compatible with older firmware.
16
17 Signed-off-by: Dave Stevenson <dave.stevenson@raspberrypi.org>
18 ---
19 drivers/gpu/drm/vc4/vc4_firmware_kms.c | 41 ++++++++++++++++++++++----
20 1 file changed, 36 insertions(+), 5 deletions(-)
21
22 --- a/drivers/gpu/drm/vc4/vc4_firmware_kms.c
23 +++ b/drivers/gpu/drm/vc4/vc4_firmware_kms.c
24 @@ -230,8 +230,13 @@ static const struct vc_image_format *vc4
25 * hardware, which has only this one register.
26 */
27 #define SMICS 0x0
28 +#define SMIDSW0 0x14
29 +#define SMIDSW1 0x1C
30 #define SMICS_INTERRUPTS (BIT(9) | BIT(10) | BIT(11))
31
32 +/* Flag to denote that the firmware is giving multiple display callbacks */
33 +#define SMI_NEW 0xabcd0000
34 +
35 #define vc4_crtc vc4_kms_crtc
36 #define to_vc4_crtc to_vc4_kms_crtc
37 struct vc4_crtc {
38 @@ -884,16 +889,42 @@ static irqreturn_t vc4_crtc_irq_handler(
39 int i;
40 u32 stat = readl(crtc_list[0]->regs + SMICS);
41 irqreturn_t ret = IRQ_NONE;
42 + u32 chan;
43
44 if (stat & SMICS_INTERRUPTS) {
45 writel(0, crtc_list[0]->regs + SMICS);
46
47 - for (i = 0; crtc_list[i]; i++) {
48 - if (crtc_list[i]->vblank_enabled)
49 - drm_crtc_handle_vblank(&crtc_list[i]->base);
50 - vc4_crtc_handle_page_flip(crtc_list[i]);
51 - ret = IRQ_HANDLED;
52 + chan = readl(crtc_list[0]->regs + SMIDSW0);
53 +
54 + if ((chan & 0xFFFF0000) != SMI_NEW) {
55 + /* Older firmware. Treat the one interrupt as vblank/
56 + * complete for all crtcs.
57 + */
58 + for (i = 0; crtc_list[i]; i++) {
59 + if (crtc_list[i]->vblank_enabled)
60 + drm_crtc_handle_vblank(&crtc_list[i]->base);
61 + vc4_crtc_handle_page_flip(crtc_list[i]);
62 + }
63 + } else {
64 + if (chan & 1) {
65 + writel(SMI_NEW, crtc_list[0]->regs + SMIDSW0);
66 + if (crtc_list[0]->vblank_enabled)
67 + drm_crtc_handle_vblank(&crtc_list[0]->base);
68 + vc4_crtc_handle_page_flip(crtc_list[0]);
69 + }
70 +
71 + /* Check for the secondary display too */
72 + chan = readl(crtc_list[0]->regs + SMIDSW1);
73 +
74 + if (chan & 1) {
75 + writel(SMI_NEW, crtc_list[0]->regs + SMIDSW1);
76 + if (crtc_list[1]->vblank_enabled)
77 + drm_crtc_handle_vblank(&crtc_list[1]->base);
78 + vc4_crtc_handle_page_flip(crtc_list[1]);
79 + }
80 }
81 +
82 + ret = IRQ_HANDLED;
83 }
84
85 return ret;