1 /* 2 * drivers/gpu/drm/omapdrm/omap_fb.c 3 * 4 * Copyright (C) 2011 Texas Instruments 5 * Author: Rob Clark <rob@ti.com> 6 * 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. 10 * 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 14 * more details. 15 * 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/>. 18 */ 19 20 #include <linux/seq_file.h> 21 22 #include <drm/drm_crtc.h> 23 #include <drm/drm_crtc_helper.h> 24 25 #include "omap_dmm_tiler.h" 26 #include "omap_drv.h" 27 28 /* 29 * framebuffer funcs 30 */ 31 32 /* per-format info: */ 33 struct format { 34 enum omap_color_mode dss_format; 35 uint32_t pixel_format; 36 struct { 37 int stride_bpp; /* this times width is stride */ 38 int sub_y; /* sub-sample in y dimension */ 39 } planes[4]; 40 bool yuv; 41 }; 42 43 static const struct format formats[] = { 44 /* 16bpp [A]RGB: */ 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 */ 52 /* 24bpp RGB: */ 53 { OMAP_DSS_COLOR_RGB24P, DRM_FORMAT_RGB888, {{3, 1}}, false }, /* RGB24-888 */ 54 /* 32bpp [A]RGB: */ 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 */ 59 /* YUV: */ 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 }, 63 }; 64 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) 68 { 69 uint32_t nformats = 0; 70 int i = 0; 71 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; 75 76 return nformats; 77 } 78 79 /* per-plane info for the fb: */ 80 struct plane { 81 struct drm_gem_object *bo; 82 uint32_t pitch; 83 uint32_t offset; 84 dma_addr_t paddr; 85 }; 86 87 #define to_omap_framebuffer(x) container_of(x, struct omap_framebuffer, base) 88 89 struct omap_framebuffer { 90 struct drm_framebuffer base; 91 int pin_count; 92 const struct format *format; 93 struct plane planes[4]; 94 /* lock for pinning (pin_count and planes.paddr) */ 95 struct mutex lock; 96 }; 97 98 static int omap_framebuffer_create_handle(struct drm_framebuffer *fb, 99 struct drm_file *file_priv, 100 unsigned int *handle) 101 { 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); 105 } 106 107 static void omap_framebuffer_destroy(struct drm_framebuffer *fb) 108 { 109 struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb); 110 int i, n = drm_format_num_planes(fb->pixel_format); 111 112 DBG("destroy: FB ID: %d (%p)", fb->base.id, fb); 113 114 drm_framebuffer_cleanup(fb); 115 116 for (i = 0; i < n; i++) { 117 struct plane *plane = &omap_fb->planes[i]; 118 if (plane->bo) 119 drm_gem_object_unreference_unlocked(plane->bo); 120 } 121 122 kfree(omap_fb); 123 } 124 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) 128 { 129 return 0; 130 } 131 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, 136 }; 137 138 static uint32_t get_linear_addr(struct plane *plane, 139 const struct format *format, int n, int x, int y) 140 { 141 uint32_t offset; 142 143 offset = plane->offset + 144 (x * format->planes[n].stride_bpp) + 145 (y * plane->pitch / format->planes[n].sub_y); 146 147 return plane->paddr + offset; 148 } 149 150 bool omap_framebuffer_supports_rotation(struct drm_framebuffer *fb) 151 { 152 struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb); 153 struct plane *plane = &omap_fb->planes[0]; 154 155 return omap_gem_flags(plane->bo) & OMAP_BO_TILED; 156 } 157 158 /* update ovl info for scanout, handles cases of multi-planar fb's, etc. 159 */ 160 void omap_framebuffer_update_scanout(struct drm_framebuffer *fb, 161 struct omap_drm_window *win, struct omap_overlay_info *info) 162 { 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; 167 168 info->color_mode = format->dss_format; 169 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; 176 177 x = win->src_x; 178 y = win->src_y; 179 180 if (omap_gem_flags(plane->bo) & OMAP_BO_TILED) { 181 uint32_t w = win->src_w; 182 uint32_t h = win->src_h; 183 184 switch (win->rotation & DRM_ROTATE_MASK) { 185 default: 186 dev_err(fb->dev->dev, "invalid rotation: %02x", 187 (uint32_t)win->rotation); 188 /* fallthru to default to no rotation */ 189 case 0: 190 case BIT(DRM_ROTATE_0): 191 orient = 0; 192 break; 193 case BIT(DRM_ROTATE_90): 194 orient = MASK_XY_FLIP | MASK_X_INVERT; 195 break; 196 case BIT(DRM_ROTATE_180): 197 orient = MASK_X_INVERT | MASK_Y_INVERT; 198 break; 199 case BIT(DRM_ROTATE_270): 200 orient = MASK_XY_FLIP | MASK_Y_INVERT; 201 break; 202 } 203 204 if (win->rotation & BIT(DRM_REFLECT_X)) 205 orient ^= MASK_X_INVERT; 206 207 if (win->rotation & BIT(DRM_REFLECT_Y)) 208 orient ^= MASK_Y_INVERT; 209 210 /* adjust x,y offset for flip/invert: */ 211 if (orient & MASK_XY_FLIP) 212 swap(w, h); 213 if (orient & MASK_Y_INVERT) 214 y += h - 1; 215 if (orient & MASK_X_INVERT) 216 x += w - 1; 217 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); 221 } else { 222 switch (win->rotation & DRM_ROTATE_MASK) { 223 case 0: 224 case BIT(DRM_ROTATE_0): 225 /* OK */ 226 break; 227 228 default: 229 dev_warn(fb->dev->dev, 230 "rotation '%d' ignored for non-tiled fb\n", 231 win->rotation); 232 win->rotation = 0; 233 break; 234 } 235 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; 239 } 240 241 /* convert to pixels: */ 242 info->screen_width /= format->planes[0].stride_bpp; 243 244 if (format->dss_format == OMAP_DSS_COLOR_NV12) { 245 plane = &omap_fb->planes[1]; 246 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); 251 } else { 252 info->p_uv_addr = get_linear_addr(plane, format, 1, x, y); 253 } 254 } else { 255 info->p_uv_addr = 0; 256 } 257 } 258 259 /* pin, prepare for scanout: */ 260 int omap_framebuffer_pin(struct drm_framebuffer *fb) 261 { 262 struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb); 263 int ret, i, n = drm_format_num_planes(fb->pixel_format); 264 265 mutex_lock(&omap_fb->lock); 266 267 if (omap_fb->pin_count > 0) { 268 omap_fb->pin_count++; 269 mutex_unlock(&omap_fb->lock); 270 return 0; 271 } 272 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); 276 if (ret) 277 goto fail; 278 omap_gem_dma_sync(plane->bo, DMA_TO_DEVICE); 279 } 280 281 omap_fb->pin_count++; 282 283 mutex_unlock(&omap_fb->lock); 284 285 return 0; 286 287 fail: 288 for (i--; i >= 0; i--) { 289 struct plane *plane = &omap_fb->planes[i]; 290 omap_gem_put_paddr(plane->bo); 291 plane->paddr = 0; 292 } 293 294 mutex_unlock(&omap_fb->lock); 295 296 return ret; 297 } 298 299 /* unpin, no longer being scanned out: */ 300 void omap_framebuffer_unpin(struct drm_framebuffer *fb) 301 { 302 struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb); 303 int i, n = drm_format_num_planes(fb->pixel_format); 304 305 mutex_lock(&omap_fb->lock); 306 307 omap_fb->pin_count--; 308 309 if (omap_fb->pin_count > 0) { 310 mutex_unlock(&omap_fb->lock); 311 return; 312 } 313 314 for (i = 0; i < n; i++) { 315 struct plane *plane = &omap_fb->planes[i]; 316 omap_gem_put_paddr(plane->bo); 317 plane->paddr = 0; 318 } 319 320 mutex_unlock(&omap_fb->lock); 321 } 322 323 struct drm_gem_object *omap_framebuffer_bo(struct drm_framebuffer *fb, int p) 324 { 325 struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb); 326 if (p >= drm_format_num_planes(fb->pixel_format)) 327 return NULL; 328 return omap_fb->planes[p].bo; 329 } 330 331 /* iterate thru all the connectors, returning ones that are attached 332 * to the same fb.. 333 */ 334 struct drm_connector *omap_framebuffer_get_next_connector( 335 struct drm_framebuffer *fb, struct drm_connector *from) 336 { 337 struct drm_device *dev = fb->dev; 338 struct list_head *connector_list = &dev->mode_config.connector_list; 339 struct drm_connector *connector = from; 340 341 if (!from) 342 return list_first_entry_or_null(connector_list, typeof(*from), 343 head); 344 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) 350 return connector; 351 352 } 353 } 354 355 return NULL; 356 } 357 358 #ifdef CONFIG_DEBUG_FS 359 void omap_framebuffer_describe(struct drm_framebuffer *fb, struct seq_file *m) 360 { 361 struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb); 362 int i, n = drm_format_num_planes(fb->pixel_format); 363 364 seq_printf(m, "fb: %dx%d@%4.4s\n", fb->width, fb->height, 365 (char *)&fb->pixel_format); 366 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); 372 } 373 } 374 #endif 375 376 struct drm_framebuffer *omap_framebuffer_create(struct drm_device *dev, 377 struct drm_file *file, const struct drm_mode_fb_cmd2 *mode_cmd) 378 { 379 struct drm_gem_object *bos[4]; 380 struct drm_framebuffer *fb; 381 int ret; 382 383 ret = objects_lookup(file, mode_cmd->pixel_format, 384 bos, mode_cmd->handles); 385 if (ret) 386 return ERR_PTR(ret); 387 388 fb = omap_framebuffer_init(dev, mode_cmd, bos); 389 if (IS_ERR(fb)) { 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]); 393 return fb; 394 } 395 return fb; 396 } 397 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) 400 { 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); 405 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); 409 410 for (i = 0; i < ARRAY_SIZE(formats); i++) { 411 if (formats[i].pixel_format == mode_cmd->pixel_format) { 412 format = &formats[i]; 413 break; 414 } 415 } 416 417 if (!format) { 418 dev_err(dev->dev, "unsupported pixel format: %4.4s\n", 419 (char *)&mode_cmd->pixel_format); 420 ret = -EINVAL; 421 goto fail; 422 } 423 424 omap_fb = kzalloc(sizeof(*omap_fb), GFP_KERNEL); 425 if (!omap_fb) { 426 ret = -ENOMEM; 427 goto fail; 428 } 429 430 fb = &omap_fb->base; 431 omap_fb->format = format; 432 mutex_init(&omap_fb->lock); 433 434 for (i = 0; i < n; i++) { 435 struct plane *plane = &omap_fb->planes[i]; 436 int size, pitch = mode_cmd->pitches[i]; 437 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); 441 ret = -EINVAL; 442 goto fail; 443 } 444 445 if (pitch % format->planes[i].stride_bpp != 0) { 446 dev_err(dev->dev, 447 "buffer pitch (%d bytes) is not a multiple of pixel size (%d bytes)\n", 448 pitch, format->planes[i].stride_bpp); 449 ret = -EINVAL; 450 goto fail; 451 } 452 453 size = pitch * mode_cmd->height / format->planes[i].sub_y; 454 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); 458 ret = -EINVAL; 459 goto fail; 460 } 461 462 if (i > 0 && pitch != mode_cmd->pitches[i - 1]) { 463 dev_err(dev->dev, 464 "pitches are not the same between framebuffer planes %d != %d\n", 465 pitch, mode_cmd->pitches[i - 1]); 466 ret = -EINVAL; 467 goto fail; 468 } 469 470 plane->bo = bos[i]; 471 plane->offset = mode_cmd->offsets[i]; 472 plane->pitch = pitch; 473 plane->paddr = 0; 474 } 475 476 drm_helper_mode_fill_fb_struct(fb, mode_cmd); 477 478 ret = drm_framebuffer_init(dev, fb, &omap_framebuffer_funcs); 479 if (ret) { 480 dev_err(dev->dev, "framebuffer init failed: %d\n", ret); 481 goto fail; 482 } 483 484 DBG("create: FB ID: %d (%p)", fb->base.id, fb); 485 486 return fb; 487 488 fail: 489 kfree(omap_fb); 490 491 return ERR_PTR(ret); 492 } 493