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