Commit | Line | Data |
---|---|---|
785b93ef DA |
1 | /* |
2 | * Copyright (c) 2006-2009 Red Hat Inc. | |
3 | * Copyright (c) 2006-2008 Intel Corporation | |
4 | * Copyright (c) 2007 Dave Airlie <airlied@linux.ie> | |
5 | * | |
6 | * DRM framebuffer helper functions | |
7 | * | |
8 | * Permission to use, copy, modify, distribute, and sell this software and its | |
9 | * documentation for any purpose is hereby granted without fee, provided that | |
10 | * the above copyright notice appear in all copies and that both that copyright | |
11 | * notice and this permission notice appear in supporting documentation, and | |
12 | * that the name of the copyright holders not be used in advertising or | |
13 | * publicity pertaining to distribution of the software without specific, | |
14 | * written prior permission. The copyright holders make no representations | |
15 | * about the suitability of this software for any purpose. It is provided "as | |
16 | * is" without express or implied warranty. | |
17 | * | |
18 | * THE COPYRIGHT HOLDERS DISCLAIM ALL WARRANTIES WITH REGARD TO THIS SOFTWARE, | |
19 | * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO | |
20 | * EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY SPECIAL, INDIRECT OR | |
21 | * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, | |
22 | * DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER | |
23 | * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE | |
24 | * OF THIS SOFTWARE. | |
25 | * | |
26 | * Authors: | |
27 | * Dave Airlie <airlied@linux.ie> | |
28 | * Jesse Barnes <jesse.barnes@intel.com> | |
29 | */ | |
d56b1b9d SK |
30 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
31 | ||
cfe63423 | 32 | #include <linux/console.h> |
d536540f | 33 | #include <linux/dma-buf.h> |
3b40a443 | 34 | #include <linux/kernel.h> |
e0cd3608 | 35 | #include <linux/module.h> |
0500c04e SR |
36 | #include <linux/slab.h> |
37 | #include <linux/sysrq.h> | |
38 | #include <linux/vmalloc.h> | |
39 | ||
bbb1e524 | 40 | #include <drm/drm_atomic.h> |
0500c04e SR |
41 | #include <drm/drm_crtc.h> |
42 | #include <drm/drm_crtc_helper.h> | |
43 | #include <drm/drm_drv.h> | |
44 | #include <drm/drm_fb_helper.h> | |
45 | #include <drm/drm_fourcc.h> | |
46 | #include <drm/drm_print.h> | |
47 | #include <drm/drm_vblank.h> | |
785b93ef | 48 | |
7baa77f1 | 49 | #include "drm_crtc_helper_internal.h" |
03a9606e | 50 | #include "drm_internal.h" |
699fbeea | 51 | |
f64c5573 DV |
52 | static bool drm_fbdev_emulation = true; |
53 | module_param_named(fbdev_emulation, drm_fbdev_emulation, bool, 0600); | |
54 | MODULE_PARM_DESC(fbdev_emulation, | |
55 | "Enable legacy fbdev emulation [default=true]"); | |
56 | ||
5f152576 XL |
57 | static int drm_fbdev_overalloc = CONFIG_DRM_FBDEV_OVERALLOC; |
58 | module_param(drm_fbdev_overalloc, int, 0444); | |
59 | MODULE_PARM_DESC(drm_fbdev_overalloc, | |
60 | "Overallocation of the fbdev buffer (%) [default=" | |
61 | __MODULE_STRING(CONFIG_DRM_FBDEV_OVERALLOC) "]"); | |
62 | ||
4be9bd10 NA |
63 | /* |
64 | * In order to keep user-space compatibility, we want in certain use-cases | |
65 | * to keep leaking the fbdev physical address to the user-space program | |
66 | * handling the fbdev buffer. | |
67 | * This is a bad habit essentially kept into closed source opengl driver | |
68 | * that should really be moved into open-source upstream projects instead | |
69 | * of using legacy physical addresses in user space to communicate with | |
70 | * other out-of-tree kernel modules. | |
71 | * | |
72 | * This module_param *should* be removed as soon as possible and be | |
73 | * considered as a broken and legacy behaviour from a modern fbdev device. | |
74 | */ | |
75 | #if IS_ENABLED(CONFIG_DRM_FBDEV_LEAK_PHYS_SMEM) | |
76 | static bool drm_leak_fbdev_smem = false; | |
77 | module_param_unsafe(drm_leak_fbdev_smem, bool, 0600); | |
b31a3ca7 | 78 | MODULE_PARM_DESC(drm_leak_fbdev_smem, |
4be9bd10 NA |
79 | "Allow unsafe leaking fbdev physical smem address [default=false]"); |
80 | #endif | |
81 | ||
785b93ef | 82 | static LIST_HEAD(kernel_fb_helper_list); |
a53ca635 | 83 | static DEFINE_MUTEX(kernel_fb_helper_lock); |
785b93ef | 84 | |
d0ddc033 DV |
85 | /** |
86 | * DOC: fbdev helpers | |
87 | * | |
88 | * The fb helper functions are useful to provide an fbdev on top of a drm kernel | |
83c617c5 | 89 | * mode setting driver. They can be used mostly independently from the crtc |
d0ddc033 DV |
90 | * helper functions used by many drivers to implement the kernel mode setting |
91 | * interfaces. | |
207fd329 | 92 | * |
9060d7f4 NT |
93 | * Drivers that support a dumb buffer with a virtual address and mmap support, |
94 | * should try out the generic fbdev emulation using drm_fbdev_generic_setup(). | |
8e86dee0 TZ |
95 | * It will automatically set up deferred I/O if the driver requires a shadow |
96 | * buffer. | |
9060d7f4 | 97 | * |
95b0137f NT |
98 | * At runtime drivers should restore the fbdev console by using |
99 | * drm_fb_helper_lastclose() as their &drm_driver.lastclose callback. | |
100 | * They should also notify the fb helper code from updates to the output | |
101 | * configuration by using drm_fb_helper_output_poll_changed() as their | |
102 | * &drm_mode_config_funcs.output_poll_changed callback. | |
103 | * | |
104 | * For suspend/resume consider using drm_mode_config_helper_suspend() and | |
105 | * drm_mode_config_helper_resume() which takes care of fbdev as well. | |
207fd329 DV |
106 | * |
107 | * All other functions exported by the fb helper library can be used to | |
108 | * implement the fbdev driver interface by the driver. | |
10a23102 TR |
109 | * |
110 | * It is possible, though perhaps somewhat tricky, to implement race-free | |
111 | * hotplug detection using the fbdev helpers. The drm_fb_helper_prepare() | |
112 | * helper must be called first to initialize the minimum required to make | |
113 | * hotplug detection work. Drivers also need to make sure to properly set up | |
6806cdf9 | 114 | * the &drm_mode_config.funcs member. After calling drm_kms_helper_poll_init() |
10a23102 TR |
115 | * it is safe to enable interrupts and start processing hotplug events. At the |
116 | * same time, drivers should initialize all modeset objects such as CRTCs, | |
117 | * encoders and connectors. To finish up the fbdev helper initialization, the | |
118 | * drm_fb_helper_init() function is called. To probe for all attached displays | |
119 | * and set up an initial configuration using the detected hardware, drivers | |
e5852bee | 120 | * should call drm_fb_helper_initial_config(). |
eaa434de | 121 | * |
6806cdf9 | 122 | * If &drm_framebuffer_funcs.dirty is set, the |
2dad551c | 123 | * drm_fb_helper_{cfb,sys}_{write,fillrect,copyarea,imageblit} functions will |
6806cdf9 | 124 | * accumulate changes and schedule &drm_fb_helper.dirty_work to run right |
2dad551c NT |
125 | * away. This worker then calls the dirty() function ensuring that it will |
126 | * always run in process context since the fb_*() function could be running in | |
127 | * atomic context. If drm_fb_helper_deferred_io() is used as the deferred_io | |
128 | * callback it will also schedule dirty_work with the damage collected from the | |
8e86dee0 TZ |
129 | * mmap page writes. |
130 | * | |
131 | * Deferred I/O is not compatible with SHMEM. Such drivers should request an | |
132 | * fbdev shadow buffer and call drm_fbdev_generic_setup() instead. | |
d0ddc033 DV |
133 | */ |
134 | ||
99231028 JW |
135 | static void drm_fb_helper_restore_lut_atomic(struct drm_crtc *crtc) |
136 | { | |
137 | uint16_t *r_base, *g_base, *b_base; | |
138 | ||
ebe0f244 LP |
139 | if (crtc->funcs->gamma_set == NULL) |
140 | return; | |
141 | ||
99231028 JW |
142 | r_base = crtc->gamma_store; |
143 | g_base = r_base + crtc->gamma_size; | |
144 | b_base = g_base + crtc->gamma_size; | |
145 | ||
6d124ff8 DV |
146 | crtc->funcs->gamma_set(crtc, r_base, g_base, b_base, |
147 | crtc->gamma_size, NULL); | |
99231028 JW |
148 | } |
149 | ||
207fd329 | 150 | /** |
6806cdf9 | 151 | * drm_fb_helper_debug_enter - implementation for &fb_ops.fb_debug_enter |
207fd329 DV |
152 | * @info: fbdev registered by the helper |
153 | */ | |
1a7aba7f JB |
154 | int drm_fb_helper_debug_enter(struct fb_info *info) |
155 | { | |
156 | struct drm_fb_helper *helper = info->par; | |
be26a66d | 157 | const struct drm_crtc_helper_funcs *funcs; |
d81294af | 158 | struct drm_mode_set *mode_set; |
1a7aba7f | 159 | |
1a7aba7f | 160 | list_for_each_entry(helper, &kernel_fb_helper_list, kernel_fb_list) { |
d81294af NT |
161 | mutex_lock(&helper->client.modeset_mutex); |
162 | drm_client_for_each_modeset(mode_set, &helper->client) { | |
1a7aba7f JB |
163 | if (!mode_set->crtc->enabled) |
164 | continue; | |
165 | ||
166 | funcs = mode_set->crtc->helper_private; | |
1b99b724 SC |
167 | if (funcs->mode_set_base_atomic == NULL) |
168 | continue; | |
169 | ||
9c79e0b1 DV |
170 | if (drm_drv_uses_atomic_modeset(mode_set->crtc->dev)) |
171 | continue; | |
172 | ||
1a7aba7f JB |
173 | funcs->mode_set_base_atomic(mode_set->crtc, |
174 | mode_set->fb, | |
175 | mode_set->x, | |
413d45d3 | 176 | mode_set->y, |
21c74a8e | 177 | ENTER_ATOMIC_MODE_SET); |
1a7aba7f | 178 | } |
d81294af | 179 | mutex_unlock(&helper->client.modeset_mutex); |
1a7aba7f JB |
180 | } |
181 | ||
182 | return 0; | |
183 | } | |
184 | EXPORT_SYMBOL(drm_fb_helper_debug_enter); | |
185 | ||
207fd329 | 186 | /** |
6806cdf9 | 187 | * drm_fb_helper_debug_leave - implementation for &fb_ops.fb_debug_leave |
207fd329 DV |
188 | * @info: fbdev registered by the helper |
189 | */ | |
1a7aba7f JB |
190 | int drm_fb_helper_debug_leave(struct fb_info *info) |
191 | { | |
192 | struct drm_fb_helper *helper = info->par; | |
d81294af | 193 | struct drm_client_dev *client = &helper->client; |
f33b9730 | 194 | struct drm_device *dev = helper->dev; |
1a7aba7f | 195 | struct drm_crtc *crtc; |
be26a66d | 196 | const struct drm_crtc_helper_funcs *funcs; |
d81294af | 197 | struct drm_mode_set *mode_set; |
1a7aba7f | 198 | struct drm_framebuffer *fb; |
4b4f99f5 | 199 | |
d81294af NT |
200 | mutex_lock(&client->modeset_mutex); |
201 | drm_client_for_each_modeset(mode_set, client) { | |
1a7aba7f | 202 | crtc = mode_set->crtc; |
7114d2e2 ML |
203 | if (drm_drv_uses_atomic_modeset(crtc->dev)) |
204 | continue; | |
205 | ||
1a7aba7f | 206 | funcs = crtc->helper_private; |
7114d2e2 | 207 | fb = crtc->primary->fb; |
1a7aba7f JB |
208 | |
209 | if (!crtc->enabled) | |
210 | continue; | |
211 | ||
212 | if (!fb) { | |
f33b9730 | 213 | drm_err(dev, "no fb to restore?\n"); |
1a7aba7f JB |
214 | continue; |
215 | } | |
216 | ||
1b99b724 SC |
217 | if (funcs->mode_set_base_atomic == NULL) |
218 | continue; | |
219 | ||
99231028 | 220 | drm_fb_helper_restore_lut_atomic(mode_set->crtc); |
1a7aba7f | 221 | funcs->mode_set_base_atomic(mode_set->crtc, fb, crtc->x, |
21c74a8e | 222 | crtc->y, LEAVE_ATOMIC_MODE_SET); |
1a7aba7f | 223 | } |
d81294af | 224 | mutex_unlock(&client->modeset_mutex); |
1a7aba7f JB |
225 | |
226 | return 0; | |
227 | } | |
228 | EXPORT_SYMBOL(drm_fb_helper_debug_leave); | |
229 | ||
dc5bdb68 DV |
230 | static int |
231 | __drm_fb_helper_restore_fbdev_mode_unlocked(struct drm_fb_helper *fb_helper, | |
232 | bool force) | |
5ea1f752 | 233 | { |
b7bdf0a8 DV |
234 | bool do_delayed; |
235 | int ret; | |
e2809c7d | 236 | |
c777990f | 237 | if (!drm_fbdev_emulation || !fb_helper) |
f64c5573 DV |
238 | return -ENODEV; |
239 | ||
ca91a275 DV |
240 | if (READ_ONCE(fb_helper->deferred_setup)) |
241 | return 0; | |
242 | ||
e9827d8e | 243 | mutex_lock(&fb_helper->lock); |
dc5bdb68 DV |
244 | if (force) { |
245 | /* | |
246 | * Yes this is the _locked version which expects the master lock | |
247 | * to be held. But for forced restores we're intentionally | |
248 | * racing here, see drm_fb_helper_set_par(). | |
249 | */ | |
250 | ret = drm_client_modeset_commit_locked(&fb_helper->client); | |
251 | } else { | |
252 | ret = drm_client_modeset_commit(&fb_helper->client); | |
253 | } | |
e2809c7d DA |
254 | |
255 | do_delayed = fb_helper->delayed_hotplug; | |
256 | if (do_delayed) | |
257 | fb_helper->delayed_hotplug = false; | |
e9827d8e | 258 | mutex_unlock(&fb_helper->lock); |
e2809c7d DA |
259 | |
260 | if (do_delayed) | |
261 | drm_fb_helper_hotplug_event(fb_helper); | |
e9827d8e | 262 | |
5ea1f752 RC |
263 | return ret; |
264 | } | |
dc5bdb68 DV |
265 | |
266 | /** | |
267 | * drm_fb_helper_restore_fbdev_mode_unlocked - restore fbdev configuration | |
268 | * @fb_helper: driver-allocated fbdev helper, can be NULL | |
269 | * | |
270 | * This should be called from driver's drm &drm_driver.lastclose callback | |
271 | * when implementing an fbcon on top of kms using this helper. This ensures that | |
272 | * the user isn't greeted with a black screen when e.g. X dies. | |
273 | * | |
274 | * RETURNS: | |
275 | * Zero if everything went ok, negative error code otherwise. | |
276 | */ | |
277 | int drm_fb_helper_restore_fbdev_mode_unlocked(struct drm_fb_helper *fb_helper) | |
278 | { | |
279 | return __drm_fb_helper_restore_fbdev_mode_unlocked(fb_helper, false); | |
280 | } | |
5ea1f752 | 281 | EXPORT_SYMBOL(drm_fb_helper_restore_fbdev_mode_unlocked); |
e8e7a2b8 | 282 | |
2c4124fd | 283 | #ifdef CONFIG_MAGIC_SYSRQ |
a76fa354 DV |
284 | /* emergency restore, don't bother with error reporting */ |
285 | static void drm_fb_helper_restore_work_fn(struct work_struct *ignored) | |
785b93ef | 286 | { |
785b93ef DA |
287 | struct drm_fb_helper *helper; |
288 | ||
a76fa354 | 289 | mutex_lock(&kernel_fb_helper_lock); |
785b93ef | 290 | list_for_each_entry(helper, &kernel_fb_helper_list, kernel_fb_list) { |
b77f0765 TR |
291 | struct drm_device *dev = helper->dev; |
292 | ||
293 | if (dev->switch_power_state == DRM_SWITCH_POWER_OFF) | |
294 | continue; | |
295 | ||
e9827d8e | 296 | mutex_lock(&helper->lock); |
a76fa354 | 297 | drm_client_modeset_commit_locked(&helper->client); |
e9827d8e | 298 | mutex_unlock(&helper->lock); |
785b93ef | 299 | } |
a76fa354 | 300 | mutex_unlock(&kernel_fb_helper_lock); |
785b93ef DA |
301 | } |
302 | ||
785b93ef DA |
303 | static DECLARE_WORK(drm_fb_helper_restore_work, drm_fb_helper_restore_work_fn); |
304 | ||
1495cc9d | 305 | static void drm_fb_helper_sysrq(int dummy1) |
785b93ef DA |
306 | { |
307 | schedule_work(&drm_fb_helper_restore_work); | |
308 | } | |
309 | ||
c1a01f29 | 310 | static const struct sysrq_key_op sysrq_drm_fb_helper_restore_op = { |
785b93ef | 311 | .handler = drm_fb_helper_sysrq, |
a27eb0cb | 312 | .help_msg = "force-fb(v)", |
785b93ef DA |
313 | .action_msg = "Restore framebuffer console", |
314 | }; | |
b8c40d62 | 315 | #else |
c1a01f29 | 316 | static const struct sysrq_key_op sysrq_drm_fb_helper_restore_op = { }; |
bea1d35b | 317 | #endif |
785b93ef | 318 | |
eade2a17 NT |
319 | static void drm_fb_helper_dpms(struct fb_info *info, int dpms_mode) |
320 | { | |
321 | struct drm_fb_helper *fb_helper = info->par; | |
322 | ||
323 | mutex_lock(&fb_helper->lock); | |
324 | drm_client_modeset_dpms(&fb_helper->client, dpms_mode); | |
e9827d8e | 325 | mutex_unlock(&fb_helper->lock); |
785b93ef DA |
326 | } |
327 | ||
207fd329 | 328 | /** |
6806cdf9 | 329 | * drm_fb_helper_blank - implementation for &fb_ops.fb_blank |
207fd329 DV |
330 | * @blank: desired blanking state |
331 | * @info: fbdev registered by the helper | |
332 | */ | |
785b93ef DA |
333 | int drm_fb_helper_blank(int blank, struct fb_info *info) |
334 | { | |
c50bfd08 DV |
335 | if (oops_in_progress) |
336 | return -EBUSY; | |
337 | ||
785b93ef | 338 | switch (blank) { |
731b5a15 | 339 | /* Display: On; HSync: On, VSync: On */ |
785b93ef | 340 | case FB_BLANK_UNBLANK: |
3a8148c5 | 341 | drm_fb_helper_dpms(info, DRM_MODE_DPMS_ON); |
785b93ef | 342 | break; |
731b5a15 | 343 | /* Display: Off; HSync: On, VSync: On */ |
785b93ef | 344 | case FB_BLANK_NORMAL: |
3a8148c5 | 345 | drm_fb_helper_dpms(info, DRM_MODE_DPMS_STANDBY); |
785b93ef | 346 | break; |
731b5a15 | 347 | /* Display: Off; HSync: Off, VSync: On */ |
785b93ef | 348 | case FB_BLANK_HSYNC_SUSPEND: |
3a8148c5 | 349 | drm_fb_helper_dpms(info, DRM_MODE_DPMS_STANDBY); |
785b93ef | 350 | break; |
731b5a15 | 351 | /* Display: Off; HSync: On, VSync: Off */ |
785b93ef | 352 | case FB_BLANK_VSYNC_SUSPEND: |
3a8148c5 | 353 | drm_fb_helper_dpms(info, DRM_MODE_DPMS_SUSPEND); |
785b93ef | 354 | break; |
731b5a15 | 355 | /* Display: Off; HSync: Off, VSync: Off */ |
785b93ef | 356 | case FB_BLANK_POWERDOWN: |
3a8148c5 | 357 | drm_fb_helper_dpms(info, DRM_MODE_DPMS_OFF); |
785b93ef DA |
358 | break; |
359 | } | |
360 | return 0; | |
361 | } | |
362 | EXPORT_SYMBOL(drm_fb_helper_blank); | |
363 | ||
cfe63423 NT |
364 | static void drm_fb_helper_resume_worker(struct work_struct *work) |
365 | { | |
366 | struct drm_fb_helper *helper = container_of(work, struct drm_fb_helper, | |
367 | resume_work); | |
368 | ||
369 | console_lock(); | |
370 | fb_set_suspend(helper->fbdev, 0); | |
371 | console_unlock(); | |
372 | } | |
373 | ||
9622349e TZ |
374 | static void drm_fb_helper_damage_blit_real(struct drm_fb_helper *fb_helper, |
375 | struct drm_clip_rect *clip, | |
376 | struct dma_buf_map *dst) | |
d536540f NT |
377 | { |
378 | struct drm_framebuffer *fb = fb_helper->fb; | |
b0f986b4 | 379 | unsigned int cpp = fb->format->cpp[0]; |
d536540f NT |
380 | size_t offset = clip->y1 * fb->pitches[0] + clip->x1 * cpp; |
381 | void *src = fb_helper->fbdev->screen_buffer + offset; | |
d536540f NT |
382 | size_t len = (clip->x2 - clip->x1) * cpp; |
383 | unsigned int y; | |
384 | ||
222ec45f | 385 | dma_buf_map_incr(dst, offset); /* go to first pixel within clip rect */ |
2a1658bf | 386 | |
222ec45f TZ |
387 | for (y = clip->y1; y < clip->y2; y++) { |
388 | dma_buf_map_memcpy_to(dst, src, len); | |
389 | dma_buf_map_incr(dst, fb->pitches[0]); | |
d536540f | 390 | src += fb->pitches[0]; |
d536540f NT |
391 | } |
392 | } | |
393 | ||
1d46491d TZ |
394 | static int drm_fb_helper_damage_blit(struct drm_fb_helper *fb_helper, |
395 | struct drm_clip_rect *clip) | |
396 | { | |
397 | struct drm_client_buffer *buffer = fb_helper->buffer; | |
7d4d269c | 398 | struct dma_buf_map map, dst; |
1d46491d TZ |
399 | int ret; |
400 | ||
32228ff5 TZ |
401 | /* |
402 | * We have to pin the client buffer to its current location while | |
403 | * flushing the shadow buffer. In the general case, concurrent | |
404 | * modesetting operations could try to move the buffer and would | |
405 | * fail. The modeset has to be serialized by acquiring the reservation | |
406 | * object of the underlying BO here. | |
407 | * | |
408 | * For fbdev emulation, we only have to protect against fbdev modeset | |
409 | * operations. Nothing else will involve the client buffer's BO. So it | |
410 | * is sufficient to acquire struct drm_fb_helper.lock here. | |
411 | */ | |
412 | mutex_lock(&fb_helper->lock); | |
413 | ||
1d46491d TZ |
414 | ret = drm_client_buffer_vmap(buffer, &map); |
415 | if (ret) | |
32228ff5 | 416 | goto out; |
1d46491d | 417 | |
7d4d269c TZ |
418 | dst = map; |
419 | drm_fb_helper_damage_blit_real(fb_helper, clip, &dst); | |
1d46491d TZ |
420 | |
421 | drm_client_buffer_vunmap(buffer); | |
422 | ||
32228ff5 TZ |
423 | out: |
424 | mutex_unlock(&fb_helper->lock); | |
425 | ||
426 | return ret; | |
1d46491d TZ |
427 | } |
428 | ||
9622349e | 429 | static void drm_fb_helper_damage_work(struct work_struct *work) |
eaa434de NT |
430 | { |
431 | struct drm_fb_helper *helper = container_of(work, struct drm_fb_helper, | |
9622349e | 432 | damage_work); |
1d46491d | 433 | struct drm_device *dev = helper->dev; |
9622349e | 434 | struct drm_clip_rect *clip = &helper->damage_clip; |
eaa434de NT |
435 | struct drm_clip_rect clip_copy; |
436 | unsigned long flags; | |
a8595556 | 437 | int ret; |
eaa434de | 438 | |
9622349e | 439 | spin_lock_irqsave(&helper->damage_lock, flags); |
eaa434de NT |
440 | clip_copy = *clip; |
441 | clip->x1 = clip->y1 = ~0; | |
442 | clip->x2 = clip->y2 = 0; | |
9622349e | 443 | spin_unlock_irqrestore(&helper->damage_lock, flags); |
eaa434de | 444 | |
2b5f31aa TZ |
445 | /* Call damage handlers only if necessary */ |
446 | if (!(clip_copy.x1 < clip_copy.x2 && clip_copy.y1 < clip_copy.y2)) | |
447 | return; | |
cf1ca9ae | 448 | |
2b5f31aa | 449 | if (helper->buffer) { |
1d46491d TZ |
450 | ret = drm_fb_helper_damage_blit(helper, &clip_copy); |
451 | if (drm_WARN_ONCE(dev, ret, "Damage blitter failed: ret=%d\n", ret)) | |
4270d6f6 | 452 | goto err; |
d536540f | 453 | } |
2b5f31aa | 454 | |
4270d6f6 TZ |
455 | if (helper->fb->funcs->dirty) { |
456 | ret = helper->fb->funcs->dirty(helper->fb, NULL, 0, 0, &clip_copy, 1); | |
457 | if (drm_WARN_ONCE(dev, ret, "Dirty helper failed: ret=%d\n", ret)) | |
458 | goto err; | |
459 | } | |
460 | ||
461 | return; | |
462 | ||
463 | err: | |
464 | /* | |
465 | * Restore damage clip rectangle on errors. The next run | |
466 | * of the damage worker will perform the update. | |
467 | */ | |
468 | spin_lock_irqsave(&helper->damage_lock, flags); | |
469 | clip->x1 = min_t(u32, clip->x1, clip_copy.x1); | |
470 | clip->y1 = min_t(u32, clip->y1, clip_copy.y1); | |
471 | clip->x2 = max_t(u32, clip->x2, clip_copy.x2); | |
472 | clip->y2 = max_t(u32, clip->y2, clip_copy.y2); | |
473 | spin_unlock_irqrestore(&helper->damage_lock, flags); | |
eaa434de NT |
474 | } |
475 | ||
10a23102 TR |
476 | /** |
477 | * drm_fb_helper_prepare - setup a drm_fb_helper structure | |
478 | * @dev: DRM device | |
479 | * @helper: driver-allocated fbdev helper structure to set up | |
480 | * @funcs: pointer to structure of functions associate with this helper | |
481 | * | |
482 | * Sets up the bare minimum to make the framebuffer helper usable. This is | |
483 | * useful to implement race-free initialization of the polling helpers. | |
484 | */ | |
485 | void drm_fb_helper_prepare(struct drm_device *dev, struct drm_fb_helper *helper, | |
486 | const struct drm_fb_helper_funcs *funcs) | |
487 | { | |
488 | INIT_LIST_HEAD(&helper->kernel_fb_list); | |
9622349e | 489 | spin_lock_init(&helper->damage_lock); |
cfe63423 | 490 | INIT_WORK(&helper->resume_work, drm_fb_helper_resume_worker); |
9622349e TZ |
491 | INIT_WORK(&helper->damage_work, drm_fb_helper_damage_work); |
492 | helper->damage_clip.x1 = helper->damage_clip.y1 = ~0; | |
e9827d8e | 493 | mutex_init(&helper->lock); |
10a23102 TR |
494 | helper->funcs = funcs; |
495 | helper->dev = dev; | |
496 | } | |
497 | EXPORT_SYMBOL(drm_fb_helper_prepare); | |
498 | ||
207fd329 | 499 | /** |
ed84e254 | 500 | * drm_fb_helper_init - initialize a &struct drm_fb_helper |
207fd329 DV |
501 | * @dev: drm device |
502 | * @fb_helper: driver-allocated fbdev helper structure to initialize | |
207fd329 DV |
503 | * |
504 | * This allocates the structures for the fbdev helper with the given limits. | |
505 | * Note that this won't yet touch the hardware (through the driver interfaces) | |
506 | * nor register the fbdev. This is only done in drm_fb_helper_initial_config() | |
507 | * to allow driver writes more control over the exact init sequence. | |
508 | * | |
10a23102 | 509 | * Drivers must call drm_fb_helper_prepare() before calling this function. |
207fd329 DV |
510 | * |
511 | * RETURNS: | |
512 | * Zero if everything went ok, nonzero otherwise. | |
513 | */ | |
4abe3520 | 514 | int drm_fb_helper_init(struct drm_device *dev, |
2dea2d11 | 515 | struct drm_fb_helper *fb_helper) |
785b93ef | 516 | { |
d81294af | 517 | int ret; |
785b93ef | 518 | |
29ad20b2 NT |
519 | if (!drm_fbdev_emulation) { |
520 | dev->fb_helper = fb_helper; | |
f64c5573 | 521 | return 0; |
29ad20b2 | 522 | } |
f64c5573 | 523 | |
d81294af NT |
524 | /* |
525 | * If this is not the generic fbdev client, initialize a drm_client | |
526 | * without callbacks so we can use the modesets. | |
527 | */ | |
528 | if (!fb_helper->client.funcs) { | |
529 | ret = drm_client_init(dev, &fb_helper->client, "drm_fb_helper", NULL); | |
530 | if (ret) | |
531 | return ret; | |
532 | } | |
785b93ef | 533 | |
29ad20b2 NT |
534 | dev->fb_helper = fb_helper; |
535 | ||
785b93ef | 536 | return 0; |
785b93ef | 537 | } |
4abe3520 DA |
538 | EXPORT_SYMBOL(drm_fb_helper_init); |
539 | ||
b8017d6c AT |
540 | /** |
541 | * drm_fb_helper_alloc_fbi - allocate fb_info and some of its members | |
542 | * @fb_helper: driver-allocated fbdev helper | |
543 | * | |
544 | * A helper to alloc fb_info and the members cmap and apertures. Called | |
da7bdda2 DV |
545 | * by the driver within the fb_probe fb_helper callback function. Drivers do not |
546 | * need to release the allocated fb_info structure themselves, this is | |
547 | * automatically done when calling drm_fb_helper_fini(). | |
b8017d6c AT |
548 | * |
549 | * RETURNS: | |
550 | * fb_info pointer if things went okay, pointer containing error code | |
551 | * otherwise | |
552 | */ | |
553 | struct fb_info *drm_fb_helper_alloc_fbi(struct drm_fb_helper *fb_helper) | |
554 | { | |
555 | struct device *dev = fb_helper->dev->dev; | |
556 | struct fb_info *info; | |
557 | int ret; | |
558 | ||
559 | info = framebuffer_alloc(0, dev); | |
560 | if (!info) | |
561 | return ERR_PTR(-ENOMEM); | |
562 | ||
563 | ret = fb_alloc_cmap(&info->cmap, 256, 0); | |
564 | if (ret) | |
565 | goto err_release; | |
566 | ||
1a8bf67d | 567 | /* |
0ae865ef | 568 | * TODO: We really should be smarter here and alloc an aperture |
1a8bf67d HG |
569 | * for each IORESOURCE_MEM resource helper->dev->dev has and also |
570 | * init the ranges of the appertures based on the resources. | |
571 | * Note some drivers currently count on there being only 1 empty | |
572 | * aperture and fill this themselves, these will need to be dealt | |
573 | * with somehow when fixing this. | |
574 | */ | |
b8017d6c AT |
575 | info->apertures = alloc_apertures(1); |
576 | if (!info->apertures) { | |
577 | ret = -ENOMEM; | |
578 | goto err_free_cmap; | |
579 | } | |
580 | ||
581 | fb_helper->fbdev = info; | |
8782c647 | 582 | info->skip_vt_switch = true; |
b8017d6c AT |
583 | |
584 | return info; | |
585 | ||
586 | err_free_cmap: | |
587 | fb_dealloc_cmap(&info->cmap); | |
588 | err_release: | |
589 | framebuffer_release(info); | |
590 | return ERR_PTR(ret); | |
591 | } | |
592 | EXPORT_SYMBOL(drm_fb_helper_alloc_fbi); | |
593 | ||
594 | /** | |
595 | * drm_fb_helper_unregister_fbi - unregister fb_info framebuffer device | |
c777990f | 596 | * @fb_helper: driver-allocated fbdev helper, can be NULL |
b8017d6c AT |
597 | * |
598 | * A wrapper around unregister_framebuffer, to release the fb_info | |
ed84e254 DV |
599 | * framebuffer device. This must be called before releasing all resources for |
600 | * @fb_helper by calling drm_fb_helper_fini(). | |
b8017d6c AT |
601 | */ |
602 | void drm_fb_helper_unregister_fbi(struct drm_fb_helper *fb_helper) | |
603 | { | |
604 | if (fb_helper && fb_helper->fbdev) | |
605 | unregister_framebuffer(fb_helper->fbdev); | |
606 | } | |
607 | EXPORT_SYMBOL(drm_fb_helper_unregister_fbi); | |
608 | ||
ed84e254 DV |
609 | /** |
610 | * drm_fb_helper_fini - finialize a &struct drm_fb_helper | |
c777990f | 611 | * @fb_helper: driver-allocated fbdev helper, can be NULL |
ed84e254 | 612 | * |
6821603a | 613 | * This cleans up all remaining resources associated with @fb_helper. |
ed84e254 | 614 | */ |
4abe3520 DA |
615 | void drm_fb_helper_fini(struct drm_fb_helper *fb_helper) |
616 | { | |
da7bdda2 DV |
617 | struct fb_info *info; |
618 | ||
29ad20b2 NT |
619 | if (!fb_helper) |
620 | return; | |
621 | ||
622 | fb_helper->dev->fb_helper = NULL; | |
623 | ||
624 | if (!drm_fbdev_emulation) | |
f64c5573 DV |
625 | return; |
626 | ||
b52f09c4 | 627 | cancel_work_sync(&fb_helper->resume_work); |
9622349e | 628 | cancel_work_sync(&fb_helper->damage_work); |
b52f09c4 | 629 | |
da7bdda2 DV |
630 | info = fb_helper->fbdev; |
631 | if (info) { | |
632 | if (info->cmap.len) | |
633 | fb_dealloc_cmap(&info->cmap); | |
634 | framebuffer_release(info); | |
635 | } | |
636 | fb_helper->fbdev = NULL; | |
637 | ||
a53ca635 | 638 | mutex_lock(&kernel_fb_helper_lock); |
4abe3520 DA |
639 | if (!list_empty(&fb_helper->kernel_fb_list)) { |
640 | list_del(&fb_helper->kernel_fb_list); | |
4b4f99f5 | 641 | if (list_empty(&kernel_fb_helper_list)) |
4abe3520 | 642 | unregister_sysrq_key('v', &sysrq_drm_fb_helper_restore_op); |
4abe3520 | 643 | } |
a53ca635 | 644 | mutex_unlock(&kernel_fb_helper_lock); |
4abe3520 | 645 | |
e9827d8e | 646 | mutex_destroy(&fb_helper->lock); |
4abe3520 | 647 | |
d81294af NT |
648 | if (!fb_helper->client.funcs) |
649 | drm_client_release(&fb_helper->client); | |
4abe3520 DA |
650 | } |
651 | EXPORT_SYMBOL(drm_fb_helper_fini); | |
785b93ef | 652 | |
f458579e TZ |
653 | static bool drm_fbdev_use_shadow_fb(struct drm_fb_helper *fb_helper) |
654 | { | |
655 | struct drm_device *dev = fb_helper->dev; | |
656 | struct drm_framebuffer *fb = fb_helper->fb; | |
657 | ||
658 | return dev->mode_config.prefer_shadow_fbdev || | |
659 | dev->mode_config.prefer_shadow || | |
660 | fb->funcs->dirty; | |
661 | } | |
662 | ||
9622349e TZ |
663 | static void drm_fb_helper_damage(struct fb_info *info, u32 x, u32 y, |
664 | u32 width, u32 height) | |
eaa434de NT |
665 | { |
666 | struct drm_fb_helper *helper = info->par; | |
9622349e | 667 | struct drm_clip_rect *clip = &helper->damage_clip; |
eaa434de NT |
668 | unsigned long flags; |
669 | ||
f458579e | 670 | if (!drm_fbdev_use_shadow_fb(helper)) |
eaa434de NT |
671 | return; |
672 | ||
9622349e | 673 | spin_lock_irqsave(&helper->damage_lock, flags); |
eaa434de NT |
674 | clip->x1 = min_t(u32, clip->x1, x); |
675 | clip->y1 = min_t(u32, clip->y1, y); | |
676 | clip->x2 = max_t(u32, clip->x2, x + width); | |
677 | clip->y2 = max_t(u32, clip->y2, y + height); | |
9622349e | 678 | spin_unlock_irqrestore(&helper->damage_lock, flags); |
eaa434de | 679 | |
9622349e | 680 | schedule_work(&helper->damage_work); |
eaa434de NT |
681 | } |
682 | ||
683 | /** | |
684 | * drm_fb_helper_deferred_io() - fbdev deferred_io callback function | |
685 | * @info: fb_info struct pointer | |
9622349e | 686 | * @pagelist: list of mmap framebuffer pages that have to be flushed |
eaa434de | 687 | * |
6806cdf9 | 688 | * This function is used as the &fb_deferred_io.deferred_io |
eaa434de NT |
689 | * callback function for flushing the fbdev mmap writes. |
690 | */ | |
691 | void drm_fb_helper_deferred_io(struct fb_info *info, | |
692 | struct list_head *pagelist) | |
693 | { | |
694 | unsigned long start, end, min, max; | |
695 | struct page *page; | |
696 | u32 y1, y2; | |
697 | ||
698 | min = ULONG_MAX; | |
699 | max = 0; | |
700 | list_for_each_entry(page, pagelist, lru) { | |
701 | start = page->index << PAGE_SHIFT; | |
702 | end = start + PAGE_SIZE - 1; | |
703 | min = min(min, start); | |
704 | max = max(max, end); | |
705 | } | |
706 | ||
707 | if (min < max) { | |
708 | y1 = min / info->fix.line_length; | |
709 | y2 = min_t(u32, DIV_ROUND_UP(max, info->fix.line_length), | |
710 | info->var.yres); | |
9622349e | 711 | drm_fb_helper_damage(info, 0, y1, info->var.xres, y2 - y1); |
eaa434de NT |
712 | } |
713 | } | |
714 | EXPORT_SYMBOL(drm_fb_helper_deferred_io); | |
715 | ||
cbb1a82e AT |
716 | /** |
717 | * drm_fb_helper_sys_read - wrapper around fb_sys_read | |
718 | * @info: fb_info struct pointer | |
719 | * @buf: userspace buffer to read from framebuffer memory | |
720 | * @count: number of bytes to read from framebuffer memory | |
721 | * @ppos: read offset within framebuffer memory | |
722 | * | |
723 | * A wrapper around fb_sys_read implemented by fbdev core | |
724 | */ | |
725 | ssize_t drm_fb_helper_sys_read(struct fb_info *info, char __user *buf, | |
726 | size_t count, loff_t *ppos) | |
727 | { | |
728 | return fb_sys_read(info, buf, count, ppos); | |
729 | } | |
730 | EXPORT_SYMBOL(drm_fb_helper_sys_read); | |
731 | ||
732 | /** | |
733 | * drm_fb_helper_sys_write - wrapper around fb_sys_write | |
734 | * @info: fb_info struct pointer | |
735 | * @buf: userspace buffer to write to framebuffer memory | |
736 | * @count: number of bytes to write to framebuffer memory | |
737 | * @ppos: write offset within framebuffer memory | |
738 | * | |
739 | * A wrapper around fb_sys_write implemented by fbdev core | |
740 | */ | |
741 | ssize_t drm_fb_helper_sys_write(struct fb_info *info, const char __user *buf, | |
742 | size_t count, loff_t *ppos) | |
743 | { | |
eaa434de NT |
744 | ssize_t ret; |
745 | ||
746 | ret = fb_sys_write(info, buf, count, ppos); | |
747 | if (ret > 0) | |
9622349e | 748 | drm_fb_helper_damage(info, 0, 0, info->var.xres, info->var.yres); |
eaa434de NT |
749 | |
750 | return ret; | |
cbb1a82e AT |
751 | } |
752 | EXPORT_SYMBOL(drm_fb_helper_sys_write); | |
753 | ||
742547b7 AT |
754 | /** |
755 | * drm_fb_helper_sys_fillrect - wrapper around sys_fillrect | |
756 | * @info: fbdev registered by the helper | |
757 | * @rect: info about rectangle to fill | |
758 | * | |
759 | * A wrapper around sys_fillrect implemented by fbdev core | |
760 | */ | |
761 | void drm_fb_helper_sys_fillrect(struct fb_info *info, | |
762 | const struct fb_fillrect *rect) | |
763 | { | |
764 | sys_fillrect(info, rect); | |
9622349e | 765 | drm_fb_helper_damage(info, rect->dx, rect->dy, rect->width, rect->height); |
742547b7 AT |
766 | } |
767 | EXPORT_SYMBOL(drm_fb_helper_sys_fillrect); | |
768 | ||
769 | /** | |
770 | * drm_fb_helper_sys_copyarea - wrapper around sys_copyarea | |
771 | * @info: fbdev registered by the helper | |
772 | * @area: info about area to copy | |
773 | * | |
774 | * A wrapper around sys_copyarea implemented by fbdev core | |
775 | */ | |
776 | void drm_fb_helper_sys_copyarea(struct fb_info *info, | |
777 | const struct fb_copyarea *area) | |
778 | { | |
779 | sys_copyarea(info, area); | |
9622349e | 780 | drm_fb_helper_damage(info, area->dx, area->dy, area->width, area->height); |
742547b7 AT |
781 | } |
782 | EXPORT_SYMBOL(drm_fb_helper_sys_copyarea); | |
783 | ||
784 | /** | |
785 | * drm_fb_helper_sys_imageblit - wrapper around sys_imageblit | |
786 | * @info: fbdev registered by the helper | |
787 | * @image: info about image to blit | |
788 | * | |
789 | * A wrapper around sys_imageblit implemented by fbdev core | |
790 | */ | |
791 | void drm_fb_helper_sys_imageblit(struct fb_info *info, | |
792 | const struct fb_image *image) | |
793 | { | |
794 | sys_imageblit(info, image); | |
9622349e | 795 | drm_fb_helper_damage(info, image->dx, image->dy, image->width, image->height); |
742547b7 AT |
796 | } |
797 | EXPORT_SYMBOL(drm_fb_helper_sys_imageblit); | |
798 | ||
799 | /** | |
800 | * drm_fb_helper_cfb_fillrect - wrapper around cfb_fillrect | |
801 | * @info: fbdev registered by the helper | |
802 | * @rect: info about rectangle to fill | |
803 | * | |
d104328c | 804 | * A wrapper around cfb_fillrect implemented by fbdev core |
742547b7 AT |
805 | */ |
806 | void drm_fb_helper_cfb_fillrect(struct fb_info *info, | |
807 | const struct fb_fillrect *rect) | |
808 | { | |
809 | cfb_fillrect(info, rect); | |
9622349e | 810 | drm_fb_helper_damage(info, rect->dx, rect->dy, rect->width, rect->height); |
742547b7 AT |
811 | } |
812 | EXPORT_SYMBOL(drm_fb_helper_cfb_fillrect); | |
813 | ||
814 | /** | |
815 | * drm_fb_helper_cfb_copyarea - wrapper around cfb_copyarea | |
816 | * @info: fbdev registered by the helper | |
817 | * @area: info about area to copy | |
818 | * | |
819 | * A wrapper around cfb_copyarea implemented by fbdev core | |
820 | */ | |
821 | void drm_fb_helper_cfb_copyarea(struct fb_info *info, | |
822 | const struct fb_copyarea *area) | |
823 | { | |
824 | cfb_copyarea(info, area); | |
9622349e | 825 | drm_fb_helper_damage(info, area->dx, area->dy, area->width, area->height); |
742547b7 AT |
826 | } |
827 | EXPORT_SYMBOL(drm_fb_helper_cfb_copyarea); | |
828 | ||
829 | /** | |
830 | * drm_fb_helper_cfb_imageblit - wrapper around cfb_imageblit | |
831 | * @info: fbdev registered by the helper | |
832 | * @image: info about image to blit | |
833 | * | |
834 | * A wrapper around cfb_imageblit implemented by fbdev core | |
835 | */ | |
836 | void drm_fb_helper_cfb_imageblit(struct fb_info *info, | |
837 | const struct fb_image *image) | |
838 | { | |
839 | cfb_imageblit(info, image); | |
9622349e | 840 | drm_fb_helper_damage(info, image->dx, image->dy, image->width, image->height); |
742547b7 AT |
841 | } |
842 | EXPORT_SYMBOL(drm_fb_helper_cfb_imageblit); | |
843 | ||
fdefa58a AT |
844 | /** |
845 | * drm_fb_helper_set_suspend - wrapper around fb_set_suspend | |
c777990f | 846 | * @fb_helper: driver-allocated fbdev helper, can be NULL |
28579f37 | 847 | * @suspend: whether to suspend or resume |
fdefa58a | 848 | * |
cfe63423 NT |
849 | * A wrapper around fb_set_suspend implemented by fbdev core. |
850 | * Use drm_fb_helper_set_suspend_unlocked() if you don't need to take | |
851 | * the lock yourself | |
fdefa58a | 852 | */ |
28579f37 | 853 | void drm_fb_helper_set_suspend(struct drm_fb_helper *fb_helper, bool suspend) |
fdefa58a AT |
854 | { |
855 | if (fb_helper && fb_helper->fbdev) | |
28579f37 | 856 | fb_set_suspend(fb_helper->fbdev, suspend); |
fdefa58a AT |
857 | } |
858 | EXPORT_SYMBOL(drm_fb_helper_set_suspend); | |
859 | ||
cfe63423 NT |
860 | /** |
861 | * drm_fb_helper_set_suspend_unlocked - wrapper around fb_set_suspend that also | |
862 | * takes the console lock | |
c777990f | 863 | * @fb_helper: driver-allocated fbdev helper, can be NULL |
28579f37 | 864 | * @suspend: whether to suspend or resume |
cfe63423 NT |
865 | * |
866 | * A wrapper around fb_set_suspend() that takes the console lock. If the lock | |
867 | * isn't available on resume, a worker is tasked with waiting for the lock | |
868 | * to become available. The console lock can be pretty contented on resume | |
869 | * due to all the printk activity. | |
870 | * | |
871 | * This function can be called multiple times with the same state since | |
6806cdf9 | 872 | * &fb_info.state is checked to see if fbdev is running or not before locking. |
cfe63423 NT |
873 | * |
874 | * Use drm_fb_helper_set_suspend() if you need to take the lock yourself. | |
875 | */ | |
876 | void drm_fb_helper_set_suspend_unlocked(struct drm_fb_helper *fb_helper, | |
28579f37 | 877 | bool suspend) |
cfe63423 NT |
878 | { |
879 | if (!fb_helper || !fb_helper->fbdev) | |
880 | return; | |
881 | ||
882 | /* make sure there's no pending/ongoing resume */ | |
883 | flush_work(&fb_helper->resume_work); | |
884 | ||
885 | if (suspend) { | |
886 | if (fb_helper->fbdev->state != FBINFO_STATE_RUNNING) | |
887 | return; | |
888 | ||
889 | console_lock(); | |
890 | ||
891 | } else { | |
892 | if (fb_helper->fbdev->state == FBINFO_STATE_RUNNING) | |
893 | return; | |
894 | ||
895 | if (!console_trylock()) { | |
896 | schedule_work(&fb_helper->resume_work); | |
897 | return; | |
898 | } | |
899 | } | |
900 | ||
901 | fb_set_suspend(fb_helper->fbdev, suspend); | |
902 | console_unlock(); | |
903 | } | |
904 | EXPORT_SYMBOL(drm_fb_helper_set_suspend_unlocked); | |
905 | ||
b8e2b019 PR |
906 | static int setcmap_pseudo_palette(struct fb_cmap *cmap, struct fb_info *info) |
907 | { | |
908 | u32 *palette = (u32 *)info->pseudo_palette; | |
909 | int i; | |
910 | ||
911 | if (cmap->start + cmap->len > 16) | |
912 | return -EINVAL; | |
913 | ||
914 | for (i = 0; i < cmap->len; ++i) { | |
915 | u16 red = cmap->red[i]; | |
916 | u16 green = cmap->green[i]; | |
917 | u16 blue = cmap->blue[i]; | |
918 | u32 value; | |
919 | ||
920 | red >>= 16 - info->var.red.length; | |
921 | green >>= 16 - info->var.green.length; | |
922 | blue >>= 16 - info->var.blue.length; | |
923 | value = (red << info->var.red.offset) | | |
924 | (green << info->var.green.offset) | | |
925 | (blue << info->var.blue.offset); | |
926 | if (info->var.transp.length > 0) { | |
927 | u32 mask = (1 << info->var.transp.length) - 1; | |
928 | ||
929 | mask <<= info->var.transp.offset; | |
930 | value |= mask; | |
931 | } | |
932 | palette[cmap->start + i] = value; | |
933 | } | |
934 | ||
935 | return 0; | |
936 | } | |
937 | ||
964c6006 | 938 | static int setcmap_legacy(struct fb_cmap *cmap, struct fb_info *info) |
068143d3 DA |
939 | { |
940 | struct drm_fb_helper *fb_helper = info->par; | |
d81294af | 941 | struct drm_mode_set *modeset; |
068143d3 | 942 | struct drm_crtc *crtc; |
a3562a0e | 943 | u16 *r, *g, *b; |
d81294af | 944 | int ret = 0; |
068143d3 | 945 | |
964c6006 | 946 | drm_modeset_lock_all(fb_helper->dev); |
d81294af NT |
947 | drm_client_for_each_modeset(modeset, &fb_helper->client) { |
948 | crtc = modeset->crtc; | |
0a260e73 CY |
949 | if (!crtc->funcs->gamma_set || !crtc->gamma_size) { |
950 | ret = -EINVAL; | |
951 | goto out; | |
952 | } | |
c50bfd08 | 953 | |
0a260e73 CY |
954 | if (cmap->start + cmap->len > crtc->gamma_size) { |
955 | ret = -EINVAL; | |
956 | goto out; | |
957 | } | |
964c6006 PR |
958 | |
959 | r = crtc->gamma_store; | |
960 | g = r + crtc->gamma_size; | |
961 | b = g + crtc->gamma_size; | |
962 | ||
963 | memcpy(r + cmap->start, cmap->red, cmap->len * sizeof(*r)); | |
964 | memcpy(g + cmap->start, cmap->green, cmap->len * sizeof(*g)); | |
965 | memcpy(b + cmap->start, cmap->blue, cmap->len * sizeof(*b)); | |
966 | ||
967 | ret = crtc->funcs->gamma_set(crtc, r, g, b, | |
968 | crtc->gamma_size, NULL); | |
969 | if (ret) | |
0a260e73 | 970 | goto out; |
8391a3d5 | 971 | } |
0a260e73 | 972 | out: |
964c6006 | 973 | drm_modeset_unlock_all(fb_helper->dev); |
8391a3d5 | 974 | |
964c6006 PR |
975 | return ret; |
976 | } | |
977 | ||
978 | static struct drm_property_blob *setcmap_new_gamma_lut(struct drm_crtc *crtc, | |
979 | struct fb_cmap *cmap) | |
980 | { | |
981 | struct drm_device *dev = crtc->dev; | |
982 | struct drm_property_blob *gamma_lut; | |
983 | struct drm_color_lut *lut; | |
984 | int size = crtc->gamma_size; | |
985 | int i; | |
986 | ||
987 | if (!size || cmap->start + cmap->len > size) | |
988 | return ERR_PTR(-EINVAL); | |
989 | ||
990 | gamma_lut = drm_property_create_blob(dev, sizeof(*lut) * size, NULL); | |
991 | if (IS_ERR(gamma_lut)) | |
992 | return gamma_lut; | |
993 | ||
11b83e3f | 994 | lut = gamma_lut->data; |
964c6006 PR |
995 | if (cmap->start || cmap->len != size) { |
996 | u16 *r = crtc->gamma_store; | |
997 | u16 *g = r + crtc->gamma_size; | |
998 | u16 *b = g + crtc->gamma_size; | |
999 | ||
1000 | for (i = 0; i < cmap->start; i++) { | |
1001 | lut[i].red = r[i]; | |
1002 | lut[i].green = g[i]; | |
1003 | lut[i].blue = b[i]; | |
1004 | } | |
1005 | for (i = cmap->start + cmap->len; i < size; i++) { | |
1006 | lut[i].red = r[i]; | |
1007 | lut[i].green = g[i]; | |
1008 | lut[i].blue = b[i]; | |
1009 | } | |
1010 | } | |
1011 | ||
1012 | for (i = 0; i < cmap->len; i++) { | |
1013 | lut[cmap->start + i].red = cmap->red[i]; | |
1014 | lut[cmap->start + i].green = cmap->green[i]; | |
1015 | lut[cmap->start + i].blue = cmap->blue[i]; | |
1016 | } | |
1017 | ||
1018 | return gamma_lut; | |
1019 | } | |
1020 | ||
1021 | static int setcmap_atomic(struct fb_cmap *cmap, struct fb_info *info) | |
1022 | { | |
1023 | struct drm_fb_helper *fb_helper = info->par; | |
1024 | struct drm_device *dev = fb_helper->dev; | |
1025 | struct drm_property_blob *gamma_lut = NULL; | |
1026 | struct drm_modeset_acquire_ctx ctx; | |
1027 | struct drm_crtc_state *crtc_state; | |
1028 | struct drm_atomic_state *state; | |
d81294af | 1029 | struct drm_mode_set *modeset; |
964c6006 PR |
1030 | struct drm_crtc *crtc; |
1031 | u16 *r, *g, *b; | |
964c6006 | 1032 | bool replaced; |
d81294af | 1033 | int ret = 0; |
964c6006 PR |
1034 | |
1035 | drm_modeset_acquire_init(&ctx, 0); | |
1036 | ||
1037 | state = drm_atomic_state_alloc(dev); | |
1038 | if (!state) { | |
1039 | ret = -ENOMEM; | |
1040 | goto out_ctx; | |
b8e2b019 PR |
1041 | } |
1042 | ||
964c6006 PR |
1043 | state->acquire_ctx = &ctx; |
1044 | retry: | |
d81294af NT |
1045 | drm_client_for_each_modeset(modeset, &fb_helper->client) { |
1046 | crtc = modeset->crtc; | |
068143d3 | 1047 | |
964c6006 PR |
1048 | if (!gamma_lut) |
1049 | gamma_lut = setcmap_new_gamma_lut(crtc, cmap); | |
1050 | if (IS_ERR(gamma_lut)) { | |
1051 | ret = PTR_ERR(gamma_lut); | |
1052 | gamma_lut = NULL; | |
1053 | goto out_state; | |
a3562a0e PR |
1054 | } |
1055 | ||
964c6006 PR |
1056 | crtc_state = drm_atomic_get_crtc_state(state, crtc); |
1057 | if (IS_ERR(crtc_state)) { | |
1058 | ret = PTR_ERR(crtc_state); | |
1059 | goto out_state; | |
a3562a0e PR |
1060 | } |
1061 | ||
1b897743 TV |
1062 | /* |
1063 | * FIXME: This always uses gamma_lut. Some HW have only | |
1064 | * degamma_lut, in which case we should reset gamma_lut and set | |
1065 | * degamma_lut. See drm_crtc_legacy_gamma_set(). | |
1066 | */ | |
964c6006 PR |
1067 | replaced = drm_property_replace_blob(&crtc_state->degamma_lut, |
1068 | NULL); | |
1069 | replaced |= drm_property_replace_blob(&crtc_state->ctm, NULL); | |
1070 | replaced |= drm_property_replace_blob(&crtc_state->gamma_lut, | |
1071 | gamma_lut); | |
1072 | crtc_state->color_mgmt_changed |= replaced; | |
1073 | } | |
1074 | ||
1075 | ret = drm_atomic_commit(state); | |
1076 | if (ret) | |
1077 | goto out_state; | |
1078 | ||
d81294af NT |
1079 | drm_client_for_each_modeset(modeset, &fb_helper->client) { |
1080 | crtc = modeset->crtc; | |
964c6006 | 1081 | |
a3562a0e PR |
1082 | r = crtc->gamma_store; |
1083 | g = r + crtc->gamma_size; | |
1084 | b = g + crtc->gamma_size; | |
1085 | ||
1086 | memcpy(r + cmap->start, cmap->red, cmap->len * sizeof(*r)); | |
1087 | memcpy(g + cmap->start, cmap->green, cmap->len * sizeof(*g)); | |
1088 | memcpy(b + cmap->start, cmap->blue, cmap->len * sizeof(*b)); | |
964c6006 | 1089 | } |
a3562a0e | 1090 | |
964c6006 PR |
1091 | out_state: |
1092 | if (ret == -EDEADLK) | |
1093 | goto backoff; | |
068143d3 | 1094 | |
964c6006 PR |
1095 | drm_property_blob_put(gamma_lut); |
1096 | drm_atomic_state_put(state); | |
1097 | out_ctx: | |
1098 | drm_modeset_drop_locks(&ctx); | |
1099 | drm_modeset_acquire_fini(&ctx); | |
068143d3 | 1100 | |
964c6006 | 1101 | return ret; |
068143d3 | 1102 | |
964c6006 PR |
1103 | backoff: |
1104 | drm_atomic_state_clear(state); | |
1105 | drm_modeset_backoff(&ctx); | |
1106 | goto retry; | |
1107 | } | |
1108 | ||
1109 | /** | |
1110 | * drm_fb_helper_setcmap - implementation for &fb_ops.fb_setcmap | |
1111 | * @cmap: cmap to set | |
1112 | * @info: fbdev registered by the helper | |
1113 | */ | |
1114 | int drm_fb_helper_setcmap(struct fb_cmap *cmap, struct fb_info *info) | |
1115 | { | |
1116 | struct drm_fb_helper *fb_helper = info->par; | |
03a9606e | 1117 | struct drm_device *dev = fb_helper->dev; |
964c6006 PR |
1118 | int ret; |
1119 | ||
1120 | if (oops_in_progress) | |
1121 | return -EBUSY; | |
1122 | ||
1123 | mutex_lock(&fb_helper->lock); | |
1124 | ||
03a9606e | 1125 | if (!drm_master_internal_acquire(dev)) { |
964c6006 | 1126 | ret = -EBUSY; |
03a9606e | 1127 | goto unlock; |
068143d3 | 1128 | } |
964c6006 | 1129 | |
d81294af | 1130 | mutex_lock(&fb_helper->client.modeset_mutex); |
964c6006 PR |
1131 | if (info->fix.visual == FB_VISUAL_TRUECOLOR) |
1132 | ret = setcmap_pseudo_palette(cmap, info); | |
1133 | else if (drm_drv_uses_atomic_modeset(fb_helper->dev)) | |
1134 | ret = setcmap_atomic(cmap, info); | |
1135 | else | |
1136 | ret = setcmap_legacy(cmap, info); | |
d81294af | 1137 | mutex_unlock(&fb_helper->client.modeset_mutex); |
964c6006 | 1138 | |
03a9606e NT |
1139 | drm_master_internal_release(dev); |
1140 | unlock: | |
e9827d8e | 1141 | mutex_unlock(&fb_helper->lock); |
964c6006 PR |
1142 | |
1143 | return ret; | |
068143d3 DA |
1144 | } |
1145 | EXPORT_SYMBOL(drm_fb_helper_setcmap); | |
1146 | ||
0f3bbe07 MR |
1147 | /** |
1148 | * drm_fb_helper_ioctl - legacy ioctl implementation | |
1149 | * @info: fbdev registered by the helper | |
1150 | * @cmd: ioctl command | |
1151 | * @arg: ioctl argument | |
1152 | * | |
1153 | * A helper to implement the standard fbdev ioctl. Only | |
1154 | * FBIO_WAITFORVSYNC is implemented for now. | |
1155 | */ | |
1156 | int drm_fb_helper_ioctl(struct fb_info *info, unsigned int cmd, | |
1157 | unsigned long arg) | |
1158 | { | |
1159 | struct drm_fb_helper *fb_helper = info->par; | |
03a9606e | 1160 | struct drm_device *dev = fb_helper->dev; |
0f3bbe07 MR |
1161 | struct drm_crtc *crtc; |
1162 | int ret = 0; | |
1163 | ||
e9827d8e | 1164 | mutex_lock(&fb_helper->lock); |
03a9606e | 1165 | if (!drm_master_internal_acquire(dev)) { |
0f3bbe07 MR |
1166 | ret = -EBUSY; |
1167 | goto unlock; | |
1168 | } | |
1169 | ||
1170 | switch (cmd) { | |
1171 | case FBIO_WAITFORVSYNC: | |
1172 | /* | |
1173 | * Only consider the first CRTC. | |
1174 | * | |
1175 | * This ioctl is supposed to take the CRTC number as | |
1176 | * an argument, but in fbdev times, what that number | |
1177 | * was supposed to be was quite unclear, different | |
1178 | * drivers were passing that argument differently | |
1179 | * (some by reference, some by value), and most of the | |
1180 | * userspace applications were just hardcoding 0 as an | |
1181 | * argument. | |
1182 | * | |
1183 | * The first CRTC should be the integrated panel on | |
1184 | * most drivers, so this is the best choice we can | |
1185 | * make. If we're not smart enough here, one should | |
1186 | * just consider switch the userspace to KMS. | |
1187 | */ | |
d81294af | 1188 | crtc = fb_helper->client.modesets[0].crtc; |
0f3bbe07 MR |
1189 | |
1190 | /* | |
1191 | * Only wait for a vblank event if the CRTC is | |
1192 | * enabled, otherwise just don't do anythintg, | |
1193 | * not even report an error. | |
1194 | */ | |
1195 | ret = drm_crtc_vblank_get(crtc); | |
1196 | if (!ret) { | |
1197 | drm_crtc_wait_one_vblank(crtc); | |
1198 | drm_crtc_vblank_put(crtc); | |
1199 | } | |
1200 | ||
1201 | ret = 0; | |
03a9606e | 1202 | break; |
0f3bbe07 MR |
1203 | default: |
1204 | ret = -ENOTTY; | |
1205 | } | |
1206 | ||
03a9606e | 1207 | drm_master_internal_release(dev); |
0f3bbe07 | 1208 | unlock: |
e9827d8e | 1209 | mutex_unlock(&fb_helper->lock); |
0f3bbe07 MR |
1210 | return ret; |
1211 | } | |
1212 | EXPORT_SYMBOL(drm_fb_helper_ioctl); | |
1213 | ||
db05c481 EP |
1214 | static bool drm_fb_pixel_format_equal(const struct fb_var_screeninfo *var_1, |
1215 | const struct fb_var_screeninfo *var_2) | |
1216 | { | |
1217 | return var_1->bits_per_pixel == var_2->bits_per_pixel && | |
1218 | var_1->grayscale == var_2->grayscale && | |
1219 | var_1->red.offset == var_2->red.offset && | |
1220 | var_1->red.length == var_2->red.length && | |
1221 | var_1->red.msb_right == var_2->red.msb_right && | |
1222 | var_1->green.offset == var_2->green.offset && | |
1223 | var_1->green.length == var_2->green.length && | |
1224 | var_1->green.msb_right == var_2->green.msb_right && | |
1225 | var_1->blue.offset == var_2->blue.offset && | |
1226 | var_1->blue.length == var_2->blue.length && | |
1227 | var_1->blue.msb_right == var_2->blue.msb_right && | |
1228 | var_1->transp.offset == var_2->transp.offset && | |
1229 | var_1->transp.length == var_2->transp.length && | |
1230 | var_1->transp.msb_right == var_2->transp.msb_right; | |
1231 | } | |
1232 | ||
62d85b3b IM |
1233 | static void drm_fb_helper_fill_pixel_fmt(struct fb_var_screeninfo *var, |
1234 | u8 depth) | |
1235 | { | |
1236 | switch (depth) { | |
1237 | case 8: | |
1238 | var->red.offset = 0; | |
1239 | var->green.offset = 0; | |
1240 | var->blue.offset = 0; | |
1241 | var->red.length = 8; /* 8bit DAC */ | |
1242 | var->green.length = 8; | |
1243 | var->blue.length = 8; | |
1244 | var->transp.offset = 0; | |
1245 | var->transp.length = 0; | |
1246 | break; | |
1247 | case 15: | |
1248 | var->red.offset = 10; | |
1249 | var->green.offset = 5; | |
1250 | var->blue.offset = 0; | |
1251 | var->red.length = 5; | |
1252 | var->green.length = 5; | |
1253 | var->blue.length = 5; | |
1254 | var->transp.offset = 15; | |
1255 | var->transp.length = 1; | |
1256 | break; | |
1257 | case 16: | |
1258 | var->red.offset = 11; | |
1259 | var->green.offset = 5; | |
1260 | var->blue.offset = 0; | |
1261 | var->red.length = 5; | |
1262 | var->green.length = 6; | |
1263 | var->blue.length = 5; | |
1264 | var->transp.offset = 0; | |
1265 | break; | |
1266 | case 24: | |
1267 | var->red.offset = 16; | |
1268 | var->green.offset = 8; | |
1269 | var->blue.offset = 0; | |
1270 | var->red.length = 8; | |
1271 | var->green.length = 8; | |
1272 | var->blue.length = 8; | |
1273 | var->transp.offset = 0; | |
1274 | var->transp.length = 0; | |
1275 | break; | |
1276 | case 32: | |
1277 | var->red.offset = 16; | |
1278 | var->green.offset = 8; | |
1279 | var->blue.offset = 0; | |
1280 | var->red.length = 8; | |
1281 | var->green.length = 8; | |
1282 | var->blue.length = 8; | |
1283 | var->transp.offset = 24; | |
1284 | var->transp.length = 8; | |
1285 | break; | |
1286 | default: | |
1287 | break; | |
1288 | } | |
1289 | } | |
1290 | ||
207fd329 | 1291 | /** |
6806cdf9 | 1292 | * drm_fb_helper_check_var - implementation for &fb_ops.fb_check_var |
207fd329 DV |
1293 | * @var: screeninfo to check |
1294 | * @info: fbdev registered by the helper | |
1295 | */ | |
785b93ef DA |
1296 | int drm_fb_helper_check_var(struct fb_var_screeninfo *var, |
1297 | struct fb_info *info) | |
1298 | { | |
1299 | struct drm_fb_helper *fb_helper = info->par; | |
1300 | struct drm_framebuffer *fb = fb_helper->fb; | |
f33b9730 | 1301 | struct drm_device *dev = fb_helper->dev; |
785b93ef | 1302 | |
66a8d5bf | 1303 | if (in_dbg_master()) |
785b93ef DA |
1304 | return -EINVAL; |
1305 | ||
66a8d5bf | 1306 | if (var->pixclock != 0) { |
f33b9730 | 1307 | drm_dbg_kms(dev, "fbdev emulation doesn't support changing the pixel clock, value of pixclock is ignored\n"); |
66a8d5bf IM |
1308 | var->pixclock = 0; |
1309 | } | |
1310 | ||
042bf753 AG |
1311 | if ((drm_format_info_block_width(fb->format, 0) > 1) || |
1312 | (drm_format_info_block_height(fb->format, 0) > 1)) | |
1313 | return -EINVAL; | |
1314 | ||
865afb11 SA |
1315 | /* |
1316 | * Changes struct fb_var_screeninfo are currently not pushed back | |
1317 | * to KMS, hence fail if different settings are requested. | |
1318 | */ | |
f30e2777 | 1319 | if (var->bits_per_pixel > fb->format->cpp[0] * 8 || |
12ffed96 MD |
1320 | var->xres > fb->width || var->yres > fb->height || |
1321 | var->xres_virtual > fb->width || var->yres_virtual > fb->height) { | |
f33b9730 | 1322 | drm_dbg_kms(dev, "fb requested width/height/bpp can't fit in current fb " |
62fb376e CW |
1323 | "request %dx%d-%d (virtual %dx%d) > %dx%d-%d\n", |
1324 | var->xres, var->yres, var->bits_per_pixel, | |
1325 | var->xres_virtual, var->yres_virtual, | |
272725c7 | 1326 | fb->width, fb->height, fb->format->cpp[0] * 8); |
785b93ef DA |
1327 | return -EINVAL; |
1328 | } | |
1329 | ||
62d85b3b IM |
1330 | /* |
1331 | * Workaround for SDL 1.2, which is known to be setting all pixel format | |
1332 | * fields values to zero in some cases. We treat this situation as a | |
1333 | * kind of "use some reasonable autodetected values". | |
1334 | */ | |
1335 | if (!var->red.offset && !var->green.offset && | |
1336 | !var->blue.offset && !var->transp.offset && | |
1337 | !var->red.length && !var->green.length && | |
1338 | !var->blue.length && !var->transp.length && | |
1339 | !var->red.msb_right && !var->green.msb_right && | |
1340 | !var->blue.msb_right && !var->transp.msb_right) { | |
1341 | drm_fb_helper_fill_pixel_fmt(var, fb->format->depth); | |
1342 | } | |
1343 | ||
f30e2777 GU |
1344 | /* |
1345 | * Likewise, bits_per_pixel should be rounded up to a supported value. | |
1346 | */ | |
1347 | var->bits_per_pixel = fb->format->cpp[0] * 8; | |
1348 | ||
db05c481 EP |
1349 | /* |
1350 | * drm fbdev emulation doesn't support changing the pixel format at all, | |
1351 | * so reject all pixel format changing requests. | |
1352 | */ | |
1353 | if (!drm_fb_pixel_format_equal(var, &info->var)) { | |
f33b9730 | 1354 | drm_dbg_kms(dev, "fbdev emulation doesn't support changing the pixel format\n"); |
785b93ef DA |
1355 | return -EINVAL; |
1356 | } | |
db05c481 | 1357 | |
785b93ef DA |
1358 | return 0; |
1359 | } | |
1360 | EXPORT_SYMBOL(drm_fb_helper_check_var); | |
1361 | ||
207fd329 | 1362 | /** |
6806cdf9 | 1363 | * drm_fb_helper_set_par - implementation for &fb_ops.fb_set_par |
207fd329 DV |
1364 | * @info: fbdev registered by the helper |
1365 | * | |
1366 | * This will let fbcon do the mode init and is called at initialization time by | |
1367 | * the fbdev core when registering the driver, and later on through the hotplug | |
1368 | * callback. | |
1369 | */ | |
785b93ef DA |
1370 | int drm_fb_helper_set_par(struct fb_info *info) |
1371 | { | |
1372 | struct drm_fb_helper *fb_helper = info->par; | |
785b93ef | 1373 | struct fb_var_screeninfo *var = &info->var; |
dc5bdb68 | 1374 | bool force; |
785b93ef | 1375 | |
c50bfd08 DV |
1376 | if (oops_in_progress) |
1377 | return -EBUSY; | |
1378 | ||
5349ef31 | 1379 | if (var->pixclock != 0) { |
f33b9730 | 1380 | drm_err(fb_helper->dev, "PIXEL CLOCK SET\n"); |
785b93ef DA |
1381 | return -EINVAL; |
1382 | } | |
1383 | ||
dc5bdb68 DV |
1384 | /* |
1385 | * Normally we want to make sure that a kms master takes precedence over | |
1386 | * fbdev, to avoid fbdev flickering and occasionally stealing the | |
1387 | * display status. But Xorg first sets the vt back to text mode using | |
1388 | * the KDSET IOCTL with KD_TEXT, and only after that drops the master | |
1389 | * status when exiting. | |
1390 | * | |
1391 | * In the past this was caught by drm_fb_helper_lastclose(), but on | |
1392 | * modern systems where logind always keeps a drm fd open to orchestrate | |
1393 | * the vt switching, this doesn't work. | |
1394 | * | |
1395 | * To not break the userspace ABI we have this special case here, which | |
1396 | * is only used for the above case. Everything else uses the normal | |
1397 | * commit function, which ensures that we never steal the display from | |
1398 | * an active drm master. | |
1399 | */ | |
1400 | force = var->activate & FB_ACTIVATE_KD_TEXT; | |
1401 | ||
1402 | __drm_fb_helper_restore_fbdev_mode_unlocked(fb_helper, force); | |
4abe3520 | 1403 | |
785b93ef DA |
1404 | return 0; |
1405 | } | |
1406 | EXPORT_SYMBOL(drm_fb_helper_set_par); | |
1407 | ||
6b7dc6e9 | 1408 | static void pan_set(struct drm_fb_helper *fb_helper, int x, int y) |
1edf0269 | 1409 | { |
d81294af | 1410 | struct drm_mode_set *mode_set; |
1edf0269 | 1411 | |
d81294af NT |
1412 | mutex_lock(&fb_helper->client.modeset_mutex); |
1413 | drm_client_for_each_modeset(mode_set, &fb_helper->client) { | |
6b7dc6e9 DV |
1414 | mode_set->x = x; |
1415 | mode_set->y = y; | |
1edf0269 | 1416 | } |
d81294af | 1417 | mutex_unlock(&fb_helper->client.modeset_mutex); |
6b7dc6e9 | 1418 | } |
1edf0269 | 1419 | |
6b7dc6e9 DV |
1420 | static int pan_display_atomic(struct fb_var_screeninfo *var, |
1421 | struct fb_info *info) | |
1422 | { | |
1423 | struct drm_fb_helper *fb_helper = info->par; | |
1424 | int ret; | |
a0fb6ad7 | 1425 | |
6b7dc6e9 | 1426 | pan_set(fb_helper, var->xoffset, var->yoffset); |
1edf0269 | 1427 | |
c368ec19 | 1428 | ret = drm_client_modeset_commit_locked(&fb_helper->client); |
6b7dc6e9 DV |
1429 | if (!ret) { |
1430 | info->var.xoffset = var->xoffset; | |
1431 | info->var.yoffset = var->yoffset; | |
1432 | } else | |
1433 | pan_set(fb_helper, info->var.xoffset, info->var.yoffset); | |
5c2e3448 | 1434 | |
1edf0269 | 1435 | return ret; |
1edf0269 RC |
1436 | } |
1437 | ||
7128645d | 1438 | static int pan_display_legacy(struct fb_var_screeninfo *var, |
785b93ef DA |
1439 | struct fb_info *info) |
1440 | { | |
1441 | struct drm_fb_helper *fb_helper = info->par; | |
d81294af | 1442 | struct drm_client_dev *client = &fb_helper->client; |
785b93ef | 1443 | struct drm_mode_set *modeset; |
785b93ef | 1444 | int ret = 0; |
785b93ef | 1445 | |
d81294af | 1446 | mutex_lock(&client->modeset_mutex); |
1ff30dd8 | 1447 | drm_modeset_lock_all(fb_helper->dev); |
d81294af | 1448 | drm_client_for_each_modeset(modeset, client) { |
785b93ef DA |
1449 | modeset->x = var->xoffset; |
1450 | modeset->y = var->yoffset; | |
1451 | ||
1452 | if (modeset->num_connectors) { | |
2d13b679 | 1453 | ret = drm_mode_set_config_internal(modeset); |
785b93ef DA |
1454 | if (!ret) { |
1455 | info->var.xoffset = var->xoffset; | |
1456 | info->var.yoffset = var->yoffset; | |
1457 | } | |
1458 | } | |
1459 | } | |
5c2e3448 | 1460 | drm_modeset_unlock_all(fb_helper->dev); |
1ff30dd8 | 1461 | mutex_unlock(&client->modeset_mutex); |
7128645d DV |
1462 | |
1463 | return ret; | |
1464 | } | |
1465 | ||
1466 | /** | |
1467 | * drm_fb_helper_pan_display - implementation for &fb_ops.fb_pan_display | |
1468 | * @var: updated screen information | |
1469 | * @info: fbdev registered by the helper | |
1470 | */ | |
1471 | int drm_fb_helper_pan_display(struct fb_var_screeninfo *var, | |
1472 | struct fb_info *info) | |
1473 | { | |
1474 | struct drm_fb_helper *fb_helper = info->par; | |
1475 | struct drm_device *dev = fb_helper->dev; | |
1476 | int ret; | |
1477 | ||
1478 | if (oops_in_progress) | |
1479 | return -EBUSY; | |
1480 | ||
e9827d8e | 1481 | mutex_lock(&fb_helper->lock); |
03a9606e NT |
1482 | if (!drm_master_internal_acquire(dev)) { |
1483 | ret = -EBUSY; | |
1484 | goto unlock; | |
7128645d DV |
1485 | } |
1486 | ||
1487 | if (drm_drv_uses_atomic_modeset(dev)) | |
1488 | ret = pan_display_atomic(var, info); | |
1489 | else | |
1490 | ret = pan_display_legacy(var, info); | |
03a9606e NT |
1491 | |
1492 | drm_master_internal_release(dev); | |
1493 | unlock: | |
e9827d8e | 1494 | mutex_unlock(&fb_helper->lock); |
7128645d | 1495 | |
785b93ef DA |
1496 | return ret; |
1497 | } | |
1498 | EXPORT_SYMBOL(drm_fb_helper_pan_display); | |
1499 | ||
8acf658a | 1500 | /* |
207fd329 | 1501 | * Allocates the backing storage and sets up the fbdev info structure through |
ca91a275 | 1502 | * the ->fb_probe callback. |
8acf658a | 1503 | */ |
de1ace5b DV |
1504 | static int drm_fb_helper_single_fb_probe(struct drm_fb_helper *fb_helper, |
1505 | int preferred_bpp) | |
785b93ef | 1506 | { |
d81294af | 1507 | struct drm_client_dev *client = &fb_helper->client; |
f33b9730 | 1508 | struct drm_device *dev = fb_helper->dev; |
b693e429 | 1509 | struct drm_mode_config *config = &dev->mode_config; |
8acf658a | 1510 | int ret = 0; |
785b93ef | 1511 | int crtc_count = 0; |
e5852bee | 1512 | struct drm_connector_list_iter conn_iter; |
38651674 | 1513 | struct drm_fb_helper_surface_size sizes; |
e5852bee | 1514 | struct drm_connector *connector; |
d81294af | 1515 | struct drm_mode_set *mode_set; |
f4bd542b | 1516 | int best_depth = 0; |
38651674 DA |
1517 | |
1518 | memset(&sizes, 0, sizeof(struct drm_fb_helper_surface_size)); | |
1519 | sizes.surface_depth = 24; | |
1520 | sizes.surface_bpp = 32; | |
4b4f99f5 TR |
1521 | sizes.fb_width = (u32)-1; |
1522 | sizes.fb_height = (u32)-1; | |
785b93ef | 1523 | |
f4bd542b LW |
1524 | /* |
1525 | * If driver picks 8 or 16 by default use that for both depth/bpp | |
1526 | * to begin with | |
1527 | */ | |
96081cdf | 1528 | if (preferred_bpp != sizes.surface_bpp) |
38651674 | 1529 | sizes.surface_depth = sizes.surface_bpp = preferred_bpp; |
96081cdf | 1530 | |
e5852bee NT |
1531 | drm_connector_list_iter_begin(fb_helper->dev, &conn_iter); |
1532 | drm_client_for_each_connector_iter(connector, &conn_iter) { | |
1794d257 | 1533 | struct drm_cmdline_mode *cmdline_mode; |
8ef8678c | 1534 | |
e5852bee | 1535 | cmdline_mode = &connector->cmdline_mode; |
d50ba256 DA |
1536 | |
1537 | if (cmdline_mode->bpp_specified) { | |
1538 | switch (cmdline_mode->bpp) { | |
1539 | case 8: | |
38651674 | 1540 | sizes.surface_depth = sizes.surface_bpp = 8; |
d50ba256 DA |
1541 | break; |
1542 | case 15: | |
38651674 DA |
1543 | sizes.surface_depth = 15; |
1544 | sizes.surface_bpp = 16; | |
d50ba256 DA |
1545 | break; |
1546 | case 16: | |
38651674 | 1547 | sizes.surface_depth = sizes.surface_bpp = 16; |
d50ba256 DA |
1548 | break; |
1549 | case 24: | |
38651674 | 1550 | sizes.surface_depth = sizes.surface_bpp = 24; |
d50ba256 DA |
1551 | break; |
1552 | case 32: | |
38651674 DA |
1553 | sizes.surface_depth = 24; |
1554 | sizes.surface_bpp = 32; | |
d50ba256 DA |
1555 | break; |
1556 | } | |
1557 | break; | |
1558 | } | |
1559 | } | |
e5852bee | 1560 | drm_connector_list_iter_end(&conn_iter); |
d50ba256 | 1561 | |
f4bd542b LW |
1562 | /* |
1563 | * If we run into a situation where, for example, the primary plane | |
1564 | * supports RGBA5551 (16 bpp, depth 15) but not RGB565 (16 bpp, depth | |
1565 | * 16) we need to scale down the depth of the sizes we request. | |
1566 | */ | |
d81294af NT |
1567 | mutex_lock(&client->modeset_mutex); |
1568 | drm_client_for_each_modeset(mode_set, client) { | |
f4bd542b LW |
1569 | struct drm_crtc *crtc = mode_set->crtc; |
1570 | struct drm_plane *plane = crtc->primary; | |
1571 | int j; | |
1572 | ||
f33b9730 | 1573 | drm_dbg_kms(dev, "test CRTC %u primary plane\n", drm_crtc_index(crtc)); |
f4bd542b LW |
1574 | |
1575 | for (j = 0; j < plane->format_count; j++) { | |
1576 | const struct drm_format_info *fmt; | |
1577 | ||
1578 | fmt = drm_format_info(plane->format_types[j]); | |
1579 | ||
1580 | /* | |
1581 | * Do not consider YUV or other complicated formats | |
1582 | * for framebuffers. This means only legacy formats | |
1583 | * are supported (fmt->depth is a legacy field) but | |
1584 | * the framebuffer emulation can only deal with such | |
1585 | * formats, specifically RGB/BGA formats. | |
1586 | */ | |
1587 | if (fmt->depth == 0) | |
1588 | continue; | |
1589 | ||
1590 | /* We found a perfect fit, great */ | |
1591 | if (fmt->depth == sizes.surface_depth) { | |
1592 | best_depth = fmt->depth; | |
1593 | break; | |
1594 | } | |
1595 | ||
1596 | /* Skip depths above what we're looking for */ | |
1597 | if (fmt->depth > sizes.surface_depth) | |
1598 | continue; | |
1599 | ||
1600 | /* Best depth found so far */ | |
1601 | if (fmt->depth > best_depth) | |
1602 | best_depth = fmt->depth; | |
1603 | } | |
1604 | } | |
b6a36e5d | 1605 | if (sizes.surface_depth != best_depth && best_depth) { |
f33b9730 | 1606 | drm_info(dev, "requested bpp %d, scaled depth down to %d", |
f4bd542b LW |
1607 | sizes.surface_bpp, best_depth); |
1608 | sizes.surface_depth = best_depth; | |
1609 | } | |
1610 | ||
b9ed8cff | 1611 | /* first up get a count of crtcs now in use and new min/maxes width/heights */ |
8be48d92 | 1612 | crtc_count = 0; |
d81294af | 1613 | drm_client_for_each_modeset(mode_set, client) { |
8be48d92 | 1614 | struct drm_display_mode *desired_mode; |
0e3704c9 RC |
1615 | int x, y, j; |
1616 | /* in case of tile group, are we the last tile vert or horiz? | |
1617 | * If no tile group you are always the last one both vertically | |
1618 | * and horizontally | |
1619 | */ | |
1620 | bool lastv = true, lasth = true; | |
675c8328 | 1621 | |
c8de0d5f | 1622 | desired_mode = mode_set->mode; |
675c8328 RC |
1623 | |
1624 | if (!desired_mode) | |
1625 | continue; | |
1626 | ||
1627 | crtc_count++; | |
1628 | ||
c8de0d5f NT |
1629 | x = mode_set->x; |
1630 | y = mode_set->y; | |
675c8328 | 1631 | |
675c8328 RC |
1632 | sizes.surface_width = max_t(u32, desired_mode->hdisplay + x, sizes.surface_width); |
1633 | sizes.surface_height = max_t(u32, desired_mode->vdisplay + y, sizes.surface_height); | |
0e3704c9 RC |
1634 | |
1635 | for (j = 0; j < mode_set->num_connectors; j++) { | |
1636 | struct drm_connector *connector = mode_set->connectors[j]; | |
4b4f99f5 | 1637 | |
8c4ebd0d MN |
1638 | if (connector->has_tile && |
1639 | desired_mode->hdisplay == connector->tile_h_size && | |
1640 | desired_mode->vdisplay == connector->tile_v_size) { | |
0e3704c9 RC |
1641 | lasth = (connector->tile_h_loc == (connector->num_h_tile - 1)); |
1642 | lastv = (connector->tile_v_loc == (connector->num_v_tile - 1)); | |
1643 | /* cloning to multiple tiles is just crazy-talk, so: */ | |
1644 | break; | |
1645 | } | |
1646 | } | |
1647 | ||
1648 | if (lasth) | |
1649 | sizes.fb_width = min_t(u32, desired_mode->hdisplay + x, sizes.fb_width); | |
1650 | if (lastv) | |
1651 | sizes.fb_height = min_t(u32, desired_mode->vdisplay + y, sizes.fb_height); | |
785b93ef | 1652 | } |
d81294af | 1653 | mutex_unlock(&client->modeset_mutex); |
785b93ef | 1654 | |
38651674 | 1655 | if (crtc_count == 0 || sizes.fb_width == -1 || sizes.fb_height == -1) { |
f33b9730 | 1656 | drm_info(dev, "Cannot find any crtc or sizes\n"); |
52dd0650 ML |
1657 | |
1658 | /* First time: disable all crtc's.. */ | |
03a9606e | 1659 | if (!fb_helper->deferred_setup) |
eade2a17 | 1660 | drm_client_modeset_commit(client); |
ca91a275 | 1661 | return -EAGAIN; |
785b93ef DA |
1662 | } |
1663 | ||
5f152576 XL |
1664 | /* Handle our overallocation */ |
1665 | sizes.surface_height *= drm_fbdev_overalloc; | |
1666 | sizes.surface_height /= 100; | |
b693e429 TZ |
1667 | if (sizes.surface_height > config->max_height) { |
1668 | drm_dbg_kms(dev, "Fbdev over-allocation too large; clamping height to %d\n", | |
1669 | config->max_height); | |
1670 | sizes.surface_height = config->max_height; | |
1671 | } | |
5f152576 | 1672 | |
38651674 | 1673 | /* push down into drivers */ |
8acf658a DV |
1674 | ret = (*fb_helper->funcs->fb_probe)(fb_helper, &sizes); |
1675 | if (ret < 0) | |
1676 | return ret; | |
785b93ef | 1677 | |
8d44e9e6 | 1678 | strcpy(fb_helper->fb->comm, "[fbcon]"); |
785b93ef DA |
1679 | return 0; |
1680 | } | |
785b93ef | 1681 | |
168b85e9 DV |
1682 | static void drm_fb_helper_fill_fix(struct fb_info *info, uint32_t pitch, |
1683 | uint32_t depth) | |
3632ef89 DA |
1684 | { |
1685 | info->fix.type = FB_TYPE_PACKED_PIXELS; | |
1686 | info->fix.visual = depth == 8 ? FB_VISUAL_PSEUDOCOLOR : | |
1687 | FB_VISUAL_TRUECOLOR; | |
1688 | info->fix.mmio_start = 0; | |
1689 | info->fix.mmio_len = 0; | |
1690 | info->fix.type_aux = 0; | |
1691 | info->fix.xpanstep = 1; /* doing it in hw */ | |
1692 | info->fix.ypanstep = 1; /* doing it in hw */ | |
1693 | info->fix.ywrapstep = 0; | |
1694 | info->fix.accel = FB_ACCEL_NONE; | |
3632ef89 DA |
1695 | |
1696 | info->fix.line_length = pitch; | |
3632ef89 | 1697 | } |
3632ef89 | 1698 | |
168b85e9 DV |
1699 | static void drm_fb_helper_fill_var(struct fb_info *info, |
1700 | struct drm_fb_helper *fb_helper, | |
1701 | uint32_t fb_width, uint32_t fb_height) | |
785b93ef | 1702 | { |
38651674 | 1703 | struct drm_framebuffer *fb = fb_helper->fb; |
4b4f99f5 | 1704 | |
042bf753 AG |
1705 | WARN_ON((drm_format_info_block_width(fb->format, 0) > 1) || |
1706 | (drm_format_info_block_height(fb->format, 0) > 1)); | |
38651674 | 1707 | info->pseudo_palette = fb_helper->pseudo_palette; |
785b93ef DA |
1708 | info->var.xres_virtual = fb->width; |
1709 | info->var.yres_virtual = fb->height; | |
272725c7 | 1710 | info->var.bits_per_pixel = fb->format->cpp[0] * 8; |
57084d05 | 1711 | info->var.accel_flags = FB_ACCELF_TEXT; |
785b93ef DA |
1712 | info->var.xoffset = 0; |
1713 | info->var.yoffset = 0; | |
1714 | info->var.activate = FB_ACTIVATE_NOW; | |
785b93ef | 1715 | |
62d85b3b | 1716 | drm_fb_helper_fill_pixel_fmt(&info->var, fb->format->depth); |
785b93ef DA |
1717 | |
1718 | info->var.xres = fb_width; | |
1719 | info->var.yres = fb_height; | |
1720 | } | |
38651674 | 1721 | |
3df3116a DV |
1722 | /** |
1723 | * drm_fb_helper_fill_info - initializes fbdev information | |
1724 | * @info: fbdev instance to set up | |
1725 | * @fb_helper: fb helper instance to use as template | |
1726 | * @sizes: describes fbdev size and scanout surface size | |
1727 | * | |
1728 | * Sets up the variable and fixed fbdev metainformation from the given fb helper | |
1729 | * instance and the drm framebuffer allocated in &drm_fb_helper.fb. | |
1730 | * | |
1731 | * Drivers should call this (or their equivalent setup code) from their | |
1732 | * &drm_fb_helper_funcs.fb_probe callback after having allocated the fbdev | |
1733 | * backing storage framebuffer. | |
1734 | */ | |
1735 | void drm_fb_helper_fill_info(struct fb_info *info, | |
1736 | struct drm_fb_helper *fb_helper, | |
1737 | struct drm_fb_helper_surface_size *sizes) | |
1738 | { | |
1739 | struct drm_framebuffer *fb = fb_helper->fb; | |
1740 | ||
1741 | drm_fb_helper_fill_fix(info, fb->pitches[0], fb->format->depth); | |
1742 | drm_fb_helper_fill_var(info, fb_helper, | |
1743 | sizes->fb_width, sizes->fb_height); | |
1744 | ||
ecbfc474 | 1745 | info->par = fb_helper; |
842470c4 JMC |
1746 | /* |
1747 | * The DRM drivers fbdev emulation device name can be confusing if the | |
1748 | * driver name also has a "drm" suffix on it. Leading to names such as | |
1749 | * "simpledrmdrmfb" in /proc/fb. Unfortunately, it's an uAPI and can't | |
1750 | * be changed due user-space tools (e.g: pm-utils) matching against it. | |
1751 | */ | |
1752 | snprintf(info->fix.id, sizeof(info->fix.id), "%sdrmfb", | |
f1eca684 DV |
1753 | fb_helper->dev->driver->name); |
1754 | ||
3df3116a DV |
1755 | } |
1756 | EXPORT_SYMBOL(drm_fb_helper_fill_info); | |
1757 | ||
f461bd2b DL |
1758 | /* |
1759 | * This is a continuation of drm_setup_crtcs() that sets up anything related | |
1760 | * to the framebuffer. During initialization, drm_setup_crtcs() is called before | |
1761 | * the framebuffer has been allocated (fb_helper->fb and fb_helper->fbdev). | |
1762 | * So, any setup that touches those fields needs to be done here instead of in | |
1763 | * drm_setup_crtcs(). | |
1764 | */ | |
1765 | static void drm_setup_crtcs_fb(struct drm_fb_helper *fb_helper) | |
1766 | { | |
d81294af | 1767 | struct drm_client_dev *client = &fb_helper->client; |
e5852bee | 1768 | struct drm_connector_list_iter conn_iter; |
991a3999 | 1769 | struct fb_info *info = fb_helper->fbdev; |
bc934755 | 1770 | unsigned int rotation, sw_rotations = 0; |
e5852bee | 1771 | struct drm_connector *connector; |
d81294af | 1772 | struct drm_mode_set *modeset; |
f461bd2b | 1773 | |
d81294af NT |
1774 | mutex_lock(&client->modeset_mutex); |
1775 | drm_client_for_each_modeset(modeset, client) { | |
bc934755 NT |
1776 | if (!modeset->num_connectors) |
1777 | continue; | |
1778 | ||
1779 | modeset->fb = fb_helper->fb; | |
1780 | ||
a99076e8 | 1781 | if (drm_client_rotation(modeset, &rotation)) |
bc934755 NT |
1782 | /* Rotating in hardware, fbcon should not rotate */ |
1783 | sw_rotations |= DRM_MODE_ROTATE_0; | |
1784 | else | |
1785 | sw_rotations |= rotation; | |
1786 | } | |
d81294af | 1787 | mutex_unlock(&client->modeset_mutex); |
991a3999 | 1788 | |
e5852bee NT |
1789 | drm_connector_list_iter_begin(fb_helper->dev, &conn_iter); |
1790 | drm_client_for_each_connector_iter(connector, &conn_iter) { | |
991a3999 DL |
1791 | |
1792 | /* use first connected connector for the physical dimensions */ | |
1793 | if (connector->status == connector_status_connected) { | |
1794 | info->var.width = connector->display_info.width_mm; | |
1795 | info->var.height = connector->display_info.height_mm; | |
1796 | break; | |
1797 | } | |
1798 | } | |
e5852bee | 1799 | drm_connector_list_iter_end(&conn_iter); |
8f0cb418 | 1800 | |
bc934755 | 1801 | switch (sw_rotations) { |
8f0cb418 HG |
1802 | case DRM_MODE_ROTATE_0: |
1803 | info->fbcon_rotate_hint = FB_ROTATE_UR; | |
1804 | break; | |
1805 | case DRM_MODE_ROTATE_90: | |
1806 | info->fbcon_rotate_hint = FB_ROTATE_CCW; | |
1807 | break; | |
1808 | case DRM_MODE_ROTATE_180: | |
1809 | info->fbcon_rotate_hint = FB_ROTATE_UD; | |
1810 | break; | |
1811 | case DRM_MODE_ROTATE_270: | |
1812 | info->fbcon_rotate_hint = FB_ROTATE_CW; | |
1813 | break; | |
1814 | default: | |
1815 | /* | |
1816 | * Multiple bits are set / multiple rotations requested | |
1817 | * fbcon cannot handle separate rotation settings per | |
1818 | * output, so fallback to unrotated. | |
1819 | */ | |
1820 | info->fbcon_rotate_hint = FB_ROTATE_UR; | |
1821 | } | |
f461bd2b DL |
1822 | } |
1823 | ||
ca91a275 DV |
1824 | /* Note: Drops fb_helper->lock before returning. */ |
1825 | static int | |
1826 | __drm_fb_helper_initial_config_and_unlock(struct drm_fb_helper *fb_helper, | |
1827 | int bpp_sel) | |
1828 | { | |
1829 | struct drm_device *dev = fb_helper->dev; | |
1830 | struct fb_info *info; | |
1831 | unsigned int width, height; | |
1832 | int ret; | |
1833 | ||
1834 | width = dev->mode_config.max_width; | |
1835 | height = dev->mode_config.max_height; | |
1836 | ||
aafa9e06 | 1837 | drm_client_modeset_probe(&fb_helper->client, width, height); |
ca91a275 DV |
1838 | ret = drm_fb_helper_single_fb_probe(fb_helper, bpp_sel); |
1839 | if (ret < 0) { | |
1840 | if (ret == -EAGAIN) { | |
1841 | fb_helper->preferred_bpp = bpp_sel; | |
1842 | fb_helper->deferred_setup = true; | |
1843 | ret = 0; | |
1844 | } | |
1845 | mutex_unlock(&fb_helper->lock); | |
1846 | ||
1847 | return ret; | |
1848 | } | |
f461bd2b | 1849 | drm_setup_crtcs_fb(fb_helper); |
ca91a275 DV |
1850 | |
1851 | fb_helper->deferred_setup = false; | |
1852 | ||
1853 | info = fb_helper->fbdev; | |
1854 | info->var.pixclock = 0; | |
4be9bd10 NA |
1855 | /* Shamelessly allow physical address leaking to userspace */ |
1856 | #if IS_ENABLED(CONFIG_DRM_FBDEV_LEAK_PHYS_SMEM) | |
1857 | if (!drm_leak_fbdev_smem) | |
1858 | #endif | |
1859 | /* don't leak any physical addresses to userspace */ | |
1860 | info->flags |= FBINFO_HIDE_SMEM_START; | |
ca91a275 DV |
1861 | |
1862 | /* Need to drop locks to avoid recursive deadlock in | |
1863 | * register_framebuffer. This is ok because the only thing left to do is | |
1864 | * register the fbdev emulation instance in kernel_fb_helper_list. */ | |
1865 | mutex_unlock(&fb_helper->lock); | |
1866 | ||
1867 | ret = register_framebuffer(info); | |
1868 | if (ret < 0) | |
1869 | return ret; | |
1870 | ||
8f9fcb34 | 1871 | drm_info(dev, "fb%d: %s frame buffer device\n", |
ca91a275 DV |
1872 | info->node, info->fix.id); |
1873 | ||
1874 | mutex_lock(&kernel_fb_helper_lock); | |
1875 | if (list_empty(&kernel_fb_helper_list)) | |
1876 | register_sysrq_key('v', &sysrq_drm_fb_helper_restore_op); | |
1877 | ||
1878 | list_add(&fb_helper->kernel_fb_list, &kernel_fb_helper_list); | |
1879 | mutex_unlock(&kernel_fb_helper_lock); | |
1880 | ||
1881 | return 0; | |
1882 | } | |
1883 | ||
38651674 | 1884 | /** |
207fd329 | 1885 | * drm_fb_helper_initial_config - setup a sane initial connector configuration |
d0ddc033 DV |
1886 | * @fb_helper: fb_helper device struct |
1887 | * @bpp_sel: bpp value to use for the framebuffer configuration | |
38651674 | 1888 | * |
d0ddc033 | 1889 | * Scans the CRTCs and connectors and tries to put together an initial setup. |
38651674 DA |
1890 | * At the moment, this is a cloned configuration across all heads with |
1891 | * a new framebuffer object as the backing store. | |
1892 | * | |
207fd329 DV |
1893 | * Note that this also registers the fbdev and so allows userspace to call into |
1894 | * the driver through the fbdev interfaces. | |
1895 | * | |
6806cdf9 DV |
1896 | * This function will call down into the &drm_fb_helper_funcs.fb_probe callback |
1897 | * to let the driver allocate and initialize the fbdev info structure and the | |
ec8bf194 DV |
1898 | * drm framebuffer used to back the fbdev. drm_fb_helper_fill_info() is provided |
1899 | * as a helper to setup simple default values for the fbdev info structure. | |
207fd329 | 1900 | * |
40f8cf4b DV |
1901 | * HANG DEBUGGING: |
1902 | * | |
1903 | * When you have fbcon support built-in or already loaded, this function will do | |
1904 | * a full modeset to setup the fbdev console. Due to locking misdesign in the | |
1905 | * VT/fbdev subsystem that entire modeset sequence has to be done while holding | |
1906 | * console_lock. Until console_unlock is called no dmesg lines will be sent out | |
1907 | * to consoles, not even serial console. This means when your driver crashes, | |
1908 | * you will see absolutely nothing else but a system stuck in this function, | |
1909 | * with no further output. Any kind of printk() you place within your own driver | |
1910 | * or in the drm core modeset code will also never show up. | |
1911 | * | |
1912 | * Standard debug practice is to run the fbcon setup without taking the | |
1913 | * console_lock as a hack, to be able to see backtraces and crashes on the | |
1914 | * serial line. This can be done by setting the fb.lockless_register_fb=1 kernel | |
1915 | * cmdline option. | |
1916 | * | |
1917 | * The other option is to just disable fbdev emulation since very likely the | |
af509d38 L |
1918 | * first modeset from userspace will crash in the same way, and is even easier |
1919 | * to debug. This can be done by setting the drm_kms_helper.fbdev_emulation=0 | |
40f8cf4b DV |
1920 | * kernel cmdline option. |
1921 | * | |
38651674 DA |
1922 | * RETURNS: |
1923 | * Zero if everything went ok, nonzero otherwise. | |
1924 | */ | |
01934c2a | 1925 | int drm_fb_helper_initial_config(struct drm_fb_helper *fb_helper, int bpp_sel) |
38651674 | 1926 | { |
966a6a13 | 1927 | int ret; |
38651674 | 1928 | |
f64c5573 DV |
1929 | if (!drm_fbdev_emulation) |
1930 | return 0; | |
1931 | ||
e9827d8e | 1932 | mutex_lock(&fb_helper->lock); |
ca91a275 | 1933 | ret = __drm_fb_helper_initial_config_and_unlock(fb_helper, bpp_sel); |
38651674 | 1934 | |
ca91a275 | 1935 | return ret; |
38651674 | 1936 | } |
8be48d92 | 1937 | EXPORT_SYMBOL(drm_fb_helper_initial_config); |
38651674 | 1938 | |
7394371d CW |
1939 | /** |
1940 | * drm_fb_helper_hotplug_event - respond to a hotplug notification by | |
d0ddc033 | 1941 | * probing all the outputs attached to the fb |
c777990f | 1942 | * @fb_helper: driver-allocated fbdev helper, can be NULL |
7394371d | 1943 | * |
7394371d | 1944 | * Scan the connectors attached to the fb_helper and try to put together a |
62cacc79 | 1945 | * setup after notification of a change in output configuration. |
7394371d | 1946 | * |
207fd329 DV |
1947 | * Called at runtime, takes the mode config locks to be able to check/change the |
1948 | * modeset configuration. Must be run from process context (which usually means | |
1949 | * either the output polling work or a work item launched from the driver's | |
1950 | * hotplug interrupt). | |
1951 | * | |
50c3dc97 | 1952 | * Note that drivers may call this even before calling |
af509d38 | 1953 | * drm_fb_helper_initial_config but only after drm_fb_helper_init. This allows |
50c3dc97 DV |
1954 | * for a race-free fbcon setup and will make sure that the fbdev emulation will |
1955 | * not miss any hotplug events. | |
207fd329 | 1956 | * |
7394371d CW |
1957 | * RETURNS: |
1958 | * 0 on success and a non-zero error code otherwise. | |
1959 | */ | |
1960 | int drm_fb_helper_hotplug_event(struct drm_fb_helper *fb_helper) | |
38651674 | 1961 | { |
e9827d8e | 1962 | int err = 0; |
5c4426a7 | 1963 | |
c777990f | 1964 | if (!drm_fbdev_emulation || !fb_helper) |
f64c5573 DV |
1965 | return 0; |
1966 | ||
e9827d8e | 1967 | mutex_lock(&fb_helper->lock); |
ca91a275 DV |
1968 | if (fb_helper->deferred_setup) { |
1969 | err = __drm_fb_helper_initial_config_and_unlock(fb_helper, | |
1970 | fb_helper->preferred_bpp); | |
1971 | return err; | |
1972 | } | |
1973 | ||
05865769 | 1974 | if (!fb_helper->fb || !drm_master_internal_acquire(fb_helper->dev)) { |
4abe3520 | 1975 | fb_helper->delayed_hotplug = true; |
bdac4a05 DV |
1976 | mutex_unlock(&fb_helper->lock); |
1977 | return err; | |
4abe3520 | 1978 | } |
e9827d8e | 1979 | |
05865769 | 1980 | drm_master_internal_release(fb_helper->dev); |
03a9606e | 1981 | |
f33b9730 | 1982 | drm_dbg_kms(fb_helper->dev, "\n"); |
4abe3520 | 1983 | |
aafa9e06 | 1984 | drm_client_modeset_probe(&fb_helper->client, fb_helper->fb->width, fb_helper->fb->height); |
f461bd2b | 1985 | drm_setup_crtcs_fb(fb_helper); |
e9827d8e | 1986 | mutex_unlock(&fb_helper->lock); |
89ced125 | 1987 | |
2180c3c7 DV |
1988 | drm_fb_helper_set_par(fb_helper->fbdev); |
1989 | ||
1990 | return 0; | |
5c4426a7 | 1991 | } |
eb1f8e4f | 1992 | EXPORT_SYMBOL(drm_fb_helper_hotplug_event); |
5c4426a7 | 1993 | |
304a4f6a NT |
1994 | /** |
1995 | * drm_fb_helper_lastclose - DRM driver lastclose helper for fbdev emulation | |
1996 | * @dev: DRM device | |
1997 | * | |
1998 | * This function can be used as the &drm_driver->lastclose callback for drivers | |
1999 | * that only need to call drm_fb_helper_restore_fbdev_mode_unlocked(). | |
2000 | */ | |
2001 | void drm_fb_helper_lastclose(struct drm_device *dev) | |
2002 | { | |
2003 | drm_fb_helper_restore_fbdev_mode_unlocked(dev->fb_helper); | |
2004 | } | |
2005 | EXPORT_SYMBOL(drm_fb_helper_lastclose); | |
2006 | ||
2007 | /** | |
2008 | * drm_fb_helper_output_poll_changed - DRM mode config \.output_poll_changed | |
2009 | * helper for fbdev emulation | |
2010 | * @dev: DRM device | |
2011 | * | |
2012 | * This function can be used as the | |
2013 | * &drm_mode_config_funcs.output_poll_changed callback for drivers that only | |
2014 | * need to call drm_fb_helper_hotplug_event(). | |
2015 | */ | |
2016 | void drm_fb_helper_output_poll_changed(struct drm_device *dev) | |
2017 | { | |
2018 | drm_fb_helper_hotplug_event(dev->fb_helper); | |
2019 | } | |
2020 | EXPORT_SYMBOL(drm_fb_helper_output_poll_changed); | |
2021 | ||
d536540f NT |
2022 | /* @user: 1=userspace, 0=fbcon */ |
2023 | static int drm_fbdev_fb_open(struct fb_info *info, int user) | |
2024 | { | |
2025 | struct drm_fb_helper *fb_helper = info->par; | |
2026 | ||
6ab20a05 NT |
2027 | /* No need to take a ref for fbcon because it unbinds on unregister */ |
2028 | if (user && !try_module_get(fb_helper->dev->driver->fops->owner)) | |
d536540f NT |
2029 | return -ENODEV; |
2030 | ||
2031 | return 0; | |
2032 | } | |
2033 | ||
2034 | static int drm_fbdev_fb_release(struct fb_info *info, int user) | |
2035 | { | |
2036 | struct drm_fb_helper *fb_helper = info->par; | |
2037 | ||
6ab20a05 NT |
2038 | if (user) |
2039 | module_put(fb_helper->dev->driver->fops->owner); | |
d536540f NT |
2040 | |
2041 | return 0; | |
2042 | } | |
2043 | ||
6e1490cf | 2044 | static void drm_fbdev_cleanup(struct drm_fb_helper *fb_helper) |
d536540f | 2045 | { |
d536540f | 2046 | struct fb_info *fbi = fb_helper->fbdev; |
d536540f NT |
2047 | void *shadow = NULL; |
2048 | ||
6e1490cf NT |
2049 | if (!fb_helper->dev) |
2050 | return; | |
2051 | ||
763aea17 TZ |
2052 | if (fbi) { |
2053 | if (fbi->fbdefio) | |
2054 | fb_deferred_io_cleanup(fbi); | |
2055 | if (drm_fbdev_use_shadow_fb(fb_helper)) | |
2056 | shadow = fbi->screen_buffer; | |
d536540f NT |
2057 | } |
2058 | ||
2059 | drm_fb_helper_fini(fb_helper); | |
2060 | ||
763aea17 TZ |
2061 | if (shadow) |
2062 | vfree(shadow); | |
874a52f9 | 2063 | else if (fb_helper->buffer) |
763aea17 | 2064 | drm_client_buffer_vunmap(fb_helper->buffer); |
d536540f NT |
2065 | |
2066 | drm_client_framebuffer_delete(fb_helper->buffer); | |
6e1490cf NT |
2067 | } |
2068 | ||
2069 | static void drm_fbdev_release(struct drm_fb_helper *fb_helper) | |
2070 | { | |
2071 | drm_fbdev_cleanup(fb_helper); | |
2de304b4 NT |
2072 | drm_client_release(&fb_helper->client); |
2073 | kfree(fb_helper); | |
d536540f NT |
2074 | } |
2075 | ||
6e1490cf NT |
2076 | /* |
2077 | * fb_ops.fb_destroy is called by the last put_fb_info() call at the end of | |
2078 | * unregister_framebuffer() or fb_release(). | |
2079 | */ | |
2080 | static void drm_fbdev_fb_destroy(struct fb_info *info) | |
2081 | { | |
2082 | drm_fbdev_release(info->par); | |
2083 | } | |
2084 | ||
d536540f NT |
2085 | static int drm_fbdev_fb_mmap(struct fb_info *info, struct vm_area_struct *vma) |
2086 | { | |
2087 | struct drm_fb_helper *fb_helper = info->par; | |
2088 | ||
2089 | if (fb_helper->dev->driver->gem_prime_mmap) | |
2090 | return fb_helper->dev->driver->gem_prime_mmap(fb_helper->buffer->gem, vma); | |
2091 | else | |
2092 | return -ENODEV; | |
2093 | } | |
2094 | ||
222ec45f TZ |
2095 | static bool drm_fbdev_use_iomem(struct fb_info *info) |
2096 | { | |
2097 | struct drm_fb_helper *fb_helper = info->par; | |
2098 | struct drm_client_buffer *buffer = fb_helper->buffer; | |
2099 | ||
2100 | return !drm_fbdev_use_shadow_fb(fb_helper) && buffer->map.is_iomem; | |
2101 | } | |
2102 | ||
2103 | static ssize_t fb_read_screen_base(struct fb_info *info, char __user *buf, size_t count, | |
2104 | loff_t pos) | |
2105 | { | |
2106 | const char __iomem *src = info->screen_base + pos; | |
a3230bd7 | 2107 | size_t alloc_size = min_t(size_t, count, PAGE_SIZE); |
222ec45f TZ |
2108 | ssize_t ret = 0; |
2109 | int err = 0; | |
2110 | char *tmp; | |
2111 | ||
2112 | tmp = kmalloc(alloc_size, GFP_KERNEL); | |
2113 | if (!tmp) | |
2114 | return -ENOMEM; | |
2115 | ||
2116 | while (count) { | |
2117 | size_t c = min_t(size_t, count, alloc_size); | |
2118 | ||
2119 | memcpy_fromio(tmp, src, c); | |
2120 | if (copy_to_user(buf, tmp, c)) { | |
2121 | err = -EFAULT; | |
2122 | break; | |
2123 | } | |
2124 | ||
2125 | src += c; | |
2126 | buf += c; | |
2127 | ret += c; | |
2128 | count -= c; | |
2129 | } | |
2130 | ||
2131 | kfree(tmp); | |
2132 | ||
2133 | return ret ? ret : err; | |
2134 | } | |
2135 | ||
2136 | static ssize_t fb_read_screen_buffer(struct fb_info *info, char __user *buf, size_t count, | |
2137 | loff_t pos) | |
2138 | { | |
2139 | const char *src = info->screen_buffer + pos; | |
2140 | ||
2141 | if (copy_to_user(buf, src, count)) | |
2142 | return -EFAULT; | |
2143 | ||
2144 | return count; | |
2145 | } | |
2146 | ||
2147 | static ssize_t drm_fbdev_fb_read(struct fb_info *info, char __user *buf, | |
2148 | size_t count, loff_t *ppos) | |
2149 | { | |
2150 | loff_t pos = *ppos; | |
2151 | size_t total_size; | |
2152 | ssize_t ret; | |
2153 | ||
2154 | if (info->screen_size) | |
2155 | total_size = info->screen_size; | |
2156 | else | |
2157 | total_size = info->fix.smem_len; | |
2158 | ||
2159 | if (pos >= total_size) | |
2160 | return 0; | |
2161 | if (count >= total_size) | |
2162 | count = total_size; | |
2163 | if (total_size - count < pos) | |
2164 | count = total_size - pos; | |
2165 | ||
2166 | if (drm_fbdev_use_iomem(info)) | |
2167 | ret = fb_read_screen_base(info, buf, count, pos); | |
2168 | else | |
2169 | ret = fb_read_screen_buffer(info, buf, count, pos); | |
2170 | ||
2171 | if (ret > 0) | |
2172 | *ppos += ret; | |
2173 | ||
2174 | return ret; | |
2175 | } | |
2176 | ||
2177 | static ssize_t fb_write_screen_base(struct fb_info *info, const char __user *buf, size_t count, | |
2178 | loff_t pos) | |
2179 | { | |
2180 | char __iomem *dst = info->screen_base + pos; | |
a3230bd7 | 2181 | size_t alloc_size = min_t(size_t, count, PAGE_SIZE); |
222ec45f TZ |
2182 | ssize_t ret = 0; |
2183 | int err = 0; | |
2184 | u8 *tmp; | |
2185 | ||
2186 | tmp = kmalloc(alloc_size, GFP_KERNEL); | |
2187 | if (!tmp) | |
2188 | return -ENOMEM; | |
2189 | ||
2190 | while (count) { | |
2191 | size_t c = min_t(size_t, count, alloc_size); | |
2192 | ||
2193 | if (copy_from_user(tmp, buf, c)) { | |
2194 | err = -EFAULT; | |
2195 | break; | |
2196 | } | |
2197 | memcpy_toio(dst, tmp, c); | |
2198 | ||
2199 | dst += c; | |
2200 | buf += c; | |
2201 | ret += c; | |
2202 | count -= c; | |
2203 | } | |
2204 | ||
2205 | kfree(tmp); | |
2206 | ||
2207 | return ret ? ret : err; | |
2208 | } | |
2209 | ||
2210 | static ssize_t fb_write_screen_buffer(struct fb_info *info, const char __user *buf, size_t count, | |
2211 | loff_t pos) | |
2212 | { | |
2213 | char *dst = info->screen_buffer + pos; | |
2214 | ||
2215 | if (copy_from_user(dst, buf, count)) | |
2216 | return -EFAULT; | |
2217 | ||
2218 | return count; | |
2219 | } | |
2220 | ||
2221 | static ssize_t drm_fbdev_fb_write(struct fb_info *info, const char __user *buf, | |
2222 | size_t count, loff_t *ppos) | |
2223 | { | |
2224 | loff_t pos = *ppos; | |
2225 | size_t total_size; | |
2226 | ssize_t ret; | |
2227 | int err = 0; | |
2228 | ||
2229 | if (info->screen_size) | |
2230 | total_size = info->screen_size; | |
2231 | else | |
2232 | total_size = info->fix.smem_len; | |
2233 | ||
2234 | if (pos > total_size) | |
2235 | return -EFBIG; | |
2236 | if (count > total_size) { | |
2237 | err = -EFBIG; | |
2238 | count = total_size; | |
2239 | } | |
2240 | if (total_size - count < pos) { | |
2241 | if (!err) | |
2242 | err = -ENOSPC; | |
2243 | count = total_size - pos; | |
2244 | } | |
2245 | ||
2246 | /* | |
2247 | * Copy to framebuffer even if we already logged an error. Emulates | |
2248 | * the behavior of the original fbdev implementation. | |
2249 | */ | |
2250 | if (drm_fbdev_use_iomem(info)) | |
2251 | ret = fb_write_screen_base(info, buf, count, pos); | |
2252 | else | |
2253 | ret = fb_write_screen_buffer(info, buf, count, pos); | |
2254 | ||
2255 | if (ret > 0) | |
2256 | *ppos += ret; | |
2257 | ||
a102172c | 2258 | if (ret > 0) |
9622349e | 2259 | drm_fb_helper_damage(info, 0, 0, info->var.xres_virtual, info->var.yres_virtual); |
a102172c | 2260 | |
222ec45f TZ |
2261 | return ret ? ret : err; |
2262 | } | |
2263 | ||
2264 | static void drm_fbdev_fb_fillrect(struct fb_info *info, | |
2265 | const struct fb_fillrect *rect) | |
2266 | { | |
2267 | if (drm_fbdev_use_iomem(info)) | |
2268 | drm_fb_helper_cfb_fillrect(info, rect); | |
2269 | else | |
2270 | drm_fb_helper_sys_fillrect(info, rect); | |
2271 | } | |
2272 | ||
2273 | static void drm_fbdev_fb_copyarea(struct fb_info *info, | |
2274 | const struct fb_copyarea *area) | |
2275 | { | |
2276 | if (drm_fbdev_use_iomem(info)) | |
2277 | drm_fb_helper_cfb_copyarea(info, area); | |
2278 | else | |
2279 | drm_fb_helper_sys_copyarea(info, area); | |
2280 | } | |
2281 | ||
2282 | static void drm_fbdev_fb_imageblit(struct fb_info *info, | |
2283 | const struct fb_image *image) | |
2284 | { | |
2285 | if (drm_fbdev_use_iomem(info)) | |
2286 | drm_fb_helper_cfb_imageblit(info, image); | |
2287 | else | |
2288 | drm_fb_helper_sys_imageblit(info, image); | |
2289 | } | |
2290 | ||
b6ff753a | 2291 | static const struct fb_ops drm_fbdev_fb_ops = { |
d536540f NT |
2292 | .owner = THIS_MODULE, |
2293 | DRM_FB_HELPER_DEFAULT_OPS, | |
2294 | .fb_open = drm_fbdev_fb_open, | |
2295 | .fb_release = drm_fbdev_fb_release, | |
2296 | .fb_destroy = drm_fbdev_fb_destroy, | |
2297 | .fb_mmap = drm_fbdev_fb_mmap, | |
222ec45f TZ |
2298 | .fb_read = drm_fbdev_fb_read, |
2299 | .fb_write = drm_fbdev_fb_write, | |
2300 | .fb_fillrect = drm_fbdev_fb_fillrect, | |
2301 | .fb_copyarea = drm_fbdev_fb_copyarea, | |
2302 | .fb_imageblit = drm_fbdev_fb_imageblit, | |
d536540f NT |
2303 | }; |
2304 | ||
2305 | static struct fb_deferred_io drm_fbdev_defio = { | |
2306 | .delay = HZ / 20, | |
2307 | .deferred_io = drm_fb_helper_deferred_io, | |
2308 | }; | |
2309 | ||
47734835 | 2310 | /* |
c10802b6 | 2311 | * This function uses the client API to create a framebuffer backed by a dumb buffer. |
d536540f NT |
2312 | * |
2313 | * The _sys_ versions are used for &fb_ops.fb_read, fb_write, fb_fillrect, | |
2314 | * fb_copyarea, fb_imageblit. | |
d536540f | 2315 | */ |
47734835 DV |
2316 | static int drm_fb_helper_generic_probe(struct drm_fb_helper *fb_helper, |
2317 | struct drm_fb_helper_surface_size *sizes) | |
d536540f NT |
2318 | { |
2319 | struct drm_client_dev *client = &fb_helper->client; | |
f33b9730 | 2320 | struct drm_device *dev = fb_helper->dev; |
d536540f NT |
2321 | struct drm_client_buffer *buffer; |
2322 | struct drm_framebuffer *fb; | |
2323 | struct fb_info *fbi; | |
2324 | u32 format; | |
a8595556 TZ |
2325 | struct dma_buf_map map; |
2326 | int ret; | |
d536540f | 2327 | |
f33b9730 JN |
2328 | drm_dbg_kms(dev, "surface width(%d), height(%d) and bpp(%d)\n", |
2329 | sizes->surface_width, sizes->surface_height, | |
2330 | sizes->surface_bpp); | |
d536540f NT |
2331 | |
2332 | format = drm_mode_legacy_fb_format(sizes->surface_bpp, sizes->surface_depth); | |
2333 | buffer = drm_client_framebuffer_create(client, sizes->surface_width, | |
2334 | sizes->surface_height, format); | |
2335 | if (IS_ERR(buffer)) | |
2336 | return PTR_ERR(buffer); | |
2337 | ||
2338 | fb_helper->buffer = buffer; | |
2339 | fb_helper->fb = buffer->fb; | |
2340 | fb = buffer->fb; | |
2341 | ||
2342 | fbi = drm_fb_helper_alloc_fbi(fb_helper); | |
6e1490cf NT |
2343 | if (IS_ERR(fbi)) |
2344 | return PTR_ERR(fbi); | |
d536540f | 2345 | |
d536540f | 2346 | fbi->fbops = &drm_fbdev_fb_ops; |
18ac700d | 2347 | fbi->screen_size = sizes->surface_height * fb->pitches[0]; |
d536540f | 2348 | fbi->fix.smem_len = fbi->screen_size; |
cf1ca9ae | 2349 | |
3df3116a | 2350 | drm_fb_helper_fill_info(fbi, fb_helper, sizes); |
d536540f | 2351 | |
f458579e | 2352 | if (drm_fbdev_use_shadow_fb(fb_helper)) { |
57778075 JN |
2353 | fbi->screen_buffer = vzalloc(fbi->screen_size); |
2354 | if (!fbi->screen_buffer) | |
6e1490cf | 2355 | return -ENOMEM; |
d536540f | 2356 | |
d536540f NT |
2357 | fbi->fbdefio = &drm_fbdev_defio; |
2358 | ||
2359 | fb_deferred_io_init(fbi); | |
cf1ca9ae TZ |
2360 | } else { |
2361 | /* buffer is mapped for HW framebuffer */ | |
a8595556 TZ |
2362 | ret = drm_client_buffer_vmap(fb_helper->buffer, &map); |
2363 | if (ret) | |
2364 | return ret; | |
2365 | if (map.is_iomem) | |
2366 | fbi->screen_base = map.vaddr_iomem; | |
2367 | else | |
2368 | fbi->screen_buffer = map.vaddr; | |
cf1ca9ae | 2369 | |
a8595556 TZ |
2370 | /* |
2371 | * Shamelessly leak the physical address to user-space. As | |
2372 | * page_to_phys() is undefined for I/O memory, warn in this | |
2373 | * case. | |
2374 | */ | |
cf1ca9ae | 2375 | #if IS_ENABLED(CONFIG_DRM_FBDEV_LEAK_PHYS_SMEM) |
a8595556 TZ |
2376 | if (drm_leak_fbdev_smem && fbi->fix.smem_start == 0 && |
2377 | !drm_WARN_ON_ONCE(dev, map.is_iomem)) | |
cf1ca9ae TZ |
2378 | fbi->fix.smem_start = |
2379 | page_to_phys(virt_to_page(fbi->screen_buffer)); | |
2380 | #endif | |
d536540f NT |
2381 | } |
2382 | ||
2383 | return 0; | |
d536540f | 2384 | } |
d536540f | 2385 | |
9060d7f4 NT |
2386 | static const struct drm_fb_helper_funcs drm_fb_helper_generic_funcs = { |
2387 | .fb_probe = drm_fb_helper_generic_probe, | |
2388 | }; | |
2389 | ||
2390 | static void drm_fbdev_client_unregister(struct drm_client_dev *client) | |
2391 | { | |
2392 | struct drm_fb_helper *fb_helper = drm_fb_helper_from_client(client); | |
2393 | ||
6e1490cf | 2394 | if (fb_helper->fbdev) |
9060d7f4 | 2395 | /* drm_fbdev_fb_destroy() takes care of cleanup */ |
6e1490cf NT |
2396 | drm_fb_helper_unregister_fbi(fb_helper); |
2397 | else | |
2398 | drm_fbdev_release(fb_helper); | |
9060d7f4 NT |
2399 | } |
2400 | ||
2401 | static int drm_fbdev_client_restore(struct drm_client_dev *client) | |
2402 | { | |
78de14c2 | 2403 | drm_fb_helper_lastclose(client->dev); |
9060d7f4 NT |
2404 | |
2405 | return 0; | |
2406 | } | |
2407 | ||
2408 | static int drm_fbdev_client_hotplug(struct drm_client_dev *client) | |
2409 | { | |
2410 | struct drm_fb_helper *fb_helper = drm_fb_helper_from_client(client); | |
2411 | struct drm_device *dev = client->dev; | |
2412 | int ret; | |
2413 | ||
6e1490cf | 2414 | /* Setup is not retried if it has failed */ |
9060d7f4 NT |
2415 | if (!fb_helper->dev && fb_helper->funcs) |
2416 | return 0; | |
2417 | ||
2418 | if (dev->fb_helper) | |
2419 | return drm_fb_helper_hotplug_event(dev->fb_helper); | |
2420 | ||
c10802b6 | 2421 | if (!dev->mode_config.num_connector) { |
f33b9730 | 2422 | drm_dbg_kms(dev, "No connectors found, will not create framebuffer!\n"); |
9060d7f4 | 2423 | return 0; |
c10802b6 | 2424 | } |
9060d7f4 | 2425 | |
6e1490cf NT |
2426 | drm_fb_helper_prepare(dev, fb_helper, &drm_fb_helper_generic_funcs); |
2427 | ||
2dea2d11 | 2428 | ret = drm_fb_helper_init(dev, fb_helper); |
6e1490cf NT |
2429 | if (ret) |
2430 | goto err; | |
2431 | ||
6e1490cf NT |
2432 | if (!drm_drv_uses_atomic_modeset(dev)) |
2433 | drm_helper_disable_unused_functions(dev); | |
2434 | ||
2435 | ret = drm_fb_helper_initial_config(fb_helper, fb_helper->preferred_bpp); | |
2436 | if (ret) | |
2437 | goto err_cleanup; | |
9060d7f4 NT |
2438 | |
2439 | return 0; | |
6e1490cf NT |
2440 | |
2441 | err_cleanup: | |
2442 | drm_fbdev_cleanup(fb_helper); | |
2443 | err: | |
2444 | fb_helper->dev = NULL; | |
2445 | fb_helper->fbdev = NULL; | |
2446 | ||
f33b9730 | 2447 | drm_err(dev, "fbdev: Failed to setup generic emulation (ret=%d)\n", ret); |
6e1490cf NT |
2448 | |
2449 | return ret; | |
9060d7f4 NT |
2450 | } |
2451 | ||
2452 | static const struct drm_client_funcs drm_fbdev_client_funcs = { | |
2453 | .owner = THIS_MODULE, | |
2454 | .unregister = drm_fbdev_client_unregister, | |
2455 | .restore = drm_fbdev_client_restore, | |
2456 | .hotplug = drm_fbdev_client_hotplug, | |
2457 | }; | |
2458 | ||
2459 | /** | |
c10802b6 | 2460 | * drm_fbdev_generic_setup() - Setup generic fbdev emulation |
9060d7f4 NT |
2461 | * @dev: DRM device |
2462 | * @preferred_bpp: Preferred bits per pixel for the device. | |
2463 | * @dev->mode_config.preferred_depth is used if this is zero. | |
2464 | * | |
2465 | * This function sets up generic fbdev emulation for drivers that supports | |
8204f235 | 2466 | * dumb buffers with a virtual address and that can be mmap'ed. |
1aed9509 TZ |
2467 | * drm_fbdev_generic_setup() shall be called after the DRM driver registered |
2468 | * the new DRM device with drm_dev_register(). | |
9060d7f4 NT |
2469 | * |
2470 | * Restore, hotplug events and teardown are all taken care of. Drivers that do | |
2471 | * suspend/resume need to call drm_fb_helper_set_suspend_unlocked() themselves. | |
2472 | * Simple drivers might use drm_mode_config_helper_suspend(). | |
2473 | * | |
2474 | * Drivers that set the dirty callback on their framebuffer will get a shadow | |
2475 | * fbdev buffer that is blitted onto the real buffer. This is done in order to | |
8e86dee0 TZ |
2476 | * make deferred I/O work with all kinds of buffers. A shadow buffer can be |
2477 | * requested explicitly by setting struct drm_mode_config.prefer_shadow or | |
2478 | * struct drm_mode_config.prefer_shadow_fbdev to true beforehand. This is | |
2479 | * required to use generic fbdev emulation with SHMEM helpers. | |
9060d7f4 NT |
2480 | * |
2481 | * This function is safe to call even when there are no connectors present. | |
2482 | * Setup will be retried on the next hotplug event. | |
2483 | * | |
c10802b6 | 2484 | * The fbdev is destroyed by drm_dev_unregister(). |
9060d7f4 | 2485 | */ |
1aed9509 TZ |
2486 | void drm_fbdev_generic_setup(struct drm_device *dev, |
2487 | unsigned int preferred_bpp) | |
9060d7f4 NT |
2488 | { |
2489 | struct drm_fb_helper *fb_helper; | |
2490 | int ret; | |
2491 | ||
1aed9509 TZ |
2492 | drm_WARN(dev, !dev->registered, "Device has not been registered.\n"); |
2493 | drm_WARN(dev, dev->fb_helper, "fb_helper is already set!\n"); | |
c10802b6 | 2494 | |
9060d7f4 | 2495 | if (!drm_fbdev_emulation) |
1aed9509 | 2496 | return; |
9060d7f4 NT |
2497 | |
2498 | fb_helper = kzalloc(sizeof(*fb_helper), GFP_KERNEL); | |
1aed9509 TZ |
2499 | if (!fb_helper) { |
2500 | drm_err(dev, "Failed to allocate fb_helper\n"); | |
2501 | return; | |
2502 | } | |
9060d7f4 | 2503 | |
4d4c2d89 | 2504 | ret = drm_client_init(dev, &fb_helper->client, "fbdev", &drm_fbdev_client_funcs); |
9060d7f4 NT |
2505 | if (ret) { |
2506 | kfree(fb_helper); | |
f33b9730 | 2507 | drm_err(dev, "Failed to register client: %d\n", ret); |
1aed9509 | 2508 | return; |
9060d7f4 NT |
2509 | } |
2510 | ||
14c1e12b DV |
2511 | /* |
2512 | * FIXME: This mixes up depth with bpp, which results in a glorious | |
2513 | * mess, resulting in some drivers picking wrong fbdev defaults and | |
2514 | * others wrong preferred_depth defaults. | |
2515 | */ | |
6e1490cf NT |
2516 | if (!preferred_bpp) |
2517 | preferred_bpp = dev->mode_config.preferred_depth; | |
2518 | if (!preferred_bpp) | |
2519 | preferred_bpp = 32; | |
9060d7f4 NT |
2520 | fb_helper->preferred_bpp = preferred_bpp; |
2521 | ||
c10802b6 PW |
2522 | ret = drm_fbdev_client_hotplug(&fb_helper->client); |
2523 | if (ret) | |
f33b9730 | 2524 | drm_dbg_kms(dev, "client hotplug ret=%d\n", ret); |
9060d7f4 | 2525 | |
e33898a2 | 2526 | drm_client_register(&fb_helper->client); |
9060d7f4 NT |
2527 | } |
2528 | EXPORT_SYMBOL(drm_fbdev_generic_setup); |