blob: ade319d10e703989f594e8103ccb94dd05b41eb5 [file] [log] [blame]
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +02001/*
2 * drm kms/fb cma (contiguous memory allocator) helper functions
3 *
4 * Copyright (C) 2012 Analog Device Inc.
5 * Author: Lars-Peter Clausen <lars@metafoo.de>
6 *
7 * Based on udl_fbdev.c
8 * Copyright (C) 2012 Red Hat
9 *
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License
12 * as published by the Free Software Foundation; either version 2
13 * of the License, or (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
18 */
19
20#include <drm/drmP.h>
Marek Vasut14d7f962016-11-14 11:07:31 +010021#include <drm/drm_atomic.h>
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +020022#include <drm/drm_crtc.h>
23#include <drm/drm_fb_helper.h>
24#include <drm/drm_crtc_helper.h>
25#include <drm/drm_gem_cma_helper.h>
26#include <drm/drm_fb_cma_helper.h>
Marek Vasut14d7f962016-11-14 11:07:31 +010027#include <linux/dma-buf.h>
Robin Murphyce0c5752016-06-07 13:18:09 +010028#include <linux/dma-mapping.h>
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +020029#include <linux/module.h>
Marek Vasut14d7f962016-11-14 11:07:31 +010030#include <linux/reservation.h>
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +020031
Noralf Trønnes199c7712016-04-28 17:18:35 +020032#define DEFAULT_FBDEFIO_DELAY_MS 50
33
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +020034struct drm_fb_cma {
35 struct drm_framebuffer fb;
36 struct drm_gem_cma_object *obj[4];
37};
38
39struct drm_fbdev_cma {
40 struct drm_fb_helper fb_helper;
41 struct drm_fb_cma *fb;
Daniel Vetterb1124812016-12-29 21:48:31 +010042 const struct drm_framebuffer_funcs *fb_funcs;
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +020043};
44
Noralf Trønnes199c7712016-04-28 17:18:35 +020045/**
46 * DOC: framebuffer cma helper functions
47 *
48 * Provides helper functions for creating a cma (contiguous memory allocator)
49 * backed framebuffer.
50 *
Daniel Vetter421242a2016-12-29 21:48:34 +010051 * drm_fb_cma_create() is used in the &drm_mode_config_funcs.fb_create
Noralf Trønnes02da16d2016-05-11 18:09:18 +020052 * callback function to create a cma backed framebuffer.
Noralf Trønnes199c7712016-04-28 17:18:35 +020053 *
54 * An fbdev framebuffer backed by cma is also available by calling
55 * drm_fbdev_cma_init(). drm_fbdev_cma_fini() tears it down.
Daniel Vetter421242a2016-12-29 21:48:34 +010056 * If the &drm_framebuffer_funcs.dirty callback is set, fb_deferred_io will be
57 * set up automatically. &drm_framebuffer_funcs.dirty is called by
58 * drm_fb_helper_deferred_io() in process context (&struct delayed_work).
Noralf Trønnes199c7712016-04-28 17:18:35 +020059 *
Daniel Vetterda5335b2016-05-31 22:55:13 +020060 * Example fbdev deferred io code::
Noralf Trønnes199c7712016-04-28 17:18:35 +020061 *
Daniel Vetterb1124812016-12-29 21:48:31 +010062 * static int driver_fb_dirty(struct drm_framebuffer *fb,
63 * struct drm_file *file_priv,
64 * unsigned flags, unsigned color,
65 * struct drm_clip_rect *clips,
66 * unsigned num_clips)
Noralf Trønnes199c7712016-04-28 17:18:35 +020067 * {
68 * struct drm_gem_cma_object *cma = drm_fb_cma_get_gem_obj(fb, 0);
69 * ... push changes ...
70 * return 0;
71 * }
72 *
Daniel Vetterb1124812016-12-29 21:48:31 +010073 * static struct drm_framebuffer_funcs driver_fb_funcs = {
Noralf Trønnes199c7712016-04-28 17:18:35 +020074 * .destroy = drm_fb_cma_destroy,
75 * .create_handle = drm_fb_cma_create_handle,
Daniel Vetterb1124812016-12-29 21:48:31 +010076 * .dirty = driver_fb_dirty,
Noralf Trønnes199c7712016-04-28 17:18:35 +020077 * };
78 *
Daniel Vetterb1124812016-12-29 21:48:31 +010079 * Initialize::
Noralf Trønnes199c7712016-04-28 17:18:35 +020080 *
Noralf Trønnes199c7712016-04-28 17:18:35 +020081 * fbdev = drm_fbdev_cma_init_with_funcs(dev, 16,
82 * dev->mode_config.num_crtc,
83 * dev->mode_config.num_connector,
Daniel Vetterb1124812016-12-29 21:48:31 +010084 * &driver_fb_funcs);
Noralf Trønnes199c7712016-04-28 17:18:35 +020085 *
86 */
87
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +020088static inline struct drm_fbdev_cma *to_fbdev_cma(struct drm_fb_helper *helper)
89{
90 return container_of(helper, struct drm_fbdev_cma, fb_helper);
91}
92
93static inline struct drm_fb_cma *to_fb_cma(struct drm_framebuffer *fb)
94{
95 return container_of(fb, struct drm_fb_cma, fb);
96}
97
Noralf Trønnes199c7712016-04-28 17:18:35 +020098void drm_fb_cma_destroy(struct drm_framebuffer *fb)
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +020099{
100 struct drm_fb_cma *fb_cma = to_fb_cma(fb);
101 int i;
102
103 for (i = 0; i < 4; i++) {
104 if (fb_cma->obj[i])
Thierry Redinge6b62712017-02-28 15:46:41 +0100105 drm_gem_object_put_unlocked(&fb_cma->obj[i]->base);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200106 }
107
108 drm_framebuffer_cleanup(fb);
109 kfree(fb_cma);
110}
Noralf Trønnes199c7712016-04-28 17:18:35 +0200111EXPORT_SYMBOL(drm_fb_cma_destroy);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200112
Noralf Trønnes199c7712016-04-28 17:18:35 +0200113int drm_fb_cma_create_handle(struct drm_framebuffer *fb,
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200114 struct drm_file *file_priv, unsigned int *handle)
115{
116 struct drm_fb_cma *fb_cma = to_fb_cma(fb);
117
118 return drm_gem_handle_create(file_priv,
119 &fb_cma->obj[0]->base, handle);
120}
Noralf Trønnes199c7712016-04-28 17:18:35 +0200121EXPORT_SYMBOL(drm_fb_cma_create_handle);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200122
123static struct drm_framebuffer_funcs drm_fb_cma_funcs = {
124 .destroy = drm_fb_cma_destroy,
125 .create_handle = drm_fb_cma_create_handle,
126};
127
128static struct drm_fb_cma *drm_fb_cma_alloc(struct drm_device *dev,
Colin Ian King70c06162016-01-20 10:59:34 +0000129 const struct drm_mode_fb_cmd2 *mode_cmd,
130 struct drm_gem_cma_object **obj,
Noralf Trønnesfdce1842016-05-12 20:25:21 +0200131 unsigned int num_planes, const struct drm_framebuffer_funcs *funcs)
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200132{
133 struct drm_fb_cma *fb_cma;
134 int ret;
135 int i;
136
137 fb_cma = kzalloc(sizeof(*fb_cma), GFP_KERNEL);
138 if (!fb_cma)
139 return ERR_PTR(-ENOMEM);
140
Ville Syrjäläa3f913c2016-12-14 22:48:59 +0200141 drm_helper_mode_fill_fb_struct(dev, &fb_cma->fb, mode_cmd);
Daniel Vetterc7d73f62012-12-13 23:38:38 +0100142
143 for (i = 0; i < num_planes; i++)
144 fb_cma->obj[i] = obj[i];
145
Noralf Trønnes199c7712016-04-28 17:18:35 +0200146 ret = drm_framebuffer_init(dev, &fb_cma->fb, funcs);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200147 if (ret) {
Masanari Iida8b513d02013-05-21 23:13:12 +0900148 dev_err(dev->dev, "Failed to initialize framebuffer: %d\n", ret);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200149 kfree(fb_cma);
150 return ERR_PTR(ret);
151 }
152
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200153 return fb_cma;
154}
155
156/**
Noralf Trønnes3995b392016-05-12 20:25:22 +0200157 * drm_fb_cma_create_with_funcs() - helper function for the
Daniel Vetter421242a2016-12-29 21:48:34 +0100158 * &drm_mode_config_funcs.fb_create
159 * callback
Daniel Vetter890358a2016-05-31 23:11:12 +0200160 * @dev: DRM device
161 * @file_priv: drm file for the ioctl call
162 * @mode_cmd: metadata from the userspace fb creation request
163 * @funcs: vtable to be used for the new framebuffer object
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200164 *
Noralf Trønnes3995b392016-05-12 20:25:22 +0200165 * This can be used to set &drm_framebuffer_funcs for drivers that need the
Daniel Vetter421242a2016-12-29 21:48:34 +0100166 * &drm_framebuffer_funcs.dirty callback. Use drm_fb_cma_create() if you don't
167 * need to change &drm_framebuffer_funcs.
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200168 */
Noralf Trønnes3995b392016-05-12 20:25:22 +0200169struct drm_framebuffer *drm_fb_cma_create_with_funcs(struct drm_device *dev,
170 struct drm_file *file_priv, const struct drm_mode_fb_cmd2 *mode_cmd,
171 const struct drm_framebuffer_funcs *funcs)
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200172{
Laurent Pinchartd5493492016-10-18 01:41:11 +0300173 const struct drm_format_info *info;
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200174 struct drm_fb_cma *fb_cma;
175 struct drm_gem_cma_object *objs[4];
176 struct drm_gem_object *obj;
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200177 int ret;
178 int i;
179
Ville Syrjälä6a0f9eb2017-03-21 20:12:16 +0200180 info = drm_get_format_info(dev, mode_cmd);
Laurent Pinchartd5493492016-10-18 01:41:11 +0300181 if (!info)
182 return ERR_PTR(-EINVAL);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200183
Laurent Pinchartd5493492016-10-18 01:41:11 +0300184 for (i = 0; i < info->num_planes; i++) {
185 unsigned int width = mode_cmd->width / (i ? info->hsub : 1);
186 unsigned int height = mode_cmd->height / (i ? info->vsub : 1);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200187 unsigned int min_size;
188
Chris Wilsona8ad0bd2016-05-09 11:04:54 +0100189 obj = drm_gem_object_lookup(file_priv, mode_cmd->handles[i]);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200190 if (!obj) {
191 dev_err(dev->dev, "Failed to lookup GEM object\n");
Daniel Vetter765393d2017-04-18 14:11:20 +0200192 ret = -ENOENT;
Thierry Redinge6b62712017-02-28 15:46:41 +0100193 goto err_gem_object_put;
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200194 }
195
196 min_size = (height - 1) * mode_cmd->pitches[i]
Laurent Pinchartd5493492016-10-18 01:41:11 +0300197 + width * info->cpp[i]
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200198 + mode_cmd->offsets[i];
199
200 if (obj->size < min_size) {
Thierry Redinge6b62712017-02-28 15:46:41 +0100201 drm_gem_object_put_unlocked(obj);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200202 ret = -EINVAL;
Thierry Redinge6b62712017-02-28 15:46:41 +0100203 goto err_gem_object_put;
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200204 }
205 objs[i] = to_drm_gem_cma_obj(obj);
206 }
207
Noralf Trønnes3995b392016-05-12 20:25:22 +0200208 fb_cma = drm_fb_cma_alloc(dev, mode_cmd, objs, i, funcs);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200209 if (IS_ERR(fb_cma)) {
210 ret = PTR_ERR(fb_cma);
Thierry Redinge6b62712017-02-28 15:46:41 +0100211 goto err_gem_object_put;
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200212 }
213
214 return &fb_cma->fb;
215
Thierry Redinge6b62712017-02-28 15:46:41 +0100216err_gem_object_put:
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200217 for (i--; i >= 0; i--)
Thierry Redinge6b62712017-02-28 15:46:41 +0100218 drm_gem_object_put_unlocked(&objs[i]->base);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200219 return ERR_PTR(ret);
220}
Noralf Trønnes3995b392016-05-12 20:25:22 +0200221EXPORT_SYMBOL_GPL(drm_fb_cma_create_with_funcs);
222
223/**
Daniel Vetter421242a2016-12-29 21:48:34 +0100224 * drm_fb_cma_create() - &drm_mode_config_funcs.fb_create callback function
Daniel Vetter890358a2016-05-31 23:11:12 +0200225 * @dev: DRM device
226 * @file_priv: drm file for the ioctl call
227 * @mode_cmd: metadata from the userspace fb creation request
Noralf Trønnes3995b392016-05-12 20:25:22 +0200228 *
229 * If your hardware has special alignment or pitch requirements these should be
230 * checked before calling this function. Use drm_fb_cma_create_with_funcs() if
Daniel Vetter421242a2016-12-29 21:48:34 +0100231 * you need to set &drm_framebuffer_funcs.dirty.
Noralf Trønnes3995b392016-05-12 20:25:22 +0200232 */
233struct drm_framebuffer *drm_fb_cma_create(struct drm_device *dev,
234 struct drm_file *file_priv, const struct drm_mode_fb_cmd2 *mode_cmd)
235{
236 return drm_fb_cma_create_with_funcs(dev, file_priv, mode_cmd,
237 &drm_fb_cma_funcs);
238}
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200239EXPORT_SYMBOL_GPL(drm_fb_cma_create);
240
241/**
242 * drm_fb_cma_get_gem_obj() - Get CMA GEM object for framebuffer
243 * @fb: The framebuffer
244 * @plane: Which plane
245 *
246 * Return the CMA GEM object for given framebuffer.
247 *
248 * This function will usually be called from the CRTC callback functions.
249 */
250struct drm_gem_cma_object *drm_fb_cma_get_gem_obj(struct drm_framebuffer *fb,
Daniel Vetter890358a2016-05-31 23:11:12 +0200251 unsigned int plane)
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200252{
253 struct drm_fb_cma *fb_cma = to_fb_cma(fb);
254
255 if (plane >= 4)
256 return NULL;
257
258 return fb_cma->obj[plane];
259}
260EXPORT_SYMBOL_GPL(drm_fb_cma_get_gem_obj);
261
Marek Vasut14d7f962016-11-14 11:07:31 +0100262/**
Yannick Fertre4636ce92017-04-14 12:13:32 +0200263 * drm_fb_cma_get_gem_addr() - Get physical address for framebuffer
264 * @fb: The framebuffer
265 * @state: Which state of drm plane
266 * @plane: Which plane
267 * Return the CMA GEM address for given framebuffer.
268 *
269 * This function will usually be called from the PLANE callback functions.
270 */
271dma_addr_t drm_fb_cma_get_gem_addr(struct drm_framebuffer *fb,
272 struct drm_plane_state *state,
273 unsigned int plane)
274{
275 struct drm_fb_cma *fb_cma = to_fb_cma(fb);
276 dma_addr_t paddr;
277
278 if (plane >= 4)
279 return 0;
280
281 paddr = fb_cma->obj[plane]->paddr + fb->offsets[plane];
282 paddr += fb->format->cpp[plane] * (state->src_x >> 16);
283 paddr += fb->pitches[plane] * (state->src_y >> 16);
284
285 return paddr;
286}
287EXPORT_SYMBOL_GPL(drm_fb_cma_get_gem_addr);
288
289/**
Marek Vasut14d7f962016-11-14 11:07:31 +0100290 * drm_fb_cma_prepare_fb() - Prepare CMA framebuffer
291 * @plane: Which plane
292 * @state: Plane state attach fence to
293 *
Daniel Vetter421242a2016-12-29 21:48:34 +0100294 * This should be set as the &struct drm_plane_helper_funcs.prepare_fb hook.
Marek Vasut14d7f962016-11-14 11:07:31 +0100295 *
296 * This function checks if the plane FB has an dma-buf attached, extracts
297 * the exclusive fence and attaches it to plane state for the atomic helper
298 * to wait on.
299 *
300 * There is no need for cleanup_fb for CMA based framebuffer drivers.
301 */
302int drm_fb_cma_prepare_fb(struct drm_plane *plane,
303 struct drm_plane_state *state)
304{
305 struct dma_buf *dma_buf;
306 struct dma_fence *fence;
307
308 if ((plane->state->fb == state->fb) || !state->fb)
309 return 0;
310
311 dma_buf = drm_fb_cma_get_gem_obj(state->fb, 0)->base.dma_buf;
312 if (dma_buf) {
313 fence = reservation_object_get_excl_rcu(dma_buf->resv);
314 drm_atomic_set_fence_for_plane(state, fence);
315 }
316
317 return 0;
318}
319EXPORT_SYMBOL_GPL(drm_fb_cma_prepare_fb);
320
Rob Clark6f646092012-12-10 10:46:43 -0600321#ifdef CONFIG_DEBUG_FS
Lespiau, Damien2c9c52e2013-08-20 00:53:08 +0100322static void drm_fb_cma_describe(struct drm_framebuffer *fb, struct seq_file *m)
Rob Clark6f646092012-12-10 10:46:43 -0600323{
324 struct drm_fb_cma *fb_cma = to_fb_cma(fb);
Laurent Pinchartd5493492016-10-18 01:41:11 +0300325 int i;
Rob Clark6f646092012-12-10 10:46:43 -0600326
327 seq_printf(m, "fb: %dx%d@%4.4s\n", fb->width, fb->height,
Ville Syrjälä438b74a2016-12-14 23:32:55 +0200328 (char *)&fb->format->format);
Rob Clark6f646092012-12-10 10:46:43 -0600329
Ville Syrjäläffb9c362016-12-15 16:29:27 +0200330 for (i = 0; i < fb->format->num_planes; i++) {
Rob Clark6f646092012-12-10 10:46:43 -0600331 seq_printf(m, " %d: offset=%d pitch=%d, obj: ",
332 i, fb->offsets[i], fb->pitches[i]);
333 drm_gem_cma_describe(fb_cma->obj[i], m);
334 }
335}
Rob Clark6f646092012-12-10 10:46:43 -0600336
337/**
338 * drm_fb_cma_debugfs_show() - Helper to list CMA framebuffer objects
Daniel Vetter890358a2016-05-31 23:11:12 +0200339 * in debugfs.
340 * @m: output file
341 * @arg: private data for the callback
Rob Clark6f646092012-12-10 10:46:43 -0600342 */
343int drm_fb_cma_debugfs_show(struct seq_file *m, void *arg)
344{
345 struct drm_info_node *node = (struct drm_info_node *) m->private;
346 struct drm_device *dev = node->minor->dev;
347 struct drm_framebuffer *fb;
Rob Clark6f646092012-12-10 10:46:43 -0600348
Daniel Vetter9e75c0e2015-07-09 23:32:34 +0200349 mutex_lock(&dev->mode_config.fb_lock);
Daniel Vettere4f62542015-07-09 23:44:35 +0200350 drm_for_each_fb(fb, dev)
Rob Clark6f646092012-12-10 10:46:43 -0600351 drm_fb_cma_describe(fb, m);
Daniel Vetter9e75c0e2015-07-09 23:32:34 +0200352 mutex_unlock(&dev->mode_config.fb_lock);
Rob Clark6f646092012-12-10 10:46:43 -0600353
354 return 0;
355}
356EXPORT_SYMBOL_GPL(drm_fb_cma_debugfs_show);
357#endif
358
Robin Murphyce0c5752016-06-07 13:18:09 +0100359static int drm_fb_cma_mmap(struct fb_info *info, struct vm_area_struct *vma)
360{
361 return dma_mmap_writecombine(info->device, vma, info->screen_base,
362 info->fix.smem_start, info->fix.smem_len);
363}
364
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200365static struct fb_ops drm_fbdev_cma_ops = {
366 .owner = THIS_MODULE,
Stefan Christ659119d2016-11-14 00:03:16 +0100367 DRM_FB_HELPER_DEFAULT_OPS,
Archit Taneja85f2edf2015-07-22 14:58:20 +0530368 .fb_fillrect = drm_fb_helper_sys_fillrect,
369 .fb_copyarea = drm_fb_helper_sys_copyarea,
370 .fb_imageblit = drm_fb_helper_sys_imageblit,
Robin Murphyce0c5752016-06-07 13:18:09 +0100371 .fb_mmap = drm_fb_cma_mmap,
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200372};
373
Noralf Trønnes199c7712016-04-28 17:18:35 +0200374static int drm_fbdev_cma_deferred_io_mmap(struct fb_info *info,
375 struct vm_area_struct *vma)
376{
377 fb_deferred_io_mmap(info, vma);
378 vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
379
380 return 0;
381}
382
383static int drm_fbdev_cma_defio_init(struct fb_info *fbi,
384 struct drm_gem_cma_object *cma_obj)
385{
386 struct fb_deferred_io *fbdefio;
387 struct fb_ops *fbops;
388
389 /*
390 * Per device structures are needed because:
391 * fbops: fb_deferred_io_cleanup() clears fbops.fb_mmap
392 * fbdefio: individual delays
393 */
394 fbdefio = kzalloc(sizeof(*fbdefio), GFP_KERNEL);
395 fbops = kzalloc(sizeof(*fbops), GFP_KERNEL);
396 if (!fbdefio || !fbops) {
397 kfree(fbdefio);
Sudip Mukherjee2a927622016-06-12 16:03:56 +0100398 kfree(fbops);
Noralf Trønnes199c7712016-04-28 17:18:35 +0200399 return -ENOMEM;
400 }
401
402 /* can't be offset from vaddr since dirty() uses cma_obj */
403 fbi->screen_buffer = cma_obj->vaddr;
404 /* fb_deferred_io_fault() needs a physical address */
405 fbi->fix.smem_start = page_to_phys(virt_to_page(fbi->screen_buffer));
406
407 *fbops = *fbi->fbops;
408 fbi->fbops = fbops;
409
410 fbdefio->delay = msecs_to_jiffies(DEFAULT_FBDEFIO_DELAY_MS);
411 fbdefio->deferred_io = drm_fb_helper_deferred_io;
412 fbi->fbdefio = fbdefio;
413 fb_deferred_io_init(fbi);
414 fbi->fbops->fb_mmap = drm_fbdev_cma_deferred_io_mmap;
415
416 return 0;
417}
418
419static void drm_fbdev_cma_defio_fini(struct fb_info *fbi)
420{
421 if (!fbi->fbdefio)
422 return;
423
424 fb_deferred_io_cleanup(fbi);
425 kfree(fbi->fbdefio);
426 kfree(fbi->fbops);
427}
428
Daniel Vetterb1124812016-12-29 21:48:31 +0100429static int
430drm_fbdev_cma_create(struct drm_fb_helper *helper,
431 struct drm_fb_helper_surface_size *sizes)
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200432{
433 struct drm_fbdev_cma *fbdev_cma = to_fbdev_cma(helper);
434 struct drm_mode_fb_cmd2 mode_cmd = { 0 };
435 struct drm_device *dev = helper->dev;
436 struct drm_gem_cma_object *obj;
437 struct drm_framebuffer *fb;
438 unsigned int bytes_per_pixel;
439 unsigned long offset;
440 struct fb_info *fbi;
441 size_t size;
442 int ret;
443
Thierry Redinge0d78d02012-10-20 10:32:46 +0000444 DRM_DEBUG_KMS("surface width(%d), height(%d) and bpp(%d)\n",
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200445 sizes->surface_width, sizes->surface_height,
446 sizes->surface_bpp);
447
448 bytes_per_pixel = DIV_ROUND_UP(sizes->surface_bpp, 8);
449
450 mode_cmd.width = sizes->surface_width;
451 mode_cmd.height = sizes->surface_height;
452 mode_cmd.pitches[0] = sizes->surface_width * bytes_per_pixel;
453 mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
454 sizes->surface_depth);
455
456 size = mode_cmd.pitches[0] * mode_cmd.height;
457 obj = drm_gem_cma_create(dev, size);
Thierry Reding02813242012-10-20 10:32:47 +0000458 if (IS_ERR(obj))
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200459 return -ENOMEM;
460
Archit Taneja85f2edf2015-07-22 14:58:20 +0530461 fbi = drm_fb_helper_alloc_fbi(helper);
462 if (IS_ERR(fbi)) {
463 ret = PTR_ERR(fbi);
Eric Anholt50cbc132015-12-14 16:26:26 -0800464 goto err_gem_free_object;
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200465 }
466
Daniel Vetterb1124812016-12-29 21:48:31 +0100467 fbdev_cma->fb = drm_fb_cma_alloc(dev, &mode_cmd, &obj, 1,
468 fbdev_cma->fb_funcs);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200469 if (IS_ERR(fbdev_cma->fb)) {
470 dev_err(dev->dev, "Failed to allocate DRM framebuffer.\n");
471 ret = PTR_ERR(fbdev_cma->fb);
Archit Taneja85f2edf2015-07-22 14:58:20 +0530472 goto err_fb_info_destroy;
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200473 }
474
475 fb = &fbdev_cma->fb->fb;
476 helper->fb = fb;
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200477
478 fbi->par = helper;
479 fbi->flags = FBINFO_FLAG_DEFAULT;
480 fbi->fbops = &drm_fbdev_cma_ops;
481
Ville Syrjäläb00c6002016-12-14 23:31:35 +0200482 drm_fb_helper_fill_fix(fbi, fb->pitches[0], fb->format->depth);
Rob Clark8d766122015-03-11 10:23:10 -0400483 drm_fb_helper_fill_var(fbi, helper, sizes->fb_width, sizes->fb_height);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200484
485 offset = fbi->var.xoffset * bytes_per_pixel;
486 offset += fbi->var.yoffset * fb->pitches[0];
487
488 dev->mode_config.fb_base = (resource_size_t)obj->paddr;
489 fbi->screen_base = obj->vaddr + offset;
490 fbi->fix.smem_start = (unsigned long)(obj->paddr + offset);
491 fbi->screen_size = size;
492 fbi->fix.smem_len = size;
493
Daniel Vetterb1124812016-12-29 21:48:31 +0100494 if (fbdev_cma->fb_funcs->dirty) {
Noralf Trønnes199c7712016-04-28 17:18:35 +0200495 ret = drm_fbdev_cma_defio_init(fbi, obj);
496 if (ret)
497 goto err_cma_destroy;
498 }
499
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200500 return 0;
501
Noralf Trønnes199c7712016-04-28 17:18:35 +0200502err_cma_destroy:
Daniel Vetter2384d622016-12-27 11:49:22 +0100503 drm_framebuffer_remove(&fbdev_cma->fb->fb);
Archit Taneja85f2edf2015-07-22 14:58:20 +0530504err_fb_info_destroy:
Daniel Vetterda7bdda2017-02-07 17:16:03 +0100505 drm_fb_helper_fini(helper);
Eric Anholt50cbc132015-12-14 16:26:26 -0800506err_gem_free_object:
Thierry Redinge6b62712017-02-28 15:46:41 +0100507 drm_gem_object_put_unlocked(&obj->base);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200508 return ret;
509}
510
Thierry Reding3a493872014-06-27 17:19:23 +0200511static const struct drm_fb_helper_funcs drm_fb_cma_helper_funcs = {
Daniel Vettercd5428a2013-01-21 23:42:49 +0100512 .fb_probe = drm_fbdev_cma_create,
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200513};
514
515/**
Noralf Trønnes199c7712016-04-28 17:18:35 +0200516 * drm_fbdev_cma_init_with_funcs() - Allocate and initializes a drm_fbdev_cma struct
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200517 * @dev: DRM device
518 * @preferred_bpp: Preferred bits per pixel for the device
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200519 * @max_conn_count: Maximum number of connectors
Daniel Vetterb1124812016-12-29 21:48:31 +0100520 * @funcs: fb helper functions, in particular a custom dirty() callback
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200521 *
522 * Returns a newly allocated drm_fbdev_cma struct or a ERR_PTR.
523 */
Noralf Trønnes199c7712016-04-28 17:18:35 +0200524struct drm_fbdev_cma *drm_fbdev_cma_init_with_funcs(struct drm_device *dev,
Gabriel Krisman Bertazie4563f62017-02-02 14:26:40 -0200525 unsigned int preferred_bpp, unsigned int max_conn_count,
526 const struct drm_framebuffer_funcs *funcs)
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200527{
528 struct drm_fbdev_cma *fbdev_cma;
529 struct drm_fb_helper *helper;
530 int ret;
531
532 fbdev_cma = kzalloc(sizeof(*fbdev_cma), GFP_KERNEL);
533 if (!fbdev_cma) {
534 dev_err(dev->dev, "Failed to allocate drm fbdev.\n");
535 return ERR_PTR(-ENOMEM);
536 }
Daniel Vetterb1124812016-12-29 21:48:31 +0100537 fbdev_cma->fb_funcs = funcs;
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200538
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200539 helper = &fbdev_cma->fb_helper;
540
Daniel Vetterb1124812016-12-29 21:48:31 +0100541 drm_fb_helper_prepare(dev, helper, &drm_fb_cma_helper_funcs);
Thierry Reding10a23102014-06-27 17:19:24 +0200542
Gabriel Krisman Bertazie4563f62017-02-02 14:26:40 -0200543 ret = drm_fb_helper_init(dev, helper, max_conn_count);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200544 if (ret < 0) {
545 dev_err(dev->dev, "Failed to initialize drm fb helper.\n");
546 goto err_free;
547 }
548
549 ret = drm_fb_helper_single_add_all_connectors(helper);
550 if (ret < 0) {
551 dev_err(dev->dev, "Failed to add connectors.\n");
552 goto err_drm_fb_helper_fini;
553
554 }
555
556 ret = drm_fb_helper_initial_config(helper, preferred_bpp);
557 if (ret < 0) {
Masanari Iida8b513d02013-05-21 23:13:12 +0900558 dev_err(dev->dev, "Failed to set initial hw configuration.\n");
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200559 goto err_drm_fb_helper_fini;
560 }
561
562 return fbdev_cma;
563
564err_drm_fb_helper_fini:
565 drm_fb_helper_fini(helper);
566err_free:
567 kfree(fbdev_cma);
568
569 return ERR_PTR(ret);
570}
Noralf Trønnes199c7712016-04-28 17:18:35 +0200571EXPORT_SYMBOL_GPL(drm_fbdev_cma_init_with_funcs);
572
573/**
574 * drm_fbdev_cma_init() - Allocate and initializes a drm_fbdev_cma struct
575 * @dev: DRM device
576 * @preferred_bpp: Preferred bits per pixel for the device
Noralf Trønnes199c7712016-04-28 17:18:35 +0200577 * @max_conn_count: Maximum number of connectors
578 *
579 * Returns a newly allocated drm_fbdev_cma struct or a ERR_PTR.
580 */
581struct drm_fbdev_cma *drm_fbdev_cma_init(struct drm_device *dev,
Gabriel Krisman Bertazie4563f62017-02-02 14:26:40 -0200582 unsigned int preferred_bpp, unsigned int max_conn_count)
Noralf Trønnes199c7712016-04-28 17:18:35 +0200583{
Gabriel Krisman Bertazie4563f62017-02-02 14:26:40 -0200584 return drm_fbdev_cma_init_with_funcs(dev, preferred_bpp,
585 max_conn_count,
586 &drm_fb_cma_funcs);
Noralf Trønnes199c7712016-04-28 17:18:35 +0200587}
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200588EXPORT_SYMBOL_GPL(drm_fbdev_cma_init);
589
590/**
591 * drm_fbdev_cma_fini() - Free drm_fbdev_cma struct
592 * @fbdev_cma: The drm_fbdev_cma struct
593 */
594void drm_fbdev_cma_fini(struct drm_fbdev_cma *fbdev_cma)
595{
Archit Taneja85f2edf2015-07-22 14:58:20 +0530596 drm_fb_helper_unregister_fbi(&fbdev_cma->fb_helper);
Stefan Agner41b9bb12016-10-19 17:32:19 -0700597 if (fbdev_cma->fb_helper.fbdev)
598 drm_fbdev_cma_defio_fini(fbdev_cma->fb_helper.fbdev);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200599
Daniel Vetter2384d622016-12-27 11:49:22 +0100600 if (fbdev_cma->fb)
601 drm_framebuffer_remove(&fbdev_cma->fb->fb);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200602
603 drm_fb_helper_fini(&fbdev_cma->fb_helper);
604 kfree(fbdev_cma);
605}
606EXPORT_SYMBOL_GPL(drm_fbdev_cma_fini);
607
608/**
609 * drm_fbdev_cma_restore_mode() - Restores initial framebuffer mode
610 * @fbdev_cma: The drm_fbdev_cma struct, may be NULL
611 *
Daniel Vetter421242a2016-12-29 21:48:34 +0100612 * This function is usually called from the &drm_driver.lastclose callback.
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200613 */
614void drm_fbdev_cma_restore_mode(struct drm_fbdev_cma *fbdev_cma)
615{
Rob Clark5ea1f752014-05-30 12:29:48 -0400616 if (fbdev_cma)
617 drm_fb_helper_restore_fbdev_mode_unlocked(&fbdev_cma->fb_helper);
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200618}
619EXPORT_SYMBOL_GPL(drm_fbdev_cma_restore_mode);
620
621/**
622 * drm_fbdev_cma_hotplug_event() - Poll for hotpulug events
623 * @fbdev_cma: The drm_fbdev_cma struct, may be NULL
624 *
Daniel Vetter421242a2016-12-29 21:48:34 +0100625 * This function is usually called from the &drm_mode_config.output_poll_changed
Lars-Peter Clausen2e3b3c42012-07-02 16:37:47 +0200626 * callback.
627 */
628void drm_fbdev_cma_hotplug_event(struct drm_fbdev_cma *fbdev_cma)
629{
630 if (fbdev_cma)
631 drm_fb_helper_hotplug_event(&fbdev_cma->fb_helper);
632}
633EXPORT_SYMBOL_GPL(drm_fbdev_cma_hotplug_event);
Stefan Agner917f4252016-02-11 17:30:14 -0800634
635/**
636 * drm_fbdev_cma_set_suspend - wrapper around drm_fb_helper_set_suspend
637 * @fbdev_cma: The drm_fbdev_cma struct, may be NULL
638 * @state: desired state, zero to resume, non-zero to suspend
639 *
640 * Calls drm_fb_helper_set_suspend, which is a wrapper around
641 * fb_set_suspend implemented by fbdev core.
642 */
Liviu Dudaud0a29872017-06-20 11:23:20 +0100643void drm_fbdev_cma_set_suspend(struct drm_fbdev_cma *fbdev_cma, bool state)
Stefan Agner917f4252016-02-11 17:30:14 -0800644{
645 if (fbdev_cma)
646 drm_fb_helper_set_suspend(&fbdev_cma->fb_helper, state);
647}
648EXPORT_SYMBOL(drm_fbdev_cma_set_suspend);
Noralf Trønnesa4405b52017-01-22 19:11:09 +0100649
650/**
651 * drm_fbdev_cma_set_suspend_unlocked - wrapper around
652 * drm_fb_helper_set_suspend_unlocked
653 * @fbdev_cma: The drm_fbdev_cma struct, may be NULL
654 * @state: desired state, zero to resume, non-zero to suspend
655 *
656 * Calls drm_fb_helper_set_suspend, which is a wrapper around
657 * fb_set_suspend implemented by fbdev core.
658 */
659void drm_fbdev_cma_set_suspend_unlocked(struct drm_fbdev_cma *fbdev_cma,
Liviu Dudaud0a29872017-06-20 11:23:20 +0100660 bool state)
Noralf Trønnesa4405b52017-01-22 19:11:09 +0100661{
662 if (fbdev_cma)
663 drm_fb_helper_set_suspend_unlocked(&fbdev_cma->fb_helper,
664 state);
665}
666EXPORT_SYMBOL(drm_fbdev_cma_set_suspend_unlocked);