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 if (!state
->fb
|| !state
->crtc
)
47 switch (fb
->pixel_format
) {
48 case DRM_FORMAT_RGB565
:
49 case DRM_FORMAT_RGB888
:
50 case DRM_FORMAT_ARGB8888
:
51 case DRM_FORMAT_BGRA4444
:
52 case DRM_FORMAT_ARGB1555
:
53 case DRM_FORMAT_YUV422
:
60 static void fsl_dcu_drm_plane_atomic_disable(struct drm_plane
*plane
,
61 struct drm_plane_state
*old_state
)
63 struct fsl_dcu_drm_device
*fsl_dev
= plane
->dev
->dev_private
;
67 index
= fsl_dcu_drm_plane_index(plane
);
71 regmap_read(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 4), &value
);
72 value
&= ~DCU_LAYER_EN
;
73 regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 4), value
);
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 regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 1),
126 DCU_LAYER_HEIGHT(state
->crtc_h
) |
127 DCU_LAYER_WIDTH(state
->crtc_w
));
128 regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 2),
129 DCU_LAYER_POSY(state
->crtc_y
) |
130 DCU_LAYER_POSX(state
->crtc_x
));
131 regmap_write(fsl_dev
->regmap
,
132 DCU_CTRLDESCLN(index
, 3), gem
->paddr
);
133 regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 4),
135 DCU_LAYER_TRANS(alpha
) |
138 regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 5),
139 DCU_LAYER_CKMAX_R(0xFF) |
140 DCU_LAYER_CKMAX_G(0xFF) |
141 DCU_LAYER_CKMAX_B(0xFF));
142 regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 6),
143 DCU_LAYER_CKMIN_R(0) |
144 DCU_LAYER_CKMIN_G(0) |
145 DCU_LAYER_CKMIN_B(0));
146 regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 7), 0);
147 regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 8),
148 DCU_LAYER_FG_FCOLOR(0));
149 regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 9),
150 DCU_LAYER_BG_BCOLOR(0));
152 if (!strcmp(fsl_dev
->soc
->name
, "ls1021a")) {
153 regmap_write(fsl_dev
->regmap
, DCU_CTRLDESCLN(index
, 10),
154 DCU_LAYER_POST_SKIP(0) |
155 DCU_LAYER_PRE_SKIP(0));
157 regmap_update_bits(fsl_dev
->regmap
, DCU_DCU_MODE
,
158 DCU_MODE_DCU_MODE_MASK
,
159 DCU_MODE_DCU_MODE(DCU_MODE_NORMAL
));
160 regmap_write(fsl_dev
->regmap
,
161 DCU_UPDATE_MODE
, DCU_UPDATE_MODE_READREG
);
167 fsl_dcu_drm_plane_cleanup_fb(struct drm_plane
*plane
,
168 const struct drm_plane_state
*new_state
)
173 fsl_dcu_drm_plane_prepare_fb(struct drm_plane
*plane
,
174 const struct drm_plane_state
*new_state
)
179 static const struct drm_plane_helper_funcs fsl_dcu_drm_plane_helper_funcs
= {
180 .atomic_check
= fsl_dcu_drm_plane_atomic_check
,
181 .atomic_disable
= fsl_dcu_drm_plane_atomic_disable
,
182 .atomic_update
= fsl_dcu_drm_plane_atomic_update
,
183 .cleanup_fb
= fsl_dcu_drm_plane_cleanup_fb
,
184 .prepare_fb
= fsl_dcu_drm_plane_prepare_fb
,
187 static void fsl_dcu_drm_plane_destroy(struct drm_plane
*plane
)
189 drm_plane_cleanup(plane
);
193 static const struct drm_plane_funcs fsl_dcu_drm_plane_funcs
= {
194 .atomic_duplicate_state
= drm_atomic_helper_plane_duplicate_state
,
195 .atomic_destroy_state
= drm_atomic_helper_plane_destroy_state
,
196 .destroy
= fsl_dcu_drm_plane_destroy
,
197 .disable_plane
= drm_atomic_helper_disable_plane
,
198 .reset
= drm_atomic_helper_plane_reset
,
199 .update_plane
= drm_atomic_helper_update_plane
,
202 static const u32 fsl_dcu_drm_plane_formats
[] = {
211 struct drm_plane
*fsl_dcu_drm_primary_create_plane(struct drm_device
*dev
)
213 struct drm_plane
*primary
;
216 primary
= kzalloc(sizeof(*primary
), GFP_KERNEL
);
218 DRM_DEBUG_KMS("Failed to allocate primary plane\n");
222 /* possible_crtc's will be filled in later by crtc_init */
223 ret
= drm_universal_plane_init(dev
, primary
, 0,
224 &fsl_dcu_drm_plane_funcs
,
225 fsl_dcu_drm_plane_formats
,
226 ARRAY_SIZE(fsl_dcu_drm_plane_formats
),
227 DRM_PLANE_TYPE_PRIMARY
, NULL
);
232 drm_plane_helper_add(primary
, &fsl_dcu_drm_plane_helper_funcs
);