1 /*
2 * Copyright © 2007 David Airlie
3 *
4 * Permission is hereby granted, free of charge, to any person obtaining a
5 * copy of this software and associated documentation files (the "Software"),
6 * to deal in the Software without restriction, including without limitation
7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8 * and/or sell copies of the Software, and to permit persons to whom the
9 * Software is furnished to do so, subject to the following conditions:
10 *
11 * The above copyright notice and this permission notice (including the next
12 * paragraph) shall be included in all copies or substantial portions of the
13 * Software.
14 *
15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
18 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
21 * DEALINGS IN THE SOFTWARE.
22 *
23 * Authors:
24 * David Airlie
25 */
26
27 #include <linux/module.h>
28 #include <linux/kernel.h>
29 #include <linux/errno.h>
30 #include <linux/string.h>
31 #include <linux/mm.h>
32 #include <linux/tty.h>
33 #include <linux/sysrq.h>
34 #include <linux/delay.h>
35 #include <linux/init.h>
36 #include <linux/screen_info.h>
37 #include <linux/vga_switcheroo.h>
38 #include <linux/console.h>
39
40 #include <drm/drmP.h>
41 #include <drm/drm_crtc.h>
42 #include <drm/drm_crtc_helper.h>
43 #include <drm/drm_fb_helper.h>
44 #include <drm/drm_atomic.h>
45
46 #include "nouveau_drv.h"
47 #include "nouveau_gem.h"
48 #include "nouveau_bo.h"
49 #include "nouveau_fbcon.h"
50 #include "nouveau_chan.h"
51
52 #include "nouveau_crtc.h"
53
54 MODULE_PARM_DESC(nofbaccel, "Disable fbcon acceleration");
55 int nouveau_nofbaccel = 0;
56 module_param_named(nofbaccel, nouveau_nofbaccel, int, 0400);
57
58 static void
nouveau_fbcon_fillrect(struct fb_info * info,const struct fb_fillrect * rect)59 nouveau_fbcon_fillrect(struct fb_info *info, const struct fb_fillrect *rect)
60 {
61 struct nouveau_fbdev *fbcon = info->par;
62 struct nouveau_drm *drm = nouveau_drm(fbcon->helper.dev);
63 struct nvif_device *device = &drm->client.device;
64 int ret;
65
66 if (info->state != FBINFO_STATE_RUNNING)
67 return;
68
69 ret = -ENODEV;
70 if (!in_interrupt() && !(info->flags & FBINFO_HWACCEL_DISABLED) &&
71 mutex_trylock(&drm->client.mutex)) {
72 if (device->info.family < NV_DEVICE_INFO_V0_TESLA)
73 ret = nv04_fbcon_fillrect(info, rect);
74 else
75 if (device->info.family < NV_DEVICE_INFO_V0_FERMI)
76 ret = nv50_fbcon_fillrect(info, rect);
77 else
78 ret = nvc0_fbcon_fillrect(info, rect);
79 mutex_unlock(&drm->client.mutex);
80 }
81
82 if (ret == 0)
83 return;
84
85 if (ret != -ENODEV)
86 nouveau_fbcon_gpu_lockup(info);
87 drm_fb_helper_cfb_fillrect(info, rect);
88 }
89
90 static void
nouveau_fbcon_copyarea(struct fb_info * info,const struct fb_copyarea * image)91 nouveau_fbcon_copyarea(struct fb_info *info, const struct fb_copyarea *image)
92 {
93 struct nouveau_fbdev *fbcon = info->par;
94 struct nouveau_drm *drm = nouveau_drm(fbcon->helper.dev);
95 struct nvif_device *device = &drm->client.device;
96 int ret;
97
98 if (info->state != FBINFO_STATE_RUNNING)
99 return;
100
101 ret = -ENODEV;
102 if (!in_interrupt() && !(info->flags & FBINFO_HWACCEL_DISABLED) &&
103 mutex_trylock(&drm->client.mutex)) {
104 if (device->info.family < NV_DEVICE_INFO_V0_TESLA)
105 ret = nv04_fbcon_copyarea(info, image);
106 else
107 if (device->info.family < NV_DEVICE_INFO_V0_FERMI)
108 ret = nv50_fbcon_copyarea(info, image);
109 else
110 ret = nvc0_fbcon_copyarea(info, image);
111 mutex_unlock(&drm->client.mutex);
112 }
113
114 if (ret == 0)
115 return;
116
117 if (ret != -ENODEV)
118 nouveau_fbcon_gpu_lockup(info);
119 drm_fb_helper_cfb_copyarea(info, image);
120 }
121
122 static void
nouveau_fbcon_imageblit(struct fb_info * info,const struct fb_image * image)123 nouveau_fbcon_imageblit(struct fb_info *info, const struct fb_image *image)
124 {
125 struct nouveau_fbdev *fbcon = info->par;
126 struct nouveau_drm *drm = nouveau_drm(fbcon->helper.dev);
127 struct nvif_device *device = &drm->client.device;
128 int ret;
129
130 if (info->state != FBINFO_STATE_RUNNING)
131 return;
132
133 ret = -ENODEV;
134 if (!in_interrupt() && !(info->flags & FBINFO_HWACCEL_DISABLED) &&
135 mutex_trylock(&drm->client.mutex)) {
136 if (device->info.family < NV_DEVICE_INFO_V0_TESLA)
137 ret = nv04_fbcon_imageblit(info, image);
138 else
139 if (device->info.family < NV_DEVICE_INFO_V0_FERMI)
140 ret = nv50_fbcon_imageblit(info, image);
141 else
142 ret = nvc0_fbcon_imageblit(info, image);
143 mutex_unlock(&drm->client.mutex);
144 }
145
146 if (ret == 0)
147 return;
148
149 if (ret != -ENODEV)
150 nouveau_fbcon_gpu_lockup(info);
151 drm_fb_helper_cfb_imageblit(info, image);
152 }
153
154 static int
nouveau_fbcon_sync(struct fb_info * info)155 nouveau_fbcon_sync(struct fb_info *info)
156 {
157 struct nouveau_fbdev *fbcon = info->par;
158 struct nouveau_drm *drm = nouveau_drm(fbcon->helper.dev);
159 struct nouveau_channel *chan = drm->channel;
160 int ret;
161
162 if (!chan || !chan->accel_done || in_interrupt() ||
163 info->state != FBINFO_STATE_RUNNING ||
164 info->flags & FBINFO_HWACCEL_DISABLED)
165 return 0;
166
167 if (!mutex_trylock(&drm->client.mutex))
168 return 0;
169
170 ret = nouveau_channel_idle(chan);
171 mutex_unlock(&drm->client.mutex);
172 if (ret) {
173 nouveau_fbcon_gpu_lockup(info);
174 return 0;
175 }
176
177 chan->accel_done = false;
178 return 0;
179 }
180
181 static int
nouveau_fbcon_open(struct fb_info * info,int user)182 nouveau_fbcon_open(struct fb_info *info, int user)
183 {
184 struct nouveau_fbdev *fbcon = info->par;
185 struct nouveau_drm *drm = nouveau_drm(fbcon->helper.dev);
186 int ret = pm_runtime_get_sync(drm->dev->dev);
187 if (ret < 0 && ret != -EACCES)
188 return ret;
189 return 0;
190 }
191
192 static int
nouveau_fbcon_release(struct fb_info * info,int user)193 nouveau_fbcon_release(struct fb_info *info, int user)
194 {
195 struct nouveau_fbdev *fbcon = info->par;
196 struct nouveau_drm *drm = nouveau_drm(fbcon->helper.dev);
197 pm_runtime_put(drm->dev->dev);
198 return 0;
199 }
200
201 static struct fb_ops nouveau_fbcon_ops = {
202 .owner = THIS_MODULE,
203 DRM_FB_HELPER_DEFAULT_OPS,
204 .fb_open = nouveau_fbcon_open,
205 .fb_release = nouveau_fbcon_release,
206 .fb_fillrect = nouveau_fbcon_fillrect,
207 .fb_copyarea = nouveau_fbcon_copyarea,
208 .fb_imageblit = nouveau_fbcon_imageblit,
209 .fb_sync = nouveau_fbcon_sync,
210 };
211
212 static struct fb_ops nouveau_fbcon_sw_ops = {
213 .owner = THIS_MODULE,
214 DRM_FB_HELPER_DEFAULT_OPS,
215 .fb_open = nouveau_fbcon_open,
216 .fb_release = nouveau_fbcon_release,
217 .fb_fillrect = drm_fb_helper_cfb_fillrect,
218 .fb_copyarea = drm_fb_helper_cfb_copyarea,
219 .fb_imageblit = drm_fb_helper_cfb_imageblit,
220 };
221
222 void
nouveau_fbcon_accel_save_disable(struct drm_device * dev)223 nouveau_fbcon_accel_save_disable(struct drm_device *dev)
224 {
225 struct nouveau_drm *drm = nouveau_drm(dev);
226 if (drm->fbcon && drm->fbcon->helper.fbdev) {
227 drm->fbcon->saved_flags = drm->fbcon->helper.fbdev->flags;
228 drm->fbcon->helper.fbdev->flags |= FBINFO_HWACCEL_DISABLED;
229 }
230 }
231
232 void
nouveau_fbcon_accel_restore(struct drm_device * dev)233 nouveau_fbcon_accel_restore(struct drm_device *dev)
234 {
235 struct nouveau_drm *drm = nouveau_drm(dev);
236 if (drm->fbcon && drm->fbcon->helper.fbdev) {
237 drm->fbcon->helper.fbdev->flags = drm->fbcon->saved_flags;
238 }
239 }
240
241 static void
nouveau_fbcon_accel_fini(struct drm_device * dev)242 nouveau_fbcon_accel_fini(struct drm_device *dev)
243 {
244 struct nouveau_drm *drm = nouveau_drm(dev);
245 struct nouveau_fbdev *fbcon = drm->fbcon;
246 if (fbcon && drm->channel) {
247 console_lock();
248 if (fbcon->helper.fbdev)
249 fbcon->helper.fbdev->flags |= FBINFO_HWACCEL_DISABLED;
250 console_unlock();
251 nouveau_channel_idle(drm->channel);
252 nvif_object_fini(&fbcon->twod);
253 nvif_object_fini(&fbcon->blit);
254 nvif_object_fini(&fbcon->gdi);
255 nvif_object_fini(&fbcon->patt);
256 nvif_object_fini(&fbcon->rop);
257 nvif_object_fini(&fbcon->clip);
258 nvif_object_fini(&fbcon->surf2d);
259 }
260 }
261
262 static void
nouveau_fbcon_accel_init(struct drm_device * dev)263 nouveau_fbcon_accel_init(struct drm_device *dev)
264 {
265 struct nouveau_drm *drm = nouveau_drm(dev);
266 struct nouveau_fbdev *fbcon = drm->fbcon;
267 struct fb_info *info = fbcon->helper.fbdev;
268 int ret;
269
270 if (drm->client.device.info.family < NV_DEVICE_INFO_V0_TESLA)
271 ret = nv04_fbcon_accel_init(info);
272 else
273 if (drm->client.device.info.family < NV_DEVICE_INFO_V0_FERMI)
274 ret = nv50_fbcon_accel_init(info);
275 else
276 ret = nvc0_fbcon_accel_init(info);
277
278 if (ret == 0)
279 info->fbops = &nouveau_fbcon_ops;
280 }
281
282 static void
nouveau_fbcon_zfill(struct drm_device * dev,struct nouveau_fbdev * fbcon)283 nouveau_fbcon_zfill(struct drm_device *dev, struct nouveau_fbdev *fbcon)
284 {
285 struct fb_info *info = fbcon->helper.fbdev;
286 struct fb_fillrect rect;
287
288 /* Clear the entire fbcon. The drm will program every connector
289 * with it's preferred mode. If the sizes differ, one display will
290 * quite likely have garbage around the console.
291 */
292 rect.dx = rect.dy = 0;
293 rect.width = info->var.xres_virtual;
294 rect.height = info->var.yres_virtual;
295 rect.color = 0;
296 rect.rop = ROP_COPY;
297 info->fbops->fb_fillrect(info, &rect);
298 }
299
300 static int
nouveau_fbcon_create(struct drm_fb_helper * helper,struct drm_fb_helper_surface_size * sizes)301 nouveau_fbcon_create(struct drm_fb_helper *helper,
302 struct drm_fb_helper_surface_size *sizes)
303 {
304 struct nouveau_fbdev *fbcon =
305 container_of(helper, struct nouveau_fbdev, helper);
306 struct drm_device *dev = fbcon->helper.dev;
307 struct nouveau_drm *drm = nouveau_drm(dev);
308 struct nvif_device *device = &drm->client.device;
309 struct fb_info *info;
310 struct nouveau_framebuffer *fb;
311 struct nouveau_channel *chan;
312 struct nouveau_bo *nvbo;
313 struct drm_mode_fb_cmd2 mode_cmd;
314 int ret;
315
316 mode_cmd.width = sizes->surface_width;
317 mode_cmd.height = sizes->surface_height;
318
319 mode_cmd.pitches[0] = mode_cmd.width * (sizes->surface_bpp >> 3);
320 mode_cmd.pitches[0] = roundup(mode_cmd.pitches[0], 256);
321
322 mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
323 sizes->surface_depth);
324
325 ret = nouveau_gem_new(&drm->client, mode_cmd.pitches[0] *
326 mode_cmd.height, 0, NOUVEAU_GEM_DOMAIN_VRAM,
327 0, 0x0000, &nvbo);
328 if (ret) {
329 NV_ERROR(drm, "failed to allocate framebuffer\n");
330 goto out;
331 }
332
333 ret = nouveau_framebuffer_new(dev, &mode_cmd, nvbo, &fb);
334 if (ret)
335 goto out_unref;
336
337 ret = nouveau_bo_pin(nvbo, TTM_PL_FLAG_VRAM, false);
338 if (ret) {
339 NV_ERROR(drm, "failed to pin fb: %d\n", ret);
340 goto out_unref;
341 }
342
343 ret = nouveau_bo_map(nvbo);
344 if (ret) {
345 NV_ERROR(drm, "failed to map fb: %d\n", ret);
346 goto out_unpin;
347 }
348
349 chan = nouveau_nofbaccel ? NULL : drm->channel;
350 if (chan && device->info.family >= NV_DEVICE_INFO_V0_TESLA) {
351 ret = nouveau_bo_vma_add(nvbo, drm->client.vm, &fb->vma);
352 if (ret) {
353 NV_ERROR(drm, "failed to map fb into chan: %d\n", ret);
354 chan = NULL;
355 }
356 }
357
358 info = drm_fb_helper_alloc_fbi(helper);
359 if (IS_ERR(info)) {
360 ret = PTR_ERR(info);
361 goto out_unlock;
362 }
363 info->skip_vt_switch = 1;
364
365 info->par = fbcon;
366
367 /* setup helper */
368 fbcon->helper.fb = &fb->base;
369
370 strcpy(info->fix.id, "nouveaufb");
371 if (!chan)
372 info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_DISABLED;
373 else
374 info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_COPYAREA |
375 FBINFO_HWACCEL_FILLRECT |
376 FBINFO_HWACCEL_IMAGEBLIT;
377 info->flags |= FBINFO_CAN_FORCE_OUTPUT;
378 info->fbops = &nouveau_fbcon_sw_ops;
379 info->fix.smem_start = fb->nvbo->bo.mem.bus.base +
380 fb->nvbo->bo.mem.bus.offset;
381 info->fix.smem_len = fb->nvbo->bo.mem.num_pages << PAGE_SHIFT;
382
383 info->screen_base = nvbo_kmap_obj_iovirtual(fb->nvbo);
384 info->screen_size = fb->nvbo->bo.mem.num_pages << PAGE_SHIFT;
385
386 drm_fb_helper_fill_fix(info, fb->base.pitches[0],
387 fb->base.format->depth);
388 drm_fb_helper_fill_var(info, &fbcon->helper, sizes->fb_width, sizes->fb_height);
389
390 /* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
391
392 if (chan)
393 nouveau_fbcon_accel_init(dev);
394 nouveau_fbcon_zfill(dev, fbcon);
395
396 /* To allow resizeing without swapping buffers */
397 NV_INFO(drm, "allocated %dx%d fb: 0x%llx, bo %p\n",
398 fb->base.width, fb->base.height, fb->nvbo->bo.offset, nvbo);
399
400 vga_switcheroo_client_fb_set(dev->pdev, info);
401 return 0;
402
403 out_unlock:
404 if (chan)
405 nouveau_bo_vma_del(fb->nvbo, &fb->vma);
406 nouveau_bo_unmap(fb->nvbo);
407 out_unpin:
408 nouveau_bo_unpin(fb->nvbo);
409 out_unref:
410 nouveau_bo_ref(NULL, &fb->nvbo);
411 out:
412 return ret;
413 }
414
415 void
nouveau_fbcon_output_poll_changed(struct drm_device * dev)416 nouveau_fbcon_output_poll_changed(struct drm_device *dev)
417 {
418 struct nouveau_drm *drm = nouveau_drm(dev);
419 if (drm->fbcon)
420 drm_fb_helper_hotplug_event(&drm->fbcon->helper);
421 }
422
423 static int
nouveau_fbcon_destroy(struct drm_device * dev,struct nouveau_fbdev * fbcon)424 nouveau_fbcon_destroy(struct drm_device *dev, struct nouveau_fbdev *fbcon)
425 {
426 struct nouveau_framebuffer *nouveau_fb = nouveau_framebuffer(fbcon->helper.fb);
427
428 drm_fb_helper_unregister_fbi(&fbcon->helper);
429 drm_fb_helper_fini(&fbcon->helper);
430
431 if (nouveau_fb->nvbo) {
432 nouveau_bo_vma_del(nouveau_fb->nvbo, &nouveau_fb->vma);
433 nouveau_bo_unmap(nouveau_fb->nvbo);
434 nouveau_bo_unpin(nouveau_fb->nvbo);
435 drm_framebuffer_unreference(&nouveau_fb->base);
436 }
437
438 return 0;
439 }
440
nouveau_fbcon_gpu_lockup(struct fb_info * info)441 void nouveau_fbcon_gpu_lockup(struct fb_info *info)
442 {
443 struct nouveau_fbdev *fbcon = info->par;
444 struct nouveau_drm *drm = nouveau_drm(fbcon->helper.dev);
445
446 NV_ERROR(drm, "GPU lockup - switching to software fbcon\n");
447 info->flags |= FBINFO_HWACCEL_DISABLED;
448 }
449
450 static const struct drm_fb_helper_funcs nouveau_fbcon_helper_funcs = {
451 .fb_probe = nouveau_fbcon_create,
452 };
453
454 static void
nouveau_fbcon_set_suspend_work(struct work_struct * work)455 nouveau_fbcon_set_suspend_work(struct work_struct *work)
456 {
457 struct nouveau_drm *drm = container_of(work, typeof(*drm), fbcon_work);
458 int state = READ_ONCE(drm->fbcon_new_state);
459
460 if (state == FBINFO_STATE_RUNNING)
461 pm_runtime_get_sync(drm->dev->dev);
462
463 console_lock();
464 if (state == FBINFO_STATE_RUNNING)
465 nouveau_fbcon_accel_restore(drm->dev);
466 drm_fb_helper_set_suspend(&drm->fbcon->helper, state);
467 if (state != FBINFO_STATE_RUNNING)
468 nouveau_fbcon_accel_save_disable(drm->dev);
469 console_unlock();
470
471 if (state == FBINFO_STATE_RUNNING) {
472 pm_runtime_mark_last_busy(drm->dev->dev);
473 pm_runtime_put_sync(drm->dev->dev);
474 }
475 }
476
477 void
nouveau_fbcon_set_suspend(struct drm_device * dev,int state)478 nouveau_fbcon_set_suspend(struct drm_device *dev, int state)
479 {
480 struct nouveau_drm *drm = nouveau_drm(dev);
481
482 if (!drm->fbcon)
483 return;
484
485 drm->fbcon_new_state = state;
486 /* Since runtime resume can happen as a result of a sysfs operation,
487 * it's possible we already have the console locked. So handle fbcon
488 * init/deinit from a seperate work thread
489 */
490 schedule_work(&drm->fbcon_work);
491 }
492
493 int
nouveau_fbcon_init(struct drm_device * dev)494 nouveau_fbcon_init(struct drm_device *dev)
495 {
496 struct nouveau_drm *drm = nouveau_drm(dev);
497 struct nouveau_fbdev *fbcon;
498 int preferred_bpp;
499 int ret;
500
501 if (!dev->mode_config.num_crtc ||
502 (dev->pdev->class >> 8) != PCI_CLASS_DISPLAY_VGA)
503 return 0;
504
505 fbcon = kzalloc(sizeof(struct nouveau_fbdev), GFP_KERNEL);
506 if (!fbcon)
507 return -ENOMEM;
508
509 drm->fbcon = fbcon;
510 INIT_WORK(&drm->fbcon_work, nouveau_fbcon_set_suspend_work);
511
512 drm_fb_helper_prepare(dev, &fbcon->helper, &nouveau_fbcon_helper_funcs);
513
514 ret = drm_fb_helper_init(dev, &fbcon->helper, 4);
515 if (ret)
516 goto free;
517
518 ret = drm_fb_helper_single_add_all_connectors(&fbcon->helper);
519 if (ret)
520 goto fini;
521
522 if (drm->client.device.info.ram_size <= 32 * 1024 * 1024)
523 preferred_bpp = 8;
524 else
525 if (drm->client.device.info.ram_size <= 64 * 1024 * 1024)
526 preferred_bpp = 16;
527 else
528 preferred_bpp = 32;
529
530 /* disable all the possible outputs/crtcs before entering KMS mode */
531 if (!drm_drv_uses_atomic_modeset(dev))
532 drm_helper_disable_unused_functions(dev);
533
534 ret = drm_fb_helper_initial_config(&fbcon->helper, preferred_bpp);
535 if (ret)
536 goto fini;
537
538 if (fbcon->helper.fbdev)
539 fbcon->helper.fbdev->pixmap.buf_align = 4;
540 return 0;
541
542 fini:
543 drm_fb_helper_fini(&fbcon->helper);
544 free:
545 kfree(fbcon);
546 return ret;
547 }
548
549 void
nouveau_fbcon_fini(struct drm_device * dev)550 nouveau_fbcon_fini(struct drm_device *dev)
551 {
552 struct nouveau_drm *drm = nouveau_drm(dev);
553
554 if (!drm->fbcon)
555 return;
556
557 nouveau_fbcon_accel_fini(dev);
558 nouveau_fbcon_destroy(dev, drm->fbcon);
559 kfree(drm->fbcon);
560 drm->fbcon = NULL;
561 }
562