OSDN Git Service

Merge 4.4.163 into android-4.4
[sagit-ice-cold/kernel_xiaomi_msm8998.git] / drivers / gpu / drm / nouveau / nouveau_fbcon.c
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/fb.h>
36 #include <linux/init.h>
37 #include <linux/screen_info.h>
38 #include <linux/vga_switcheroo.h>
39 #include <linux/console.h>
40
41 #include <drm/drmP.h>
42 #include <drm/drm_crtc.h>
43 #include <drm/drm_crtc_helper.h>
44 #include <drm/drm_fb_helper.h>
45
46 #include "nouveau_drm.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
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->dev);
63         struct nvif_device *device = &drm->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
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->dev);
95         struct nvif_device *device = &drm->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
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->dev);
127         struct nvif_device *device = &drm->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
155 nouveau_fbcon_sync(struct fb_info *info)
156 {
157         struct nouveau_fbdev *fbcon = info->par;
158         struct nouveau_drm *drm = nouveau_drm(fbcon->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
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->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
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->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         .fb_open = nouveau_fbcon_open,
204         .fb_release = nouveau_fbcon_release,
205         .fb_check_var = drm_fb_helper_check_var,
206         .fb_set_par = drm_fb_helper_set_par,
207         .fb_fillrect = nouveau_fbcon_fillrect,
208         .fb_copyarea = nouveau_fbcon_copyarea,
209         .fb_imageblit = nouveau_fbcon_imageblit,
210         .fb_sync = nouveau_fbcon_sync,
211         .fb_pan_display = drm_fb_helper_pan_display,
212         .fb_blank = drm_fb_helper_blank,
213         .fb_setcmap = drm_fb_helper_setcmap,
214         .fb_debug_enter = drm_fb_helper_debug_enter,
215         .fb_debug_leave = drm_fb_helper_debug_leave,
216 };
217
218 static struct fb_ops nouveau_fbcon_sw_ops = {
219         .owner = THIS_MODULE,
220         .fb_open = nouveau_fbcon_open,
221         .fb_release = nouveau_fbcon_release,
222         .fb_check_var = drm_fb_helper_check_var,
223         .fb_set_par = drm_fb_helper_set_par,
224         .fb_fillrect = drm_fb_helper_cfb_fillrect,
225         .fb_copyarea = drm_fb_helper_cfb_copyarea,
226         .fb_imageblit = drm_fb_helper_cfb_imageblit,
227         .fb_pan_display = drm_fb_helper_pan_display,
228         .fb_blank = drm_fb_helper_blank,
229         .fb_setcmap = drm_fb_helper_setcmap,
230         .fb_debug_enter = drm_fb_helper_debug_enter,
231         .fb_debug_leave = drm_fb_helper_debug_leave,
232 };
233
234 void
235 nouveau_fbcon_accel_save_disable(struct drm_device *dev)
236 {
237         struct nouveau_drm *drm = nouveau_drm(dev);
238         if (drm->fbcon && drm->fbcon->helper.fbdev) {
239                 drm->fbcon->saved_flags = drm->fbcon->helper.fbdev->flags;
240                 drm->fbcon->helper.fbdev->flags |= FBINFO_HWACCEL_DISABLED;
241         }
242 }
243
244 void
245 nouveau_fbcon_accel_restore(struct drm_device *dev)
246 {
247         struct nouveau_drm *drm = nouveau_drm(dev);
248         if (drm->fbcon && drm->fbcon->helper.fbdev) {
249                 drm->fbcon->helper.fbdev->flags = drm->fbcon->saved_flags;
250         }
251 }
252
253 static void
254 nouveau_fbcon_accel_fini(struct drm_device *dev)
255 {
256         struct nouveau_drm *drm = nouveau_drm(dev);
257         struct nouveau_fbdev *fbcon = drm->fbcon;
258         if (fbcon && drm->channel) {
259                 console_lock();
260                 if (fbcon->helper.fbdev)
261                         fbcon->helper.fbdev->flags |= FBINFO_HWACCEL_DISABLED;
262                 console_unlock();
263                 nouveau_channel_idle(drm->channel);
264                 nvif_object_fini(&fbcon->twod);
265                 nvif_object_fini(&fbcon->blit);
266                 nvif_object_fini(&fbcon->gdi);
267                 nvif_object_fini(&fbcon->patt);
268                 nvif_object_fini(&fbcon->rop);
269                 nvif_object_fini(&fbcon->clip);
270                 nvif_object_fini(&fbcon->surf2d);
271         }
272 }
273
274 static void
275 nouveau_fbcon_accel_init(struct drm_device *dev)
276 {
277         struct nouveau_drm *drm = nouveau_drm(dev);
278         struct nouveau_fbdev *fbcon = drm->fbcon;
279         struct fb_info *info = fbcon->helper.fbdev;
280         int ret;
281
282         if (drm->device.info.family < NV_DEVICE_INFO_V0_TESLA)
283                 ret = nv04_fbcon_accel_init(info);
284         else
285         if (drm->device.info.family < NV_DEVICE_INFO_V0_FERMI)
286                 ret = nv50_fbcon_accel_init(info);
287         else
288                 ret = nvc0_fbcon_accel_init(info);
289
290         if (ret == 0)
291                 info->fbops = &nouveau_fbcon_ops;
292 }
293
294 static void nouveau_fbcon_gamma_set(struct drm_crtc *crtc, u16 red, u16 green,
295                                     u16 blue, int regno)
296 {
297         struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
298
299         nv_crtc->lut.r[regno] = red;
300         nv_crtc->lut.g[regno] = green;
301         nv_crtc->lut.b[regno] = blue;
302 }
303
304 static void nouveau_fbcon_gamma_get(struct drm_crtc *crtc, u16 *red, u16 *green,
305                                     u16 *blue, int regno)
306 {
307         struct nouveau_crtc *nv_crtc = nouveau_crtc(crtc);
308
309         *red = nv_crtc->lut.r[regno];
310         *green = nv_crtc->lut.g[regno];
311         *blue = nv_crtc->lut.b[regno];
312 }
313
314 static void
315 nouveau_fbcon_zfill(struct drm_device *dev, struct nouveau_fbdev *fbcon)
316 {
317         struct fb_info *info = fbcon->helper.fbdev;
318         struct fb_fillrect rect;
319
320         /* Clear the entire fbcon.  The drm will program every connector
321          * with it's preferred mode.  If the sizes differ, one display will
322          * quite likely have garbage around the console.
323          */
324         rect.dx = rect.dy = 0;
325         rect.width = info->var.xres_virtual;
326         rect.height = info->var.yres_virtual;
327         rect.color = 0;
328         rect.rop = ROP_COPY;
329         info->fbops->fb_fillrect(info, &rect);
330 }
331
332 static int
333 nouveau_fbcon_create(struct drm_fb_helper *helper,
334                      struct drm_fb_helper_surface_size *sizes)
335 {
336         struct nouveau_fbdev *fbcon =
337                 container_of(helper, struct nouveau_fbdev, helper);
338         struct drm_device *dev = fbcon->dev;
339         struct nouveau_drm *drm = nouveau_drm(dev);
340         struct nvif_device *device = &drm->device;
341         struct fb_info *info;
342         struct drm_framebuffer *fb;
343         struct nouveau_framebuffer *nouveau_fb;
344         struct nouveau_channel *chan;
345         struct nouveau_bo *nvbo;
346         struct drm_mode_fb_cmd2 mode_cmd;
347         int size, ret;
348
349         mode_cmd.width = sizes->surface_width;
350         mode_cmd.height = sizes->surface_height;
351
352         mode_cmd.pitches[0] = mode_cmd.width * (sizes->surface_bpp >> 3);
353         mode_cmd.pitches[0] = roundup(mode_cmd.pitches[0], 256);
354
355         mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
356                                                           sizes->surface_depth);
357
358         size = mode_cmd.pitches[0] * mode_cmd.height;
359         size = roundup(size, PAGE_SIZE);
360
361         ret = nouveau_gem_new(dev, size, 0, NOUVEAU_GEM_DOMAIN_VRAM,
362                               0, 0x0000, &nvbo);
363         if (ret) {
364                 NV_ERROR(drm, "failed to allocate framebuffer\n");
365                 goto out;
366         }
367
368         ret = nouveau_bo_pin(nvbo, TTM_PL_FLAG_VRAM, false);
369         if (ret) {
370                 NV_ERROR(drm, "failed to pin fb: %d\n", ret);
371                 goto out_unref;
372         }
373
374         ret = nouveau_bo_map(nvbo);
375         if (ret) {
376                 NV_ERROR(drm, "failed to map fb: %d\n", ret);
377                 goto out_unpin;
378         }
379
380         chan = nouveau_nofbaccel ? NULL : drm->channel;
381         if (chan && device->info.family >= NV_DEVICE_INFO_V0_TESLA) {
382                 ret = nouveau_bo_vma_add(nvbo, drm->client.vm,
383                                         &fbcon->nouveau_fb.vma);
384                 if (ret) {
385                         NV_ERROR(drm, "failed to map fb into chan: %d\n", ret);
386                         chan = NULL;
387                 }
388         }
389
390         mutex_lock(&dev->struct_mutex);
391
392         info = drm_fb_helper_alloc_fbi(helper);
393         if (IS_ERR(info)) {
394                 ret = PTR_ERR(info);
395                 goto out_unlock;
396         }
397         info->skip_vt_switch = 1;
398
399         info->par = fbcon;
400
401         nouveau_framebuffer_init(dev, &fbcon->nouveau_fb, &mode_cmd, nvbo);
402
403         nouveau_fb = &fbcon->nouveau_fb;
404         fb = &nouveau_fb->base;
405
406         /* setup helper */
407         fbcon->helper.fb = fb;
408
409         strcpy(info->fix.id, "nouveaufb");
410         if (!chan)
411                 info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_DISABLED;
412         else
413                 info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_COPYAREA |
414                               FBINFO_HWACCEL_FILLRECT |
415                               FBINFO_HWACCEL_IMAGEBLIT;
416         info->flags |= FBINFO_CAN_FORCE_OUTPUT;
417         info->fbops = &nouveau_fbcon_sw_ops;
418         info->fix.smem_start = nvbo->bo.mem.bus.base +
419                                nvbo->bo.mem.bus.offset;
420         info->fix.smem_len = size;
421
422         info->screen_base = nvbo_kmap_obj_iovirtual(nouveau_fb->nvbo);
423         info->screen_size = size;
424
425         drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth);
426         drm_fb_helper_fill_var(info, &fbcon->helper, sizes->fb_width, sizes->fb_height);
427
428         /* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
429
430         mutex_unlock(&dev->struct_mutex);
431
432         if (chan)
433                 nouveau_fbcon_accel_init(dev);
434         nouveau_fbcon_zfill(dev, fbcon);
435
436         /* To allow resizeing without swapping buffers */
437         NV_INFO(drm, "allocated %dx%d fb: 0x%llx, bo %p\n",
438                 nouveau_fb->base.width, nouveau_fb->base.height,
439                 nvbo->bo.offset, nvbo);
440
441         vga_switcheroo_client_fb_set(dev->pdev, info);
442         return 0;
443
444 out_unlock:
445         mutex_unlock(&dev->struct_mutex);
446         if (chan)
447                 nouveau_bo_vma_del(nvbo, &fbcon->nouveau_fb.vma);
448         nouveau_bo_unmap(nvbo);
449 out_unpin:
450         nouveau_bo_unpin(nvbo);
451 out_unref:
452         nouveau_bo_ref(NULL, &nvbo);
453 out:
454         return ret;
455 }
456
457 void
458 nouveau_fbcon_output_poll_changed(struct drm_device *dev)
459 {
460         struct nouveau_drm *drm = nouveau_drm(dev);
461         if (drm->fbcon)
462                 drm_fb_helper_hotplug_event(&drm->fbcon->helper);
463 }
464
465 static int
466 nouveau_fbcon_destroy(struct drm_device *dev, struct nouveau_fbdev *fbcon)
467 {
468         struct nouveau_framebuffer *nouveau_fb = &fbcon->nouveau_fb;
469
470         drm_fb_helper_unregister_fbi(&fbcon->helper);
471         drm_fb_helper_release_fbi(&fbcon->helper);
472
473         if (nouveau_fb->nvbo) {
474                 nouveau_bo_unmap(nouveau_fb->nvbo);
475                 nouveau_bo_vma_del(nouveau_fb->nvbo, &nouveau_fb->vma);
476                 nouveau_bo_unpin(nouveau_fb->nvbo);
477                 drm_gem_object_unreference_unlocked(&nouveau_fb->nvbo->gem);
478                 nouveau_fb->nvbo = NULL;
479         }
480         drm_fb_helper_fini(&fbcon->helper);
481         drm_framebuffer_unregister_private(&nouveau_fb->base);
482         drm_framebuffer_cleanup(&nouveau_fb->base);
483         return 0;
484 }
485
486 void nouveau_fbcon_gpu_lockup(struct fb_info *info)
487 {
488         struct nouveau_fbdev *fbcon = info->par;
489         struct nouveau_drm *drm = nouveau_drm(fbcon->dev);
490
491         NV_ERROR(drm, "GPU lockup - switching to software fbcon\n");
492         info->flags |= FBINFO_HWACCEL_DISABLED;
493 }
494
495 static const struct drm_fb_helper_funcs nouveau_fbcon_helper_funcs = {
496         .gamma_set = nouveau_fbcon_gamma_set,
497         .gamma_get = nouveau_fbcon_gamma_get,
498         .fb_probe = nouveau_fbcon_create,
499 };
500
501 void
502 nouveau_fbcon_set_suspend(struct drm_device *dev, int state)
503 {
504         struct nouveau_drm *drm = nouveau_drm(dev);
505         if (drm->fbcon) {
506                 console_lock();
507                 if (state == FBINFO_STATE_RUNNING)
508                         nouveau_fbcon_accel_restore(dev);
509                 drm_fb_helper_set_suspend(&drm->fbcon->helper, state);
510                 if (state != FBINFO_STATE_RUNNING)
511                         nouveau_fbcon_accel_save_disable(dev);
512                 console_unlock();
513         }
514 }
515
516 int
517 nouveau_fbcon_init(struct drm_device *dev)
518 {
519         struct nouveau_drm *drm = nouveau_drm(dev);
520         struct nouveau_fbdev *fbcon;
521         int preferred_bpp;
522         int ret;
523
524         if (!dev->mode_config.num_crtc ||
525             (dev->pdev->class >> 8) != PCI_CLASS_DISPLAY_VGA)
526                 return 0;
527
528         fbcon = kzalloc(sizeof(struct nouveau_fbdev), GFP_KERNEL);
529         if (!fbcon)
530                 return -ENOMEM;
531
532         fbcon->dev = dev;
533         drm->fbcon = fbcon;
534
535         drm_fb_helper_prepare(dev, &fbcon->helper, &nouveau_fbcon_helper_funcs);
536
537         ret = drm_fb_helper_init(dev, &fbcon->helper,
538                                  dev->mode_config.num_crtc, 4);
539         if (ret)
540                 goto free;
541
542         ret = drm_fb_helper_single_add_all_connectors(&fbcon->helper);
543         if (ret)
544                 goto fini;
545
546         if (drm->device.info.ram_size <= 32 * 1024 * 1024)
547                 preferred_bpp = 8;
548         else
549         if (drm->device.info.ram_size <= 64 * 1024 * 1024)
550                 preferred_bpp = 16;
551         else
552                 preferred_bpp = 32;
553
554         /* disable all the possible outputs/crtcs before entering KMS mode */
555         drm_helper_disable_unused_functions(dev);
556
557         ret = drm_fb_helper_initial_config(&fbcon->helper, preferred_bpp);
558         if (ret)
559                 goto fini;
560
561         if (fbcon->helper.fbdev)
562                 fbcon->helper.fbdev->pixmap.buf_align = 4;
563         return 0;
564
565 fini:
566         drm_fb_helper_fini(&fbcon->helper);
567 free:
568         kfree(fbcon);
569         return ret;
570 }
571
572 void
573 nouveau_fbcon_fini(struct drm_device *dev)
574 {
575         struct nouveau_drm *drm = nouveau_drm(dev);
576
577         if (!drm->fbcon)
578                 return;
579
580         nouveau_fbcon_accel_fini(dev);
581         nouveau_fbcon_destroy(dev, drm->fbcon);
582         kfree(drm->fbcon);
583         drm->fbcon = NULL;
584 }