1 // SPDX-License-Identifier: GPL-2.0+ 2 // Copyright 2018 IBM Corporation 3 4 #include <linux/clk.h> 5 #include <linux/reset.h> 6 #include <linux/regmap.h> 7 8 #include <drm/drm_crtc_helper.h> 9 #include <drm/drm_device.h> 10 #include <drm/drm_fb_cma_helper.h> 11 #include <drm/drm_fourcc.h> 12 #include <drm/drm_gem_cma_helper.h> 13 #include <drm/drm_gem_framebuffer_helper.h> 14 #include <drm/drm_panel.h> 15 #include <drm/drm_simple_kms_helper.h> 16 #include <drm/drm_vblank.h> 17 18 #include "aspeed_gfx.h" 19 20 static struct aspeed_gfx * 21 drm_pipe_to_aspeed_gfx(struct drm_simple_display_pipe *pipe) 22 { 23 return container_of(pipe, struct aspeed_gfx, pipe); 24 } 25 26 static int aspeed_gfx_set_pixel_fmt(struct aspeed_gfx *priv, u32 *bpp) 27 { 28 struct drm_crtc *crtc = &priv->pipe.crtc; 29 struct drm_device *drm = crtc->dev; 30 const u32 format = crtc->primary->state->fb->format->format; 31 u32 ctrl1; 32 33 ctrl1 = readl(priv->base + CRT_CTRL1); 34 ctrl1 &= ~CRT_CTRL_COLOR_MASK; 35 36 switch (format) { 37 case DRM_FORMAT_RGB565: 38 dev_dbg(drm->dev, "Setting up RGB565 mode\n"); 39 ctrl1 |= CRT_CTRL_COLOR_RGB565; 40 *bpp = 16; 41 break; 42 case DRM_FORMAT_XRGB8888: 43 dev_dbg(drm->dev, "Setting up XRGB8888 mode\n"); 44 ctrl1 |= CRT_CTRL_COLOR_XRGB8888; 45 *bpp = 32; 46 break; 47 default: 48 dev_err(drm->dev, "Unhandled pixel format %08x\n", format); 49 return -EINVAL; 50 } 51 52 writel(ctrl1, priv->base + CRT_CTRL1); 53 54 return 0; 55 } 56 57 static void aspeed_gfx_enable_controller(struct aspeed_gfx *priv) 58 { 59 u32 ctrl1 = readl(priv->base + CRT_CTRL1); 60 u32 ctrl2 = readl(priv->base + CRT_CTRL2); 61 62 /* SCU2C: set DAC source for display output to Graphics CRT (GFX) */ 63 regmap_update_bits(priv->scu, 0x2c, BIT(16), BIT(16)); 64 65 writel(ctrl1 | CRT_CTRL_EN, priv->base + CRT_CTRL1); 66 writel(ctrl2 | CRT_CTRL_DAC_EN, priv->base + CRT_CTRL2); 67 } 68 69 static void aspeed_gfx_disable_controller(struct aspeed_gfx *priv) 70 { 71 u32 ctrl1 = readl(priv->base + CRT_CTRL1); 72 u32 ctrl2 = readl(priv->base + CRT_CTRL2); 73 74 writel(ctrl1 & ~CRT_CTRL_EN, priv->base + CRT_CTRL1); 75 writel(ctrl2 & ~CRT_CTRL_DAC_EN, priv->base + CRT_CTRL2); 76 77 regmap_update_bits(priv->scu, 0x2c, BIT(16), 0); 78 } 79 80 static void aspeed_gfx_crtc_mode_set_nofb(struct aspeed_gfx *priv) 81 { 82 struct drm_display_mode *m = &priv->pipe.crtc.state->adjusted_mode; 83 u32 ctrl1, d_offset, t_count, bpp; 84 int err; 85 86 err = aspeed_gfx_set_pixel_fmt(priv, &bpp); 87 if (err) 88 return; 89 90 #if 0 91 /* TODO: we have only been able to test with the 40MHz USB clock. The 92 * clock is fixed, so we cannot adjust it here. */ 93 clk_set_rate(priv->pixel_clk, m->crtc_clock * 1000); 94 #endif 95 96 ctrl1 = readl(priv->base + CRT_CTRL1); 97 ctrl1 &= ~(CRT_CTRL_INTERLACED | 98 CRT_CTRL_HSYNC_NEGATIVE | 99 CRT_CTRL_VSYNC_NEGATIVE); 100 101 if (m->flags & DRM_MODE_FLAG_INTERLACE) 102 ctrl1 |= CRT_CTRL_INTERLACED; 103 104 if (!(m->flags & DRM_MODE_FLAG_PHSYNC)) 105 ctrl1 |= CRT_CTRL_HSYNC_NEGATIVE; 106 107 if (!(m->flags & DRM_MODE_FLAG_PVSYNC)) 108 ctrl1 |= CRT_CTRL_VSYNC_NEGATIVE; 109 110 writel(ctrl1, priv->base + CRT_CTRL1); 111 112 /* Horizontal timing */ 113 writel(CRT_H_TOTAL(m->htotal - 1) | CRT_H_DE(m->hdisplay - 1), 114 priv->base + CRT_HORIZ0); 115 writel(CRT_H_RS_START(m->hsync_start - 1) | CRT_H_RS_END(m->hsync_end), 116 priv->base + CRT_HORIZ1); 117 118 119 /* Vertical timing */ 120 writel(CRT_V_TOTAL(m->vtotal - 1) | CRT_V_DE(m->vdisplay - 1), 121 priv->base + CRT_VERT0); 122 writel(CRT_V_RS_START(m->vsync_start) | CRT_V_RS_END(m->vsync_end), 123 priv->base + CRT_VERT1); 124 125 /* 126 * Display Offset: address difference between consecutive scan lines 127 * Terminal Count: memory size of one scan line 128 */ 129 d_offset = m->hdisplay * bpp / 8; 130 t_count = (m->hdisplay * bpp + 127) / 128; 131 writel(CRT_DISP_OFFSET(d_offset) | CRT_TERM_COUNT(t_count), 132 priv->base + CRT_OFFSET); 133 134 /* 135 * Threshold: FIFO thresholds of refill and stop (16 byte chunks 136 * per line, rounded up) 137 */ 138 writel(G5_CRT_THROD_VAL, priv->base + CRT_THROD); 139 } 140 141 static void aspeed_gfx_pipe_enable(struct drm_simple_display_pipe *pipe, 142 struct drm_crtc_state *crtc_state, 143 struct drm_plane_state *plane_state) 144 { 145 struct aspeed_gfx *priv = drm_pipe_to_aspeed_gfx(pipe); 146 struct drm_crtc *crtc = &pipe->crtc; 147 148 aspeed_gfx_crtc_mode_set_nofb(priv); 149 aspeed_gfx_enable_controller(priv); 150 drm_crtc_vblank_on(crtc); 151 } 152 153 static void aspeed_gfx_pipe_disable(struct drm_simple_display_pipe *pipe) 154 { 155 struct aspeed_gfx *priv = drm_pipe_to_aspeed_gfx(pipe); 156 struct drm_crtc *crtc = &pipe->crtc; 157 158 drm_crtc_vblank_off(crtc); 159 aspeed_gfx_disable_controller(priv); 160 } 161 162 static void aspeed_gfx_pipe_update(struct drm_simple_display_pipe *pipe, 163 struct drm_plane_state *plane_state) 164 { 165 struct aspeed_gfx *priv = drm_pipe_to_aspeed_gfx(pipe); 166 struct drm_crtc *crtc = &pipe->crtc; 167 struct drm_framebuffer *fb = pipe->plane.state->fb; 168 struct drm_pending_vblank_event *event; 169 struct drm_gem_cma_object *gem; 170 171 spin_lock_irq(&crtc->dev->event_lock); 172 event = crtc->state->event; 173 if (event) { 174 crtc->state->event = NULL; 175 176 if (drm_crtc_vblank_get(crtc) == 0) 177 drm_crtc_arm_vblank_event(crtc, event); 178 else 179 drm_crtc_send_vblank_event(crtc, event); 180 } 181 spin_unlock_irq(&crtc->dev->event_lock); 182 183 if (!fb) 184 return; 185 186 gem = drm_fb_cma_get_gem_obj(fb, 0); 187 if (!gem) 188 return; 189 writel(gem->paddr, priv->base + CRT_ADDR); 190 } 191 192 static int aspeed_gfx_enable_vblank(struct drm_simple_display_pipe *pipe) 193 { 194 struct aspeed_gfx *priv = drm_pipe_to_aspeed_gfx(pipe); 195 u32 reg = readl(priv->base + CRT_CTRL1); 196 197 /* Clear pending VBLANK IRQ */ 198 writel(reg | CRT_CTRL_VERTICAL_INTR_STS, priv->base + CRT_CTRL1); 199 200 reg |= CRT_CTRL_VERTICAL_INTR_EN; 201 writel(reg, priv->base + CRT_CTRL1); 202 203 return 0; 204 } 205 206 static void aspeed_gfx_disable_vblank(struct drm_simple_display_pipe *pipe) 207 { 208 struct aspeed_gfx *priv = drm_pipe_to_aspeed_gfx(pipe); 209 u32 reg = readl(priv->base + CRT_CTRL1); 210 211 reg &= ~CRT_CTRL_VERTICAL_INTR_EN; 212 writel(reg, priv->base + CRT_CTRL1); 213 214 /* Clear pending VBLANK IRQ */ 215 writel(reg | CRT_CTRL_VERTICAL_INTR_STS, priv->base + CRT_CTRL1); 216 } 217 218 static struct drm_simple_display_pipe_funcs aspeed_gfx_funcs = { 219 .enable = aspeed_gfx_pipe_enable, 220 .disable = aspeed_gfx_pipe_disable, 221 .update = aspeed_gfx_pipe_update, 222 .prepare_fb = drm_gem_fb_simple_display_pipe_prepare_fb, 223 .enable_vblank = aspeed_gfx_enable_vblank, 224 .disable_vblank = aspeed_gfx_disable_vblank, 225 }; 226 227 static const uint32_t aspeed_gfx_formats[] = { 228 DRM_FORMAT_XRGB8888, 229 DRM_FORMAT_RGB565, 230 }; 231 232 int aspeed_gfx_create_pipe(struct drm_device *drm) 233 { 234 struct aspeed_gfx *priv = drm->dev_private; 235 236 return drm_simple_display_pipe_init(drm, &priv->pipe, &aspeed_gfx_funcs, 237 aspeed_gfx_formats, 238 ARRAY_SIZE(aspeed_gfx_formats), 239 NULL, 240 &priv->connector); 241 } 242