projects/linux·blob master · refs

147 lines · 3.7 KiB

1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (C) 2012-2013 Avionic Design GmbH
4 * Copyright (C) 2012 NVIDIA CORPORATION. All rights reserved.
5 *
6 * Based on the KMS/FB DMA helpers
7 * Copyright (C) 2012 Analog Devices Inc.
8 */
9
10#include <linux/console.h>
11#include <linux/fb.h>
12#include <linux/vmalloc.h>
13
14#include <drm/drm_drv.h>
15#include <drm/drm_crtc_helper.h>
16#include <drm/drm_fb_helper.h>
17#include <drm/drm_fourcc.h>
18#include <drm/drm_framebuffer.h>
19#include <drm/drm_gem_framebuffer_helper.h>
20#include <drm/drm_modeset_helper.h>
21
22#include "drm.h"
23#include "gem.h"
24
25static int tegra_fb_mmap(struct fb_info *info, struct vm_area_struct *vma)
26{
27 struct drm_fb_helper *helper = info->par;
28 struct tegra_bo *bo;
29 int err;
30
31 bo = tegra_fb_get_plane(helper->fb, 0);
32
33 err = drm_gem_mmap_obj(&bo->gem, bo->gem.size, vma);
34 if (err < 0)
35 return err;
36
37 return __tegra_gem_mmap(&bo->gem, vma);
38}
39
40static void tegra_fbdev_fb_destroy(struct fb_info *info)
41{
42 struct drm_fb_helper *helper = info->par;
43 struct tegra_bo *bo = tegra_fb_get_plane(helper->fb, 0);
44
45 drm_fb_helper_fini(helper);
46
47 /* Undo the special mapping we made in fbdev probe. */
48 if (bo->pages) {
49 vunmap(bo->vaddr);
50 bo->vaddr = NULL;
51 }
52
53 drm_client_buffer_delete(helper->buffer);
54 drm_client_release(&helper->client);
55}
56
57static const struct fb_ops tegra_fb_ops = {
58 .owner = THIS_MODULE,
59 __FB_DEFAULT_DMAMEM_OPS_RDWR,
60 DRM_FB_HELPER_DEFAULT_OPS,
61 __FB_DEFAULT_DMAMEM_OPS_DRAW,
62 .fb_mmap = tegra_fb_mmap,
63 .fb_destroy = tegra_fbdev_fb_destroy,
64};
65
66static const struct drm_fb_helper_funcs tegra_fbdev_helper_funcs = {
67};
68
69int tegra_fbdev_driver_fbdev_probe(struct drm_fb_helper *helper,
70 struct drm_fb_helper_surface_size *sizes)
71{
72 struct drm_client_dev *client = &helper->client;
73 struct drm_device *drm = client->dev;
74 struct drm_file *file = client->file;
75 struct tegra_drm *tegra = drm->dev_private;
76 struct fb_info *info = helper->info;
77 u32 fourcc, pitch;
78 u64 size;
79 const struct drm_format_info *format;
80 struct tegra_bo *bo;
81 struct drm_gem_object *gem;
82 u32 handle;
83 struct drm_client_buffer *buffer;
84 int err;
85
86 fourcc = drm_mode_legacy_fb_format(sizes->surface_bpp, sizes->surface_depth);
87 format = drm_get_format_info(drm, fourcc, DRM_FORMAT_MOD_LINEAR);
88 pitch = round_up(drm_format_info_min_pitch(format, 0, sizes->surface_width),
89 tegra->pitch_align);
90 size = ALIGN(pitch * sizes->surface_height, PAGE_SIZE);
91
92 bo = tegra_bo_create(drm, size, 0);
93 if (IS_ERR(bo))
94 return PTR_ERR(bo);
95 gem = &bo->gem;
96
97 err = drm_gem_handle_create(file, gem, &handle);
98 if (err)
99 goto err_drm_gem_object_put;
100
101 buffer = drm_client_buffer_create(client, sizes->surface_width, sizes->surface_height,
102 fourcc, handle, pitch);
103 if (IS_ERR(buffer)) {
104 err = PTR_ERR(buffer);
105 goto err_drm_gem_handle_delete;
106 }
107
108 helper->funcs = &tegra_fbdev_helper_funcs;
109 helper->buffer = buffer;
110 helper->fb = buffer->fb;
111
112 info->fbops = &tegra_fb_ops;
113
114 drm_fb_helper_fill_info(info, helper, sizes);
115
116 if (bo->pages) {
117 bo->vaddr = vmap(bo->pages, bo->num_pages, VM_MAP,
118 pgprot_writecombine(PAGE_KERNEL));
119 if (!bo->vaddr) {
120 dev_err(drm->dev, "failed to vmap() framebuffer\n");
121 err = -ENOMEM;
122 goto err_drm_client_buffer_delete;
123 }
124 }
125
126 info->flags |= FBINFO_VIRTFB;
127 info->screen_buffer = bo->vaddr;
128 info->screen_size = gem->size;
129 info->fix.smem_start = (unsigned long)(bo->iova);
130 info->fix.smem_len = gem->size;
131
132 /* The handle is only needed for creating the framebuffer. */
133 drm_gem_handle_delete(file, handle);
134
135 /* The framebuffer still holds a reference on the GEM object. */
136 drm_gem_object_put(gem);
137
138 return 0;
139
140err_drm_client_buffer_delete:
141 drm_client_buffer_delete(buffer);
142err_drm_gem_handle_delete:
143 drm_gem_handle_delete(file, handle);
144err_drm_gem_object_put:
145 drm_gem_object_put(gem);
146 return err;
147}