1
2
3
4
5
6
7
8
9
10
11#include <drm/drm_atomic.h>
12#include <drm/drm_atomic_helper.h>
13#include <drm/drm_crtc.h>
14#include <drm/drm_fb_helper.h>
15#include <drm/drm_fourcc.h>
16#include <drm/drm_gem_framebuffer_helper.h>
17#include <drm/drm_probe_helper.h>
18#include <drm/exynos_drm.h>
19
20#include "exynos_drm_crtc.h"
21#include "exynos_drm_drv.h"
22#include "exynos_drm_fb.h"
23#include "exynos_drm_fbdev.h"
24
25static int check_fb_gem_memory_type(struct drm_device *drm_dev,
26 struct exynos_drm_gem *exynos_gem)
27{
28 unsigned int flags;
29
30
31
32
33
34 if (is_drm_iommu_supported(drm_dev))
35 return 0;
36
37 flags = exynos_gem->flags;
38
39
40
41
42
43 if (IS_NONCONTIG_BUFFER(flags)) {
44 DRM_DEV_ERROR(drm_dev->dev,
45 "Non-contiguous GEM memory is not supported.\n");
46 return -EINVAL;
47 }
48
49 return 0;
50}
51
52static const struct drm_framebuffer_funcs exynos_drm_fb_funcs = {
53 .destroy = drm_gem_fb_destroy,
54 .create_handle = drm_gem_fb_create_handle,
55};
56
57struct drm_framebuffer *
58exynos_drm_framebuffer_init(struct drm_device *dev,
59 const struct drm_mode_fb_cmd2 *mode_cmd,
60 struct exynos_drm_gem **exynos_gem,
61 int count)
62{
63 struct drm_framebuffer *fb;
64 int i;
65 int ret;
66
67 fb = kzalloc(sizeof(*fb), GFP_KERNEL);
68 if (!fb)
69 return ERR_PTR(-ENOMEM);
70
71 for (i = 0; i < count; i++) {
72 ret = check_fb_gem_memory_type(dev, exynos_gem[i]);
73 if (ret < 0)
74 goto err;
75
76 fb->obj[i] = &exynos_gem[i]->base;
77 }
78
79 drm_helper_mode_fill_fb_struct(dev, fb, mode_cmd);
80
81 ret = drm_framebuffer_init(dev, fb, &exynos_drm_fb_funcs);
82 if (ret < 0) {
83 DRM_DEV_ERROR(dev->dev,
84 "failed to initialize framebuffer\n");
85 goto err;
86 }
87
88 return fb;
89
90err:
91 kfree(fb);
92 return ERR_PTR(ret);
93}
94
95static struct drm_framebuffer *
96exynos_user_fb_create(struct drm_device *dev, struct drm_file *file_priv,
97 const struct drm_mode_fb_cmd2 *mode_cmd)
98{
99 const struct drm_format_info *info = drm_get_format_info(dev, mode_cmd);
100 struct exynos_drm_gem *exynos_gem[MAX_FB_BUFFER];
101 struct drm_framebuffer *fb;
102 int i;
103 int ret;
104
105 for (i = 0; i < info->num_planes; i++) {
106 unsigned int height = (i == 0) ? mode_cmd->height :
107 DIV_ROUND_UP(mode_cmd->height, info->vsub);
108 unsigned long size = height * mode_cmd->pitches[i] +
109 mode_cmd->offsets[i];
110
111 exynos_gem[i] = exynos_drm_gem_get(file_priv,
112 mode_cmd->handles[i]);
113 if (!exynos_gem[i]) {
114 DRM_DEV_ERROR(dev->dev,
115 "failed to lookup gem object\n");
116 ret = -ENOENT;
117 goto err;
118 }
119
120 if (size > exynos_gem[i]->size) {
121 i++;
122 ret = -EINVAL;
123 goto err;
124 }
125 }
126
127 fb = exynos_drm_framebuffer_init(dev, mode_cmd, exynos_gem, i);
128 if (IS_ERR(fb)) {
129 ret = PTR_ERR(fb);
130 goto err;
131 }
132
133 return fb;
134
135err:
136 while (i--)
137 exynos_drm_gem_put(exynos_gem[i]);
138
139 return ERR_PTR(ret);
140}
141
142dma_addr_t exynos_drm_fb_dma_addr(struct drm_framebuffer *fb, int index)
143{
144 struct exynos_drm_gem *exynos_gem;
145
146 if (WARN_ON_ONCE(index >= MAX_FB_BUFFER))
147 return 0;
148
149 exynos_gem = to_exynos_gem(fb->obj[index]);
150 return exynos_gem->dma_addr + fb->offsets[index];
151}
152
153static struct drm_mode_config_helper_funcs exynos_drm_mode_config_helpers = {
154 .atomic_commit_tail = drm_atomic_helper_commit_tail_rpm,
155};
156
157static const struct drm_mode_config_funcs exynos_drm_mode_config_funcs = {
158 .fb_create = exynos_user_fb_create,
159 .output_poll_changed = drm_fb_helper_output_poll_changed,
160 .atomic_check = drm_atomic_helper_check,
161 .atomic_commit = drm_atomic_helper_commit,
162};
163
164void exynos_drm_mode_config_init(struct drm_device *dev)
165{
166 dev->mode_config.min_width = 0;
167 dev->mode_config.min_height = 0;
168
169
170
171
172
173
174 dev->mode_config.max_width = 4096;
175 dev->mode_config.max_height = 4096;
176
177 dev->mode_config.funcs = &exynos_drm_mode_config_funcs;
178 dev->mode_config.helper_private = &exynos_drm_mode_config_helpers;
179
180 dev->mode_config.allow_fb_modifiers = true;
181
182 dev->mode_config.normalize_zpos = true;
183}
184