2 * Copyright 2015 Freescale Semiconductor, Inc.
4 * Freescale DCU drm device driver
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
12 #include <linux/regmap.h>
15 #include <drm/drm_atomic_helper.h>
16 #include <drm/drm_crtc.h>
17 #include <drm/drm_crtc_helper.h>
18 #include <drm/drm_fb_cma_helper.h>
19 #include <drm/drm_gem_cma_helper.h>
20 #include <drm/drm_plane_helper.h>
22 #include "fsl_dcu_drm_drv.h"
23 #include "fsl_dcu_drm_plane.h"
25 static int fsl_dcu_drm_plane_index(struct drm_plane
*plane
)
27 struct fsl_dcu_drm_device
*fsl_dev
= plane
->dev
->dev_private
;
28 unsigned int total_layer
= fsl_dev
->soc
->total_layer
;
31 index
= drm_plane_index(plane
);
32 if (index
< total_layer
)
33 return total_layer
- index
- 1;
35 dev_err(fsl_dev
->dev
, "No more layer left\n");
39 static int fsl_dcu_drm_plane_atomic_check(struct drm_plane
*plane
,
40 struct drm_plane_state
*state
)
42 struct drm_framebuffer
*fb
= state
->fb
;
44 switch (fb
->pixel_format
) {
45 case DRM_FORMAT_RGB565
:
46 case DRM_FORMAT_RGB888
:
47 case DRM_FORMAT_ARGB8888
:
48 case DRM_FORMAT_BGRA4444
:
49 case DRM_FORMAT_ARGB1555
:
50 case DRM_FORMAT_YUV422
:
57 static void fsl_dcu_drm_plane_atomic_disable(struct drm_plane
*plane
,
58 struct drm_plane_state
*old_state
)
60 struct fsl_dcu_drm_device
*fsl_dev
= plane
->dev
->dev_private
;
61 unsigned int index
, value
, ret
;
63 index
= fsl_dcu_drm_plane_index(plane
);
67 ret
= regmap_read(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 4), &value
);
69 dev_err(fsl_dev
->dev
, "read DCU_INT_MASK failed\n");
70 value
&= ~DCU_LAYER_EN
;
71 ret
= regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 4), value
);
73 dev_err(fsl_dev
->dev
, "set DCU register failed\n");
76 static void fsl_dcu_drm_plane_atomic_update(struct drm_plane
*plane
,
77 struct drm_plane_state
*old_state
)
80 struct fsl_dcu_drm_device
*fsl_dev
= plane
->dev
->dev_private
;
81 struct drm_plane_state
*state
= plane
->state
;
82 struct drm_framebuffer
*fb
= plane
->state
->fb
;
83 struct drm_gem_cma_object
*gem
;
84 unsigned int alpha
, bpp
;
90 index
= fsl_dcu_drm_plane_index(plane
);
94 gem
= drm_fb_cma_get_gem_obj(fb
, 0);
96 switch (fb
->pixel_format
) {
97 case DRM_FORMAT_RGB565
:
101 case DRM_FORMAT_RGB888
:
102 bpp
= FSL_DCU_RGB888
;
105 case DRM_FORMAT_ARGB8888
:
106 bpp
= FSL_DCU_ARGB8888
;
109 case DRM_FORMAT_BGRA4444
:
110 bpp
= FSL_DCU_ARGB4444
;
113 case DRM_FORMAT_ARGB1555
:
114 bpp
= FSL_DCU_ARGB1555
;
117 case DRM_FORMAT_YUV422
:
118 bpp
= FSL_DCU_YUV422
;
125 ret
= regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 1),
126 DCU_LAYER_HEIGHT(state
->crtc_h
) |
127 DCU_LAYER_WIDTH(state
->crtc_w
));
130 ret
= regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 2),
131 DCU_LAYER_POSY(state
->crtc_y
) |
132 DCU_LAYER_POSX(state
->crtc_x
));
135 ret
= regmap_write(fsl_dev
->regmap
,
136 DCU_CTRLDESCLN(index
, 3), gem
->paddr
);
139 ret
= regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 4),
141 DCU_LAYER_TRANS(alpha
) |
146 ret
= regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 5),
147 DCU_LAYER_CKMAX_R(0xFF) |
148 DCU_LAYER_CKMAX_G(0xFF) |
149 DCU_LAYER_CKMAX_B(0xFF));
152 ret
= regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 6),
153 DCU_LAYER_CKMIN_R(0) |
154 DCU_LAYER_CKMIN_G(0) |
155 DCU_LAYER_CKMIN_B(0));
158 ret
= regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 7), 0);
161 ret
= regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 8),
162 DCU_LAYER_FG_FCOLOR(0));
165 ret
= regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 9),
166 DCU_LAYER_BG_BCOLOR(0));
169 if (!strcmp(fsl_dev
->soc
->name
, "ls1021a")) {
170 ret
= regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 10),
171 DCU_LAYER_POST_SKIP(0) |
172 DCU_LAYER_PRE_SKIP(0));
176 ret
= regmap_update_bits(fsl_dev
->regmap
, DCU_DCU_MODE
,
177 DCU_MODE_DCU_MODE_MASK
,
178 DCU_MODE_DCU_MODE(DCU_MODE_NORMAL
));
181 ret
= regmap_write(fsl_dev
->regmap
,
182 DCU_UPDATE_MODE
, DCU_UPDATE_MODE_READREG
);
188 dev_err(fsl_dev
->dev
, "set DCU register failed\n");
192 fsl_dcu_drm_plane_cleanup_fb(struct drm_plane
*plane
,
193 struct drm_framebuffer
*fb
,
194 const struct drm_plane_state
*new_state
)
199 fsl_dcu_drm_plane_prepare_fb(struct drm_plane
*plane
,
200 struct drm_framebuffer
*fb
,
201 const struct drm_plane_state
*new_state
)
206 static const struct drm_plane_helper_funcs fsl_dcu_drm_plane_helper_funcs
= {
207 .atomic_check
= fsl_dcu_drm_plane_atomic_check
,
208 .atomic_disable
= fsl_dcu_drm_plane_atomic_disable
,
209 .atomic_update
= fsl_dcu_drm_plane_atomic_update
,
210 .cleanup_fb
= fsl_dcu_drm_plane_cleanup_fb
,
211 .prepare_fb
= fsl_dcu_drm_plane_prepare_fb
,
214 static void fsl_dcu_drm_plane_destroy(struct drm_plane
*plane
)
216 drm_plane_cleanup(plane
);
219 static const struct drm_plane_funcs fsl_dcu_drm_plane_funcs
= {
220 .atomic_duplicate_state
= drm_atomic_helper_plane_duplicate_state
,
221 .atomic_destroy_state
= drm_atomic_helper_plane_destroy_state
,
222 .destroy
= fsl_dcu_drm_plane_destroy
,
223 .disable_plane
= drm_atomic_helper_disable_plane
,
224 .reset
= drm_atomic_helper_plane_reset
,
225 .update_plane
= drm_atomic_helper_update_plane
,
228 static const u32 fsl_dcu_drm_plane_formats
[] = {
237 struct drm_plane
*fsl_dcu_drm_primary_create_plane(struct drm_device
*dev
)
239 struct drm_plane
*primary
;
242 primary
= kzalloc(sizeof(*primary
), GFP_KERNEL
);
244 DRM_DEBUG_KMS("Failed to allocate primary plane\n");
248 /* possible_crtc's will be filled in later by crtc_init */
249 ret
= drm_universal_plane_init(dev
, primary
, 0,
250 &fsl_dcu_drm_plane_funcs
,
251 fsl_dcu_drm_plane_formats
,
252 ARRAY_SIZE(fsl_dcu_drm_plane_formats
),
253 DRM_PLANE_TYPE_PRIMARY
);
258 drm_plane_helper_add(primary
, &fsl_dcu_drm_plane_helper_funcs
);