2 * drivers/gpu/drm/omapdrm/omap_fb.c
4 * Copyright (C) 2011 Texas Instruments
5 * Author: Rob Clark <rob@ti.com>
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License version 2 as published by
9 * the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful, but WITHOUT
12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16 * You should have received a copy of the GNU General Public License along with
17 * this program. If not, see <http://www.gnu.org/licenses/>.
20 #include <linux/seq_file.h>
22 #include <drm/drm_crtc.h>
23 #include <drm/drm_crtc_helper.h>
25 #include "omap_dmm_tiler.h"
32 /* per-format info: */
34 enum omap_color_mode dss_format
;
35 uint32_t pixel_format
;
37 int stride_bpp
; /* this times width is stride */
38 int sub_y
; /* sub-sample in y dimension */
43 static const struct format formats
[] = {
45 { OMAP_DSS_COLOR_RGB16
, DRM_FORMAT_RGB565
, {{2, 1}}, false }, /* RGB16-565 */
46 { OMAP_DSS_COLOR_RGB12U
, DRM_FORMAT_RGBX4444
, {{2, 1}}, false }, /* RGB12x-4444 */
47 { OMAP_DSS_COLOR_RGBX16
, DRM_FORMAT_XRGB4444
, {{2, 1}}, false }, /* xRGB12-4444 */
48 { OMAP_DSS_COLOR_RGBA16
, DRM_FORMAT_RGBA4444
, {{2, 1}}, false }, /* RGBA12-4444 */
49 { OMAP_DSS_COLOR_ARGB16
, DRM_FORMAT_ARGB4444
, {{2, 1}}, false }, /* ARGB16-4444 */
50 { OMAP_DSS_COLOR_XRGB16_1555
, DRM_FORMAT_XRGB1555
, {{2, 1}}, false }, /* xRGB15-1555 */
51 { OMAP_DSS_COLOR_ARGB16_1555
, DRM_FORMAT_ARGB1555
, {{2, 1}}, false }, /* ARGB16-1555 */
53 { OMAP_DSS_COLOR_RGB24P
, DRM_FORMAT_RGB888
, {{3, 1}}, false }, /* RGB24-888 */
55 { OMAP_DSS_COLOR_RGBX32
, DRM_FORMAT_RGBX8888
, {{4, 1}}, false }, /* RGBx24-8888 */
56 { OMAP_DSS_COLOR_RGB24U
, DRM_FORMAT_XRGB8888
, {{4, 1}}, false }, /* xRGB24-8888 */
57 { OMAP_DSS_COLOR_RGBA32
, DRM_FORMAT_RGBA8888
, {{4, 1}}, false }, /* RGBA32-8888 */
58 { OMAP_DSS_COLOR_ARGB32
, DRM_FORMAT_ARGB8888
, {{4, 1}}, false }, /* ARGB32-8888 */
60 { OMAP_DSS_COLOR_NV12
, DRM_FORMAT_NV12
, {{1, 1}, {1, 2}}, true },
61 { OMAP_DSS_COLOR_YUV2
, DRM_FORMAT_YUYV
, {{2, 1}}, true },
62 { OMAP_DSS_COLOR_UYVY
, DRM_FORMAT_UYVY
, {{2, 1}}, true },
65 /* convert from overlay's pixel formats bitmask to an array of fourcc's */
66 uint32_t omap_framebuffer_get_formats(uint32_t *pixel_formats
,
67 uint32_t max_formats
, enum omap_color_mode supported_modes
)
69 uint32_t nformats
= 0;
72 for (i
= 0; i
< ARRAY_SIZE(formats
) && nformats
< max_formats
; i
++)
73 if (formats
[i
].dss_format
& supported_modes
)
74 pixel_formats
[nformats
++] = formats
[i
].pixel_format
;
79 /* per-plane info for the fb: */
81 struct drm_gem_object
*bo
;
87 #define to_omap_framebuffer(x) container_of(x, struct omap_framebuffer, base)
89 struct omap_framebuffer
{
90 struct drm_framebuffer base
;
92 const struct format
*format
;
93 struct plane planes
[4];
94 /* lock for pinning (pin_count and planes.paddr) */
98 static int omap_framebuffer_create_handle(struct drm_framebuffer
*fb
,
99 struct drm_file
*file_priv
,
100 unsigned int *handle
)
102 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
103 return drm_gem_handle_create(file_priv
,
104 omap_fb
->planes
[0].bo
, handle
);
107 static void omap_framebuffer_destroy(struct drm_framebuffer
*fb
)
109 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
110 int i
, n
= drm_format_num_planes(fb
->pixel_format
);
112 DBG("destroy: FB ID: %d (%p)", fb
->base
.id
, fb
);
114 drm_framebuffer_cleanup(fb
);
116 for (i
= 0; i
< n
; i
++) {
117 struct plane
*plane
= &omap_fb
->planes
[i
];
119 drm_gem_object_unreference_unlocked(plane
->bo
);
125 static int omap_framebuffer_dirty(struct drm_framebuffer
*fb
,
126 struct drm_file
*file_priv
, unsigned flags
, unsigned color
,
127 struct drm_clip_rect
*clips
, unsigned num_clips
)
132 static const struct drm_framebuffer_funcs omap_framebuffer_funcs
= {
133 .create_handle
= omap_framebuffer_create_handle
,
134 .destroy
= omap_framebuffer_destroy
,
135 .dirty
= omap_framebuffer_dirty
,
138 static uint32_t get_linear_addr(struct plane
*plane
,
139 const struct format
*format
, int n
, int x
, int y
)
143 offset
= plane
->offset
+
144 (x
* format
->planes
[n
].stride_bpp
) +
145 (y
* plane
->pitch
/ format
->planes
[n
].sub_y
);
147 return plane
->paddr
+ offset
;
150 bool omap_framebuffer_supports_rotation(struct drm_framebuffer
*fb
)
152 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
153 struct plane
*plane
= &omap_fb
->planes
[0];
155 return omap_gem_flags(plane
->bo
) & OMAP_BO_TILED
;
158 /* update ovl info for scanout, handles cases of multi-planar fb's, etc.
160 void omap_framebuffer_update_scanout(struct drm_framebuffer
*fb
,
161 struct omap_drm_window
*win
, struct omap_overlay_info
*info
)
163 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
164 const struct format
*format
= omap_fb
->format
;
165 struct plane
*plane
= &omap_fb
->planes
[0];
166 uint32_t x
, y
, orient
= 0;
168 info
->color_mode
= format
->dss_format
;
170 info
->pos_x
= win
->crtc_x
;
171 info
->pos_y
= win
->crtc_y
;
172 info
->out_width
= win
->crtc_w
;
173 info
->out_height
= win
->crtc_h
;
174 info
->width
= win
->src_w
;
175 info
->height
= win
->src_h
;
180 if (omap_gem_flags(plane
->bo
) & OMAP_BO_TILED
) {
181 uint32_t w
= win
->src_w
;
182 uint32_t h
= win
->src_h
;
184 switch (win
->rotation
& DRM_ROTATE_MASK
) {
186 dev_err(fb
->dev
->dev
, "invalid rotation: %02x",
187 (uint32_t)win
->rotation
);
188 /* fallthru to default to no rotation */
190 case BIT(DRM_ROTATE_0
):
193 case BIT(DRM_ROTATE_90
):
194 orient
= MASK_XY_FLIP
| MASK_X_INVERT
;
196 case BIT(DRM_ROTATE_180
):
197 orient
= MASK_X_INVERT
| MASK_Y_INVERT
;
199 case BIT(DRM_ROTATE_270
):
200 orient
= MASK_XY_FLIP
| MASK_Y_INVERT
;
204 if (win
->rotation
& BIT(DRM_REFLECT_X
))
205 orient
^= MASK_X_INVERT
;
207 if (win
->rotation
& BIT(DRM_REFLECT_Y
))
208 orient
^= MASK_Y_INVERT
;
210 /* adjust x,y offset for flip/invert: */
211 if (orient
& MASK_XY_FLIP
)
213 if (orient
& MASK_Y_INVERT
)
215 if (orient
& MASK_X_INVERT
)
218 omap_gem_rotated_paddr(plane
->bo
, orient
, x
, y
, &info
->paddr
);
219 info
->rotation_type
= OMAP_DSS_ROT_TILER
;
220 info
->screen_width
= omap_gem_tiled_stride(plane
->bo
, orient
);
222 switch (win
->rotation
& DRM_ROTATE_MASK
) {
224 case BIT(DRM_ROTATE_0
):
229 dev_warn(fb
->dev
->dev
,
230 "rotation '%d' ignored for non-tiled fb\n",
236 info
->paddr
= get_linear_addr(plane
, format
, 0, x
, y
);
237 info
->rotation_type
= OMAP_DSS_ROT_DMA
;
238 info
->screen_width
= plane
->pitch
;
241 /* convert to pixels: */
242 info
->screen_width
/= format
->planes
[0].stride_bpp
;
244 if (format
->dss_format
== OMAP_DSS_COLOR_NV12
) {
245 plane
= &omap_fb
->planes
[1];
247 if (info
->rotation_type
== OMAP_DSS_ROT_TILER
) {
248 WARN_ON(!(omap_gem_flags(plane
->bo
) & OMAP_BO_TILED
));
249 omap_gem_rotated_paddr(plane
->bo
, orient
,
250 x
/2, y
/2, &info
->p_uv_addr
);
252 info
->p_uv_addr
= get_linear_addr(plane
, format
, 1, x
, y
);
259 /* pin, prepare for scanout: */
260 int omap_framebuffer_pin(struct drm_framebuffer
*fb
)
262 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
263 int ret
, i
, n
= drm_format_num_planes(fb
->pixel_format
);
265 mutex_lock(&omap_fb
->lock
);
267 if (omap_fb
->pin_count
> 0) {
268 omap_fb
->pin_count
++;
269 mutex_unlock(&omap_fb
->lock
);
273 for (i
= 0; i
< n
; i
++) {
274 struct plane
*plane
= &omap_fb
->planes
[i
];
275 ret
= omap_gem_get_paddr(plane
->bo
, &plane
->paddr
, true);
278 omap_gem_dma_sync(plane
->bo
, DMA_TO_DEVICE
);
281 omap_fb
->pin_count
++;
283 mutex_unlock(&omap_fb
->lock
);
288 for (i
--; i
>= 0; i
--) {
289 struct plane
*plane
= &omap_fb
->planes
[i
];
290 omap_gem_put_paddr(plane
->bo
);
294 mutex_unlock(&omap_fb
->lock
);
299 /* unpin, no longer being scanned out: */
300 void omap_framebuffer_unpin(struct drm_framebuffer
*fb
)
302 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
303 int i
, n
= drm_format_num_planes(fb
->pixel_format
);
305 mutex_lock(&omap_fb
->lock
);
307 omap_fb
->pin_count
--;
309 if (omap_fb
->pin_count
> 0) {
310 mutex_unlock(&omap_fb
->lock
);
314 for (i
= 0; i
< n
; i
++) {
315 struct plane
*plane
= &omap_fb
->planes
[i
];
316 omap_gem_put_paddr(plane
->bo
);
320 mutex_unlock(&omap_fb
->lock
);
323 struct drm_gem_object
*omap_framebuffer_bo(struct drm_framebuffer
*fb
, int p
)
325 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
326 if (p
>= drm_format_num_planes(fb
->pixel_format
))
328 return omap_fb
->planes
[p
].bo
;
331 /* iterate thru all the connectors, returning ones that are attached
334 struct drm_connector
*omap_framebuffer_get_next_connector(
335 struct drm_framebuffer
*fb
, struct drm_connector
*from
)
337 struct drm_device
*dev
= fb
->dev
;
338 struct list_head
*connector_list
= &dev
->mode_config
.connector_list
;
339 struct drm_connector
*connector
= from
;
342 return list_first_entry_or_null(connector_list
, typeof(*from
),
345 list_for_each_entry_from(connector
, connector_list
, head
) {
346 if (connector
!= from
) {
347 struct drm_encoder
*encoder
= connector
->encoder
;
348 struct drm_crtc
*crtc
= encoder
? encoder
->crtc
: NULL
;
349 if (crtc
&& crtc
->primary
->fb
== fb
)
358 #ifdef CONFIG_DEBUG_FS
359 void omap_framebuffer_describe(struct drm_framebuffer
*fb
, struct seq_file
*m
)
361 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
362 int i
, n
= drm_format_num_planes(fb
->pixel_format
);
364 seq_printf(m
, "fb: %dx%d@%4.4s\n", fb
->width
, fb
->height
,
365 (char *)&fb
->pixel_format
);
367 for (i
= 0; i
< n
; i
++) {
368 struct plane
*plane
= &omap_fb
->planes
[i
];
369 seq_printf(m
, " %d: offset=%d pitch=%d, obj: ",
370 i
, plane
->offset
, plane
->pitch
);
371 omap_gem_describe(plane
->bo
, m
);
376 struct drm_framebuffer
*omap_framebuffer_create(struct drm_device
*dev
,
377 struct drm_file
*file
, const struct drm_mode_fb_cmd2
*mode_cmd
)
379 struct drm_gem_object
*bos
[4];
380 struct drm_framebuffer
*fb
;
383 ret
= objects_lookup(file
, mode_cmd
->pixel_format
,
384 bos
, mode_cmd
->handles
);
388 fb
= omap_framebuffer_init(dev
, mode_cmd
, bos
);
390 int i
, n
= drm_format_num_planes(mode_cmd
->pixel_format
);
391 for (i
= 0; i
< n
; i
++)
392 drm_gem_object_unreference_unlocked(bos
[i
]);
398 struct drm_framebuffer
*omap_framebuffer_init(struct drm_device
*dev
,
399 const struct drm_mode_fb_cmd2
*mode_cmd
, struct drm_gem_object
**bos
)
401 struct omap_framebuffer
*omap_fb
= NULL
;
402 struct drm_framebuffer
*fb
= NULL
;
403 const struct format
*format
= NULL
;
404 int ret
, i
, n
= drm_format_num_planes(mode_cmd
->pixel_format
);
406 DBG("create framebuffer: dev=%p, mode_cmd=%p (%dx%d@%4.4s)",
407 dev
, mode_cmd
, mode_cmd
->width
, mode_cmd
->height
,
408 (char *)&mode_cmd
->pixel_format
);
410 for (i
= 0; i
< ARRAY_SIZE(formats
); i
++) {
411 if (formats
[i
].pixel_format
== mode_cmd
->pixel_format
) {
412 format
= &formats
[i
];
418 dev_err(dev
->dev
, "unsupported pixel format: %4.4s\n",
419 (char *)&mode_cmd
->pixel_format
);
424 omap_fb
= kzalloc(sizeof(*omap_fb
), GFP_KERNEL
);
431 omap_fb
->format
= format
;
432 mutex_init(&omap_fb
->lock
);
434 for (i
= 0; i
< n
; i
++) {
435 struct plane
*plane
= &omap_fb
->planes
[i
];
436 int size
, pitch
= mode_cmd
->pitches
[i
];
438 if (pitch
< (mode_cmd
->width
* format
->planes
[i
].stride_bpp
)) {
439 dev_err(dev
->dev
, "provided buffer pitch is too small! %d < %d\n",
440 pitch
, mode_cmd
->width
* format
->planes
[i
].stride_bpp
);
445 if (pitch
% format
->planes
[i
].stride_bpp
!= 0) {
447 "buffer pitch (%d bytes) is not a multiple of pixel size (%d bytes)\n",
448 pitch
, format
->planes
[i
].stride_bpp
);
453 size
= pitch
* mode_cmd
->height
/ format
->planes
[i
].sub_y
;
455 if (size
> (omap_gem_mmap_size(bos
[i
]) - mode_cmd
->offsets
[i
])) {
456 dev_err(dev
->dev
, "provided buffer object is too small! %d < %d\n",
457 bos
[i
]->size
- mode_cmd
->offsets
[i
], size
);
462 if (i
> 0 && pitch
!= mode_cmd
->pitches
[i
- 1]) {
464 "pitches are not the same between framebuffer planes %d != %d\n",
465 pitch
, mode_cmd
->pitches
[i
- 1]);
471 plane
->offset
= mode_cmd
->offsets
[i
];
472 plane
->pitch
= pitch
;
476 drm_helper_mode_fill_fb_struct(fb
, mode_cmd
);
478 ret
= drm_framebuffer_init(dev
, fb
, &omap_framebuffer_funcs
);
480 dev_err(dev
->dev
, "framebuffer init failed: %d\n", ret
);
484 DBG("create: FB ID: %d (%p)", fb
->base
.id
, fb
);