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 <drm/drm_crtc.h>
21 #include <drm/drm_crtc_helper.h>
23 #include "omap_dmm_tiler.h"
30 /* per-format info: */
32 enum omap_color_mode dss_format
;
33 uint32_t pixel_format
;
35 int stride_bpp
; /* this times width is stride */
36 int sub_y
; /* sub-sample in y dimension */
41 static const struct format formats
[] = {
43 { OMAP_DSS_COLOR_RGB16
, DRM_FORMAT_RGB565
, {{2, 1}}, false }, /* RGB16-565 */
44 { OMAP_DSS_COLOR_RGB12U
, DRM_FORMAT_RGBX4444
, {{2, 1}}, false }, /* RGB12x-4444 */
45 { OMAP_DSS_COLOR_RGBX16
, DRM_FORMAT_XRGB4444
, {{2, 1}}, false }, /* xRGB12-4444 */
46 { OMAP_DSS_COLOR_RGBA16
, DRM_FORMAT_RGBA4444
, {{2, 1}}, false }, /* RGBA12-4444 */
47 { OMAP_DSS_COLOR_ARGB16
, DRM_FORMAT_ARGB4444
, {{2, 1}}, false }, /* ARGB16-4444 */
48 { OMAP_DSS_COLOR_XRGB16_1555
, DRM_FORMAT_XRGB1555
, {{2, 1}}, false }, /* xRGB15-1555 */
49 { OMAP_DSS_COLOR_ARGB16_1555
, DRM_FORMAT_ARGB1555
, {{2, 1}}, false }, /* ARGB16-1555 */
51 { OMAP_DSS_COLOR_RGB24P
, DRM_FORMAT_RGB888
, {{3, 1}}, false }, /* RGB24-888 */
53 { OMAP_DSS_COLOR_RGBX32
, DRM_FORMAT_RGBX8888
, {{4, 1}}, false }, /* RGBx24-8888 */
54 { OMAP_DSS_COLOR_RGB24U
, DRM_FORMAT_XRGB8888
, {{4, 1}}, false }, /* xRGB24-8888 */
55 { OMAP_DSS_COLOR_RGBA32
, DRM_FORMAT_RGBA8888
, {{4, 1}}, false }, /* RGBA32-8888 */
56 { OMAP_DSS_COLOR_ARGB32
, DRM_FORMAT_ARGB8888
, {{4, 1}}, false }, /* ARGB32-8888 */
58 { OMAP_DSS_COLOR_NV12
, DRM_FORMAT_NV12
, {{1, 1}, {1, 2}}, true },
59 { OMAP_DSS_COLOR_YUV2
, DRM_FORMAT_YUYV
, {{2, 1}}, true },
60 { OMAP_DSS_COLOR_UYVY
, DRM_FORMAT_UYVY
, {{2, 1}}, true },
63 /* convert from overlay's pixel formats bitmask to an array of fourcc's */
64 uint32_t omap_framebuffer_get_formats(uint32_t *pixel_formats
,
65 uint32_t max_formats
, enum omap_color_mode supported_modes
)
67 uint32_t nformats
= 0;
70 for (i
= 0; i
< ARRAY_SIZE(formats
) && nformats
< max_formats
; i
++)
71 if (formats
[i
].dss_format
& supported_modes
)
72 pixel_formats
[nformats
++] = formats
[i
].pixel_format
;
77 /* per-plane info for the fb: */
79 struct drm_gem_object
*bo
;
85 #define to_omap_framebuffer(x) container_of(x, struct omap_framebuffer, base)
87 struct omap_framebuffer
{
88 struct drm_framebuffer base
;
90 const struct format
*format
;
91 struct plane planes
[4];
92 /* lock for pinning (pin_count and planes.paddr) */
96 static int omap_framebuffer_create_handle(struct drm_framebuffer
*fb
,
97 struct drm_file
*file_priv
,
100 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
101 return drm_gem_handle_create(file_priv
,
102 omap_fb
->planes
[0].bo
, handle
);
105 static void omap_framebuffer_destroy(struct drm_framebuffer
*fb
)
107 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
108 int i
, n
= drm_format_num_planes(fb
->pixel_format
);
110 DBG("destroy: FB ID: %d (%p)", fb
->base
.id
, fb
);
112 drm_framebuffer_cleanup(fb
);
114 for (i
= 0; i
< n
; i
++) {
115 struct plane
*plane
= &omap_fb
->planes
[i
];
117 drm_gem_object_unreference_unlocked(plane
->bo
);
123 static int omap_framebuffer_dirty(struct drm_framebuffer
*fb
,
124 struct drm_file
*file_priv
, unsigned flags
, unsigned color
,
125 struct drm_clip_rect
*clips
, unsigned num_clips
)
130 static const struct drm_framebuffer_funcs omap_framebuffer_funcs
= {
131 .create_handle
= omap_framebuffer_create_handle
,
132 .destroy
= omap_framebuffer_destroy
,
133 .dirty
= omap_framebuffer_dirty
,
136 static uint32_t get_linear_addr(struct plane
*plane
,
137 const struct format
*format
, int n
, int x
, int y
)
141 offset
= plane
->offset
+
142 (x
* format
->planes
[n
].stride_bpp
) +
143 (y
* plane
->pitch
/ format
->planes
[n
].sub_y
);
145 return plane
->paddr
+ offset
;
148 bool omap_framebuffer_supports_rotation(struct drm_framebuffer
*fb
)
150 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
151 struct plane
*plane
= &omap_fb
->planes
[0];
153 return omap_gem_flags(plane
->bo
) & OMAP_BO_TILED
;
156 /* update ovl info for scanout, handles cases of multi-planar fb's, etc.
158 void omap_framebuffer_update_scanout(struct drm_framebuffer
*fb
,
159 struct omap_drm_window
*win
, struct omap_overlay_info
*info
)
161 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
162 const struct format
*format
= omap_fb
->format
;
163 struct plane
*plane
= &omap_fb
->planes
[0];
164 uint32_t x
, y
, orient
= 0;
166 info
->color_mode
= format
->dss_format
;
168 info
->pos_x
= win
->crtc_x
;
169 info
->pos_y
= win
->crtc_y
;
170 info
->out_width
= win
->crtc_w
;
171 info
->out_height
= win
->crtc_h
;
172 info
->width
= win
->src_w
;
173 info
->height
= win
->src_h
;
178 if (omap_gem_flags(plane
->bo
) & OMAP_BO_TILED
) {
179 uint32_t w
= win
->src_w
;
180 uint32_t h
= win
->src_h
;
182 switch (win
->rotation
& DRM_ROTATE_MASK
) {
184 dev_err(fb
->dev
->dev
, "invalid rotation: %02x",
185 (uint32_t)win
->rotation
);
186 /* fallthru to default to no rotation */
188 case BIT(DRM_ROTATE_0
):
191 case BIT(DRM_ROTATE_90
):
192 orient
= MASK_XY_FLIP
| MASK_X_INVERT
;
194 case BIT(DRM_ROTATE_180
):
195 orient
= MASK_X_INVERT
| MASK_Y_INVERT
;
197 case BIT(DRM_ROTATE_270
):
198 orient
= MASK_XY_FLIP
| MASK_Y_INVERT
;
202 if (win
->rotation
& BIT(DRM_REFLECT_X
))
203 orient
^= MASK_X_INVERT
;
205 if (win
->rotation
& BIT(DRM_REFLECT_Y
))
206 orient
^= MASK_Y_INVERT
;
208 /* adjust x,y offset for flip/invert: */
209 if (orient
& MASK_XY_FLIP
)
211 if (orient
& MASK_Y_INVERT
)
213 if (orient
& MASK_X_INVERT
)
216 omap_gem_rotated_paddr(plane
->bo
, orient
, x
, y
, &info
->paddr
);
217 info
->rotation_type
= OMAP_DSS_ROT_TILER
;
218 info
->screen_width
= omap_gem_tiled_stride(plane
->bo
, orient
);
220 switch (win
->rotation
& DRM_ROTATE_MASK
) {
222 case BIT(DRM_ROTATE_0
):
227 dev_warn(fb
->dev
->dev
,
228 "rotation '%d' ignored for non-tiled fb\n",
234 info
->paddr
= get_linear_addr(plane
, format
, 0, x
, y
);
235 info
->rotation_type
= OMAP_DSS_ROT_DMA
;
236 info
->screen_width
= plane
->pitch
;
239 /* convert to pixels: */
240 info
->screen_width
/= format
->planes
[0].stride_bpp
;
242 if (format
->dss_format
== OMAP_DSS_COLOR_NV12
) {
243 plane
= &omap_fb
->planes
[1];
245 if (info
->rotation_type
== OMAP_DSS_ROT_TILER
) {
246 WARN_ON(!(omap_gem_flags(plane
->bo
) & OMAP_BO_TILED
));
247 omap_gem_rotated_paddr(plane
->bo
, orient
,
248 x
/2, y
/2, &info
->p_uv_addr
);
250 info
->p_uv_addr
= get_linear_addr(plane
, format
, 1, x
, y
);
257 /* pin, prepare for scanout: */
258 int omap_framebuffer_pin(struct drm_framebuffer
*fb
)
260 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
261 int ret
, i
, n
= drm_format_num_planes(fb
->pixel_format
);
263 mutex_lock(&omap_fb
->lock
);
265 if (omap_fb
->pin_count
> 0) {
266 omap_fb
->pin_count
++;
267 mutex_unlock(&omap_fb
->lock
);
271 for (i
= 0; i
< n
; i
++) {
272 struct plane
*plane
= &omap_fb
->planes
[i
];
273 ret
= omap_gem_get_paddr(plane
->bo
, &plane
->paddr
, true);
276 omap_gem_dma_sync(plane
->bo
, DMA_TO_DEVICE
);
279 omap_fb
->pin_count
++;
281 mutex_unlock(&omap_fb
->lock
);
286 for (i
--; i
>= 0; i
--) {
287 struct plane
*plane
= &omap_fb
->planes
[i
];
288 omap_gem_put_paddr(plane
->bo
);
292 mutex_unlock(&omap_fb
->lock
);
297 /* unpin, no longer being scanned out: */
298 void omap_framebuffer_unpin(struct drm_framebuffer
*fb
)
300 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
301 int i
, n
= drm_format_num_planes(fb
->pixel_format
);
303 mutex_lock(&omap_fb
->lock
);
305 omap_fb
->pin_count
--;
307 if (omap_fb
->pin_count
> 0) {
308 mutex_unlock(&omap_fb
->lock
);
312 for (i
= 0; i
< n
; i
++) {
313 struct plane
*plane
= &omap_fb
->planes
[i
];
314 omap_gem_put_paddr(plane
->bo
);
318 mutex_unlock(&omap_fb
->lock
);
321 struct drm_gem_object
*omap_framebuffer_bo(struct drm_framebuffer
*fb
, int p
)
323 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
324 if (p
>= drm_format_num_planes(fb
->pixel_format
))
326 return omap_fb
->planes
[p
].bo
;
329 /* iterate thru all the connectors, returning ones that are attached
332 struct drm_connector
*omap_framebuffer_get_next_connector(
333 struct drm_framebuffer
*fb
, struct drm_connector
*from
)
335 struct drm_device
*dev
= fb
->dev
;
336 struct list_head
*connector_list
= &dev
->mode_config
.connector_list
;
337 struct drm_connector
*connector
= from
;
340 return list_first_entry_or_null(connector_list
, typeof(*from
),
343 list_for_each_entry_from(connector
, connector_list
, head
) {
344 if (connector
!= from
) {
345 struct drm_encoder
*encoder
= connector
->encoder
;
346 struct drm_crtc
*crtc
= encoder
? encoder
->crtc
: NULL
;
347 if (crtc
&& crtc
->primary
->fb
== fb
)
356 #ifdef CONFIG_DEBUG_FS
357 void omap_framebuffer_describe(struct drm_framebuffer
*fb
, struct seq_file
*m
)
359 struct omap_framebuffer
*omap_fb
= to_omap_framebuffer(fb
);
360 int i
, n
= drm_format_num_planes(fb
->pixel_format
);
362 seq_printf(m
, "fb: %dx%d@%4.4s\n", fb
->width
, fb
->height
,
363 (char *)&fb
->pixel_format
);
365 for (i
= 0; i
< n
; i
++) {
366 struct plane
*plane
= &omap_fb
->planes
[i
];
367 seq_printf(m
, " %d: offset=%d pitch=%d, obj: ",
368 i
, plane
->offset
, plane
->pitch
);
369 omap_gem_describe(plane
->bo
, m
);
374 struct drm_framebuffer
*omap_framebuffer_create(struct drm_device
*dev
,
375 struct drm_file
*file
, const struct drm_mode_fb_cmd2
*mode_cmd
)
377 struct drm_gem_object
*bos
[4];
378 struct drm_framebuffer
*fb
;
381 ret
= objects_lookup(file
, mode_cmd
->pixel_format
,
382 bos
, mode_cmd
->handles
);
386 fb
= omap_framebuffer_init(dev
, mode_cmd
, bos
);
388 int i
, n
= drm_format_num_planes(mode_cmd
->pixel_format
);
389 for (i
= 0; i
< n
; i
++)
390 drm_gem_object_unreference_unlocked(bos
[i
]);
396 struct drm_framebuffer
*omap_framebuffer_init(struct drm_device
*dev
,
397 const struct drm_mode_fb_cmd2
*mode_cmd
, struct drm_gem_object
**bos
)
399 struct omap_framebuffer
*omap_fb
= NULL
;
400 struct drm_framebuffer
*fb
= NULL
;
401 const struct format
*format
= NULL
;
402 int ret
, i
, n
= drm_format_num_planes(mode_cmd
->pixel_format
);
404 DBG("create framebuffer: dev=%p, mode_cmd=%p (%dx%d@%4.4s)",
405 dev
, mode_cmd
, mode_cmd
->width
, mode_cmd
->height
,
406 (char *)&mode_cmd
->pixel_format
);
408 for (i
= 0; i
< ARRAY_SIZE(formats
); i
++) {
409 if (formats
[i
].pixel_format
== mode_cmd
->pixel_format
) {
410 format
= &formats
[i
];
416 dev_err(dev
->dev
, "unsupported pixel format: %4.4s\n",
417 (char *)&mode_cmd
->pixel_format
);
422 omap_fb
= kzalloc(sizeof(*omap_fb
), GFP_KERNEL
);
429 omap_fb
->format
= format
;
430 mutex_init(&omap_fb
->lock
);
432 for (i
= 0; i
< n
; i
++) {
433 struct plane
*plane
= &omap_fb
->planes
[i
];
434 int size
, pitch
= mode_cmd
->pitches
[i
];
436 if (pitch
< (mode_cmd
->width
* format
->planes
[i
].stride_bpp
)) {
437 dev_err(dev
->dev
, "provided buffer pitch is too small! %d < %d\n",
438 pitch
, mode_cmd
->width
* format
->planes
[i
].stride_bpp
);
443 if (pitch
% format
->planes
[i
].stride_bpp
!= 0) {
445 "buffer pitch (%d bytes) is not a multiple of pixel size (%d bytes)\n",
446 pitch
, format
->planes
[i
].stride_bpp
);
451 size
= pitch
* mode_cmd
->height
/ format
->planes
[i
].sub_y
;
453 if (size
> (omap_gem_mmap_size(bos
[i
]) - mode_cmd
->offsets
[i
])) {
454 dev_err(dev
->dev
, "provided buffer object is too small! %d < %d\n",
455 bos
[i
]->size
- mode_cmd
->offsets
[i
], size
);
460 if (i
> 0 && pitch
!= mode_cmd
->pitches
[i
- 1]) {
462 "pitches are not the same between framebuffer planes %d != %d\n",
463 pitch
, mode_cmd
->pitches
[i
- 1]);
469 plane
->offset
= mode_cmd
->offsets
[i
];
470 plane
->pitch
= pitch
;
474 drm_helper_mode_fill_fb_struct(fb
, mode_cmd
);
476 ret
= drm_framebuffer_init(dev
, fb
, &omap_framebuffer_funcs
);
478 dev_err(dev
->dev
, "framebuffer init failed: %d\n", ret
);
482 DBG("create: FB ID: %d (%p)", fb
->base
.id
, fb
);