omap_fb.c 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469
  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. #include "omap_drv.h"
  20. #include "omap_dmm_tiler.h"
  21. #include "drm_crtc.h"
  22. #include "drm_crtc_helper.h"
  23. /*
  24. * framebuffer funcs
  25. */
  26. /* per-format info: */
  27. struct format {
  28. enum omap_color_mode dss_format;
  29. uint32_t pixel_format;
  30. struct {
  31. int stride_bpp; /* this times width is stride */
  32. int sub_y; /* sub-sample in y dimension */
  33. } planes[4];
  34. bool yuv;
  35. };
  36. static const struct format formats[] = {
  37. /* 16bpp [A]RGB: */
  38. { OMAP_DSS_COLOR_RGB16, DRM_FORMAT_RGB565, {{2, 1}}, false }, /* RGB16-565 */
  39. { OMAP_DSS_COLOR_RGB12U, DRM_FORMAT_RGBX4444, {{2, 1}}, false }, /* RGB12x-4444 */
  40. { OMAP_DSS_COLOR_RGBX16, DRM_FORMAT_XRGB4444, {{2, 1}}, false }, /* xRGB12-4444 */
  41. { OMAP_DSS_COLOR_RGBA16, DRM_FORMAT_RGBA4444, {{2, 1}}, false }, /* RGBA12-4444 */
  42. { OMAP_DSS_COLOR_ARGB16, DRM_FORMAT_ARGB4444, {{2, 1}}, false }, /* ARGB16-4444 */
  43. { OMAP_DSS_COLOR_XRGB16_1555, DRM_FORMAT_XRGB1555, {{2, 1}}, false }, /* xRGB15-1555 */
  44. { OMAP_DSS_COLOR_ARGB16_1555, DRM_FORMAT_ARGB1555, {{2, 1}}, false }, /* ARGB16-1555 */
  45. /* 24bpp RGB: */
  46. { OMAP_DSS_COLOR_RGB24P, DRM_FORMAT_RGB888, {{3, 1}}, false }, /* RGB24-888 */
  47. /* 32bpp [A]RGB: */
  48. { OMAP_DSS_COLOR_RGBX32, DRM_FORMAT_RGBX8888, {{4, 1}}, false }, /* RGBx24-8888 */
  49. { OMAP_DSS_COLOR_RGB24U, DRM_FORMAT_XRGB8888, {{4, 1}}, false }, /* xRGB24-8888 */
  50. { OMAP_DSS_COLOR_RGBA32, DRM_FORMAT_RGBA8888, {{4, 1}}, false }, /* RGBA32-8888 */
  51. { OMAP_DSS_COLOR_ARGB32, DRM_FORMAT_ARGB8888, {{4, 1}}, false }, /* ARGB32-8888 */
  52. /* YUV: */
  53. { OMAP_DSS_COLOR_NV12, DRM_FORMAT_NV12, {{1, 1}, {1, 2}}, true },
  54. { OMAP_DSS_COLOR_YUV2, DRM_FORMAT_YUYV, {{2, 1}}, true },
  55. { OMAP_DSS_COLOR_UYVY, DRM_FORMAT_UYVY, {{2, 1}}, true },
  56. };
  57. /* convert from overlay's pixel formats bitmask to an array of fourcc's */
  58. uint32_t omap_framebuffer_get_formats(uint32_t *pixel_formats,
  59. uint32_t max_formats, enum omap_color_mode supported_modes)
  60. {
  61. uint32_t nformats = 0;
  62. int i = 0;
  63. for (i = 0; i < ARRAY_SIZE(formats) && nformats < max_formats; i++)
  64. if (formats[i].dss_format & supported_modes)
  65. pixel_formats[nformats++] = formats[i].pixel_format;
  66. return nformats;
  67. }
  68. /* per-plane info for the fb: */
  69. struct plane {
  70. struct drm_gem_object *bo;
  71. uint32_t pitch;
  72. uint32_t offset;
  73. dma_addr_t paddr;
  74. };
  75. #define to_omap_framebuffer(x) container_of(x, struct omap_framebuffer, base)
  76. struct omap_framebuffer {
  77. struct drm_framebuffer base;
  78. const struct format *format;
  79. struct plane planes[4];
  80. };
  81. static int omap_framebuffer_create_handle(struct drm_framebuffer *fb,
  82. struct drm_file *file_priv,
  83. unsigned int *handle)
  84. {
  85. struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb);
  86. return drm_gem_handle_create(file_priv,
  87. omap_fb->planes[0].bo, handle);
  88. }
  89. static void omap_framebuffer_destroy(struct drm_framebuffer *fb)
  90. {
  91. struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb);
  92. int i, n = drm_format_num_planes(fb->pixel_format);
  93. DBG("destroy: FB ID: %d (%p)", fb->base.id, fb);
  94. drm_framebuffer_cleanup(fb);
  95. for (i = 0; i < n; i++) {
  96. struct plane *plane = &omap_fb->planes[i];
  97. if (plane->bo)
  98. drm_gem_object_unreference_unlocked(plane->bo);
  99. }
  100. kfree(omap_fb);
  101. }
  102. static int omap_framebuffer_dirty(struct drm_framebuffer *fb,
  103. struct drm_file *file_priv, unsigned flags, unsigned color,
  104. struct drm_clip_rect *clips, unsigned num_clips)
  105. {
  106. int i;
  107. drm_modeset_lock_all(fb->dev);
  108. for (i = 0; i < num_clips; i++) {
  109. omap_framebuffer_flush(fb, clips[i].x1, clips[i].y1,
  110. clips[i].x2 - clips[i].x1,
  111. clips[i].y2 - clips[i].y1);
  112. }
  113. drm_modeset_unlock_all(fb->dev);
  114. return 0;
  115. }
  116. static const struct drm_framebuffer_funcs omap_framebuffer_funcs = {
  117. .create_handle = omap_framebuffer_create_handle,
  118. .destroy = omap_framebuffer_destroy,
  119. .dirty = omap_framebuffer_dirty,
  120. };
  121. static uint32_t get_linear_addr(struct plane *plane,
  122. const struct format *format, int n, int x, int y)
  123. {
  124. uint32_t offset;
  125. offset = plane->offset +
  126. (x * format->planes[n].stride_bpp) +
  127. (y * plane->pitch / format->planes[n].sub_y);
  128. return plane->paddr + offset;
  129. }
  130. /* update ovl info for scanout, handles cases of multi-planar fb's, etc.
  131. */
  132. void omap_framebuffer_update_scanout(struct drm_framebuffer *fb,
  133. struct omap_drm_window *win, struct omap_overlay_info *info)
  134. {
  135. struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb);
  136. const struct format *format = omap_fb->format;
  137. struct plane *plane = &omap_fb->planes[0];
  138. uint32_t x, y, orient = 0;
  139. info->color_mode = format->dss_format;
  140. info->pos_x = win->crtc_x;
  141. info->pos_y = win->crtc_y;
  142. info->out_width = win->crtc_w;
  143. info->out_height = win->crtc_h;
  144. info->width = win->src_w;
  145. info->height = win->src_h;
  146. x = win->src_x;
  147. y = win->src_y;
  148. if (omap_gem_flags(plane->bo) & OMAP_BO_TILED) {
  149. uint32_t w = win->src_w;
  150. uint32_t h = win->src_h;
  151. switch (win->rotation & 0xf) {
  152. default:
  153. dev_err(fb->dev->dev, "invalid rotation: %02x",
  154. (uint32_t)win->rotation);
  155. /* fallthru to default to no rotation */
  156. case 0:
  157. case BIT(DRM_ROTATE_0):
  158. orient = 0;
  159. break;
  160. case BIT(DRM_ROTATE_90):
  161. orient = MASK_XY_FLIP | MASK_X_INVERT;
  162. break;
  163. case BIT(DRM_ROTATE_180):
  164. orient = MASK_X_INVERT | MASK_Y_INVERT;
  165. break;
  166. case BIT(DRM_ROTATE_270):
  167. orient = MASK_XY_FLIP | MASK_Y_INVERT;
  168. break;
  169. }
  170. if (win->rotation & BIT(DRM_REFLECT_X))
  171. orient ^= MASK_X_INVERT;
  172. if (win->rotation & BIT(DRM_REFLECT_Y))
  173. orient ^= MASK_Y_INVERT;
  174. /* adjust x,y offset for flip/invert: */
  175. if (orient & MASK_XY_FLIP)
  176. swap(w, h);
  177. if (orient & MASK_Y_INVERT)
  178. y += h - 1;
  179. if (orient & MASK_X_INVERT)
  180. x += w - 1;
  181. omap_gem_rotated_paddr(plane->bo, orient, x, y, &info->paddr);
  182. info->rotation_type = OMAP_DSS_ROT_TILER;
  183. info->screen_width = omap_gem_tiled_stride(plane->bo, orient);
  184. } else {
  185. info->paddr = get_linear_addr(plane, format, 0, x, y);
  186. info->rotation_type = OMAP_DSS_ROT_DMA;
  187. info->screen_width = plane->pitch;
  188. }
  189. /* convert to pixels: */
  190. info->screen_width /= format->planes[0].stride_bpp;
  191. if (format->dss_format == OMAP_DSS_COLOR_NV12) {
  192. plane = &omap_fb->planes[1];
  193. if (info->rotation_type == OMAP_DSS_ROT_TILER) {
  194. WARN_ON(!(omap_gem_flags(plane->bo) & OMAP_BO_TILED));
  195. omap_gem_rotated_paddr(plane->bo, orient,
  196. x/2, y/2, &info->p_uv_addr);
  197. } else {
  198. info->p_uv_addr = get_linear_addr(plane, format, 1, x, y);
  199. }
  200. } else {
  201. info->p_uv_addr = 0;
  202. }
  203. }
  204. /* pin, prepare for scanout: */
  205. int omap_framebuffer_pin(struct drm_framebuffer *fb)
  206. {
  207. struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb);
  208. int ret, i, n = drm_format_num_planes(fb->pixel_format);
  209. for (i = 0; i < n; i++) {
  210. struct plane *plane = &omap_fb->planes[i];
  211. ret = omap_gem_get_paddr(plane->bo, &plane->paddr, true);
  212. if (ret)
  213. goto fail;
  214. omap_gem_dma_sync(plane->bo, DMA_TO_DEVICE);
  215. }
  216. return 0;
  217. fail:
  218. for (i--; i >= 0; i--) {
  219. struct plane *plane = &omap_fb->planes[i];
  220. omap_gem_put_paddr(plane->bo);
  221. plane->paddr = 0;
  222. }
  223. return ret;
  224. }
  225. /* unpin, no longer being scanned out: */
  226. int omap_framebuffer_unpin(struct drm_framebuffer *fb)
  227. {
  228. struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb);
  229. int ret, i, n = drm_format_num_planes(fb->pixel_format);
  230. for (i = 0; i < n; i++) {
  231. struct plane *plane = &omap_fb->planes[i];
  232. ret = omap_gem_put_paddr(plane->bo);
  233. if (ret)
  234. goto fail;
  235. plane->paddr = 0;
  236. }
  237. return 0;
  238. fail:
  239. return ret;
  240. }
  241. struct drm_gem_object *omap_framebuffer_bo(struct drm_framebuffer *fb, int p)
  242. {
  243. struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb);
  244. if (p >= drm_format_num_planes(fb->pixel_format))
  245. return NULL;
  246. return omap_fb->planes[p].bo;
  247. }
  248. /* iterate thru all the connectors, returning ones that are attached
  249. * to the same fb..
  250. */
  251. struct drm_connector *omap_framebuffer_get_next_connector(
  252. struct drm_framebuffer *fb, struct drm_connector *from)
  253. {
  254. struct drm_device *dev = fb->dev;
  255. struct list_head *connector_list = &dev->mode_config.connector_list;
  256. struct drm_connector *connector = from;
  257. if (!from)
  258. return list_first_entry(connector_list, typeof(*from), head);
  259. list_for_each_entry_from(connector, connector_list, head) {
  260. if (connector != from) {
  261. struct drm_encoder *encoder = connector->encoder;
  262. struct drm_crtc *crtc = encoder ? encoder->crtc : NULL;
  263. if (crtc && crtc->fb == fb)
  264. return connector;
  265. }
  266. }
  267. return NULL;
  268. }
  269. /* flush an area of the framebuffer (in case of manual update display that
  270. * is not automatically flushed)
  271. */
  272. void omap_framebuffer_flush(struct drm_framebuffer *fb,
  273. int x, int y, int w, int h)
  274. {
  275. struct drm_connector *connector = NULL;
  276. VERB("flush: %d,%d %dx%d, fb=%p", x, y, w, h, fb);
  277. while ((connector = omap_framebuffer_get_next_connector(fb, connector))) {
  278. /* only consider connectors that are part of a chain */
  279. if (connector->encoder && connector->encoder->crtc) {
  280. /* TODO: maybe this should propagate thru the crtc who
  281. * could do the coordinate translation..
  282. */
  283. struct drm_crtc *crtc = connector->encoder->crtc;
  284. int cx = max(0, x - crtc->x);
  285. int cy = max(0, y - crtc->y);
  286. int cw = w + (x - crtc->x) - cx;
  287. int ch = h + (y - crtc->y) - cy;
  288. omap_connector_flush(connector, cx, cy, cw, ch);
  289. }
  290. }
  291. }
  292. #ifdef CONFIG_DEBUG_FS
  293. void omap_framebuffer_describe(struct drm_framebuffer *fb, struct seq_file *m)
  294. {
  295. struct omap_framebuffer *omap_fb = to_omap_framebuffer(fb);
  296. int i, n = drm_format_num_planes(fb->pixel_format);
  297. seq_printf(m, "fb: %dx%d@%4.4s\n", fb->width, fb->height,
  298. (char *)&fb->pixel_format);
  299. for (i = 0; i < n; i++) {
  300. struct plane *plane = &omap_fb->planes[i];
  301. seq_printf(m, " %d: offset=%d pitch=%d, obj: ",
  302. i, plane->offset, plane->pitch);
  303. omap_gem_describe(plane->bo, m);
  304. }
  305. }
  306. #endif
  307. struct drm_framebuffer *omap_framebuffer_create(struct drm_device *dev,
  308. struct drm_file *file, struct drm_mode_fb_cmd2 *mode_cmd)
  309. {
  310. struct drm_gem_object *bos[4];
  311. struct drm_framebuffer *fb;
  312. int ret;
  313. ret = objects_lookup(dev, file, mode_cmd->pixel_format,
  314. bos, mode_cmd->handles);
  315. if (ret)
  316. return ERR_PTR(ret);
  317. fb = omap_framebuffer_init(dev, mode_cmd, bos);
  318. if (IS_ERR(fb)) {
  319. int i, n = drm_format_num_planes(mode_cmd->pixel_format);
  320. for (i = 0; i < n; i++)
  321. drm_gem_object_unreference_unlocked(bos[i]);
  322. return fb;
  323. }
  324. return fb;
  325. }
  326. struct drm_framebuffer *omap_framebuffer_init(struct drm_device *dev,
  327. struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object **bos)
  328. {
  329. struct omap_framebuffer *omap_fb;
  330. struct drm_framebuffer *fb = NULL;
  331. const struct format *format = NULL;
  332. int ret, i, n = drm_format_num_planes(mode_cmd->pixel_format);
  333. DBG("create framebuffer: dev=%p, mode_cmd=%p (%dx%d@%4.4s)",
  334. dev, mode_cmd, mode_cmd->width, mode_cmd->height,
  335. (char *)&mode_cmd->pixel_format);
  336. for (i = 0; i < ARRAY_SIZE(formats); i++) {
  337. if (formats[i].pixel_format == mode_cmd->pixel_format) {
  338. format = &formats[i];
  339. break;
  340. }
  341. }
  342. if (!format) {
  343. dev_err(dev->dev, "unsupported pixel format: %4.4s\n",
  344. (char *)&mode_cmd->pixel_format);
  345. ret = -EINVAL;
  346. goto fail;
  347. }
  348. omap_fb = kzalloc(sizeof(*omap_fb), GFP_KERNEL);
  349. if (!omap_fb) {
  350. ret = -ENOMEM;
  351. goto fail;
  352. }
  353. fb = &omap_fb->base;
  354. omap_fb->format = format;
  355. for (i = 0; i < n; i++) {
  356. struct plane *plane = &omap_fb->planes[i];
  357. int size, pitch = mode_cmd->pitches[i];
  358. if (pitch < (mode_cmd->width * format->planes[i].stride_bpp)) {
  359. dev_err(dev->dev, "provided buffer pitch is too small! %d < %d\n",
  360. pitch, mode_cmd->width * format->planes[i].stride_bpp);
  361. ret = -EINVAL;
  362. goto fail;
  363. }
  364. size = pitch * mode_cmd->height / format->planes[i].sub_y;
  365. if (size > (omap_gem_mmap_size(bos[i]) - mode_cmd->offsets[i])) {
  366. dev_err(dev->dev, "provided buffer object is too small! %d < %d\n",
  367. bos[i]->size - mode_cmd->offsets[i], size);
  368. ret = -EINVAL;
  369. goto fail;
  370. }
  371. plane->bo = bos[i];
  372. plane->offset = mode_cmd->offsets[i];
  373. plane->pitch = pitch;
  374. plane->paddr = 0;
  375. }
  376. drm_helper_mode_fill_fb_struct(fb, mode_cmd);
  377. ret = drm_framebuffer_init(dev, fb, &omap_framebuffer_funcs);
  378. if (ret) {
  379. dev_err(dev->dev, "framebuffer init failed: %d\n", ret);
  380. goto fail;
  381. }
  382. DBG("create: FB ID: %d (%p)", fb->base.id, fb);
  383. return fb;
  384. fail:
  385. if (fb)
  386. omap_framebuffer_destroy(fb);
  387. return ERR_PTR(ret);
  388. }