static void fsl_dcu_drm_plane_atomic_disable(struct drm_plane *plane, struct drm_plane_state *old_state) { struct fsl_dcu_drm_device *fsl_dev = plane->dev->dev_private; unsigned int value; int index; index = fsl_dcu_drm_plane_index(plane); if (index < 0) return; regmap_read(fsl_dev->regmap, DCU_CTRLDESCLN(index, 4), &value); value &= ~DCU_LAYER_EN; regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 4), value); }
static void fsl_dcu_drm_plane_atomic_disable(struct drm_plane *plane, struct drm_plane_state *old_state) { struct fsl_dcu_drm_device *fsl_dev = plane->dev->dev_private; unsigned int value; int index, ret; index = fsl_dcu_drm_plane_index(plane); if (index < 0) return; ret = regmap_read(fsl_dev->regmap, DCU_CTRLDESCLN(index, 4), &value); if (ret) dev_err(fsl_dev->dev, "read DCU_INT_MASK failed\n"); value &= ~DCU_LAYER_EN; ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 4), value); if (ret) dev_err(fsl_dev->dev, "set DCU register failed\n"); }
void fsl_dcu_drm_init_planes(struct drm_device *dev) { struct fsl_dcu_drm_device *fsl_dev = dev->dev_private; int i, j; for (i = 0; i < fsl_dev->soc->total_layer; i++) { for (j = 1; j <= fsl_dev->soc->layer_regs; j++) regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(i, j), 0); } regmap_update_bits(fsl_dev->regmap, DCU_DCU_MODE, DCU_MODE_DCU_MODE_MASK, DCU_MODE_DCU_MODE(DCU_MODE_OFF)); regmap_write(fsl_dev->regmap, DCU_UPDATE_MODE, DCU_UPDATE_MODE_READREG); }
int fsl_dcu_drm_crtc_create(struct fsl_dcu_drm_device *fsl_dev) { struct drm_plane *primary; struct drm_crtc *crtc = &fsl_dev->crtc; unsigned int i, j, reg_num; int ret; primary = fsl_dcu_drm_primary_create_plane(fsl_dev->drm); ret = drm_crtc_init_with_planes(fsl_dev->drm, crtc, primary, NULL, &fsl_dcu_drm_crtc_funcs, NULL); if (ret < 0) return ret; drm_crtc_helper_add(crtc, &fsl_dcu_drm_crtc_helper_funcs); if (!strcmp(fsl_dev->soc->name, "ls1021a")) reg_num = LS1021A_LAYER_REG_NUM; else reg_num = VF610_LAYER_REG_NUM; for (i = 0; i <= fsl_dev->soc->total_layer; i++) { for (j = 0; j < reg_num; j++) { ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(i, j), 0); if (ret) goto init_failed; } } ret = regmap_update_bits(fsl_dev->regmap, DCU_DCU_MODE, DCU_MODE_DCU_MODE_MASK, DCU_MODE_DCU_MODE(DCU_MODE_OFF)); if (ret) goto init_failed; ret = regmap_write(fsl_dev->regmap, DCU_UPDATE_MODE, DCU_UPDATE_MODE_READREG); if (ret) goto init_failed; return 0; init_failed: dev_err(fsl_dev->dev, "init DCU register failed\n"); return ret; }
static void fsl_dcu_drm_plane_atomic_update(struct drm_plane *plane, struct drm_plane_state *old_state) { struct fsl_dcu_drm_device *fsl_dev = plane->dev->dev_private; struct drm_plane_state *state = plane->state; struct drm_framebuffer *fb = plane->state->fb; struct drm_gem_cma_object *gem; unsigned int alpha, bpp; int index, ret; if (!fb) return; index = fsl_dcu_drm_plane_index(plane); if (index < 0) return; gem = drm_fb_cma_get_gem_obj(fb, 0); switch (fb->pixel_format) { case DRM_FORMAT_RGB565: bpp = FSL_DCU_RGB565; alpha = 0xff; break; case DRM_FORMAT_RGB888: bpp = FSL_DCU_RGB888; alpha = 0xff; break; case DRM_FORMAT_ARGB8888: bpp = FSL_DCU_ARGB8888; alpha = 0xff; break; case DRM_FORMAT_BGRA4444: bpp = FSL_DCU_ARGB4444; alpha = 0xff; break; case DRM_FORMAT_ARGB1555: bpp = FSL_DCU_ARGB1555; alpha = 0xff; break; case DRM_FORMAT_YUV422: bpp = FSL_DCU_YUV422; alpha = 0xff; break; default: return; } ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 1), DCU_LAYER_HEIGHT(state->crtc_h) | DCU_LAYER_WIDTH(state->crtc_w)); if (ret) goto set_failed; ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 2), DCU_LAYER_POSY(state->crtc_y) | DCU_LAYER_POSX(state->crtc_x)); if (ret) goto set_failed; ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 3), gem->paddr); if (ret) goto set_failed; ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 4), DCU_LAYER_EN | DCU_LAYER_TRANS(alpha) | DCU_LAYER_BPP(bpp) | DCU_LAYER_AB(0)); if (ret) goto set_failed; ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 5), DCU_LAYER_CKMAX_R(0xFF) | DCU_LAYER_CKMAX_G(0xFF) | DCU_LAYER_CKMAX_B(0xFF)); if (ret) goto set_failed; ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 6), DCU_LAYER_CKMIN_R(0) | DCU_LAYER_CKMIN_G(0) | DCU_LAYER_CKMIN_B(0)); if (ret) goto set_failed; ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 7), 0); if (ret) goto set_failed; ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 8), DCU_LAYER_FG_FCOLOR(0)); if (ret) goto set_failed; ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 9), DCU_LAYER_BG_BCOLOR(0)); if (ret) goto set_failed; if (!strcmp(fsl_dev->soc->name, "ls1021a")) { ret = regmap_write(fsl_dev->regmap, DCU_CTRLDESCLN(index, 10), DCU_LAYER_POST_SKIP(0) | DCU_LAYER_PRE_SKIP(0)); if (ret) goto set_failed; } ret = regmap_update_bits(fsl_dev->regmap, DCU_DCU_MODE, DCU_MODE_DCU_MODE_MASK, DCU_MODE_DCU_MODE(DCU_MODE_NORMAL)); if (ret) goto set_failed; ret = regmap_write(fsl_dev->regmap, DCU_UPDATE_MODE, DCU_UPDATE_MODE_READREG); if (ret) goto set_failed; return; set_failed: dev_err(fsl_dev->dev, "set DCU register failed\n"); }