1a0a23564SMichal Meloun /*-
2a0a23564SMichal Meloun * Copyright (c) 2016 Michal Meloun
3a0a23564SMichal Meloun * All rights reserved.
4a0a23564SMichal Meloun *
5a0a23564SMichal Meloun * Redistribution and use in source and binary forms, with or without
6a0a23564SMichal Meloun * modification, are permitted provided that the following conditions
7a0a23564SMichal Meloun * are met:
8a0a23564SMichal Meloun * 1. Redistributions of source code must retain the above copyright
9a0a23564SMichal Meloun * notice, this list of conditions and the following disclaimer.
10a0a23564SMichal Meloun * 2. Redistributions in binary form must reproduce the above copyright
11a0a23564SMichal Meloun * notice, this list of conditions and the following disclaimer in the
12a0a23564SMichal Meloun * documentation and/or other materials provided with the distribution.
13a0a23564SMichal Meloun *
14a0a23564SMichal Meloun * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15a0a23564SMichal Meloun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16a0a23564SMichal Meloun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17a0a23564SMichal Meloun * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18a0a23564SMichal Meloun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19a0a23564SMichal Meloun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20a0a23564SMichal Meloun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21a0a23564SMichal Meloun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22a0a23564SMichal Meloun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23a0a23564SMichal Meloun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24a0a23564SMichal Meloun * SUCH DAMAGE.
25a0a23564SMichal Meloun */
26a0a23564SMichal Meloun
27a0a23564SMichal Meloun #include <sys/param.h>
28a0a23564SMichal Meloun #include <sys/systm.h>
29a0a23564SMichal Meloun #include <sys/bus.h>
30a0a23564SMichal Meloun #include <sys/kernel.h>
31a0a23564SMichal Meloun #include <sys/malloc.h>
32a0a23564SMichal Meloun
33a0a23564SMichal Meloun #include <machine/bus.h>
34a0a23564SMichal Meloun
35be82b3a0SEmmanuel Vadot #include <dev/clk/clk.h>
36a0a23564SMichal Meloun #include <dev/drm2/drmP.h>
37a0a23564SMichal Meloun #include <dev/drm2/drm_crtc_helper.h>
38a0a23564SMichal Meloun #include <dev/drm2/drm_fb_helper.h>
39a0a23564SMichal Meloun
40a0a23564SMichal Meloun #include <arm/nvidia/drm2/tegra_drm.h>
41a0a23564SMichal Meloun
42a0a23564SMichal Meloun static void
fb_destroy(struct drm_framebuffer * drm_fb)43a0a23564SMichal Meloun fb_destroy(struct drm_framebuffer *drm_fb)
44a0a23564SMichal Meloun {
45a0a23564SMichal Meloun struct tegra_fb *fb;
46a0a23564SMichal Meloun struct tegra_bo *bo;
47a0a23564SMichal Meloun unsigned int i;
48a0a23564SMichal Meloun
49a0a23564SMichal Meloun fb = container_of(drm_fb, struct tegra_fb, drm_fb);
50a0a23564SMichal Meloun for (i = 0; i < fb->nplanes; i++) {
51a0a23564SMichal Meloun bo = fb->planes[i];
52a0a23564SMichal Meloun if (bo != NULL)
53a0a23564SMichal Meloun drm_gem_object_unreference_unlocked(&bo->gem_obj);
54a0a23564SMichal Meloun }
55a0a23564SMichal Meloun
56a0a23564SMichal Meloun drm_framebuffer_cleanup(drm_fb);
57a0a23564SMichal Meloun free(fb->planes, DRM_MEM_DRIVER);
58a0a23564SMichal Meloun }
59a0a23564SMichal Meloun
60a0a23564SMichal Meloun static int
fb_create_handle(struct drm_framebuffer * drm_fb,struct drm_file * file,unsigned int * handle)61a0a23564SMichal Meloun fb_create_handle(struct drm_framebuffer *drm_fb, struct drm_file *file,
62a0a23564SMichal Meloun unsigned int *handle)
63a0a23564SMichal Meloun {
64a0a23564SMichal Meloun struct tegra_fb *fb;
65a0a23564SMichal Meloun int rv;
66a0a23564SMichal Meloun
67a0a23564SMichal Meloun fb = container_of(drm_fb, struct tegra_fb, drm_fb);
68a0a23564SMichal Meloun rv = drm_gem_handle_create(file, &fb->planes[0]->gem_obj, handle);
69a0a23564SMichal Meloun return (rv);
70a0a23564SMichal Meloun }
71a0a23564SMichal Meloun
72a0a23564SMichal Meloun /* XXX Probably not needed */
73a0a23564SMichal Meloun static int
fb_dirty(struct drm_framebuffer * fb,struct drm_file * file_priv,unsigned flags,unsigned color,struct drm_clip_rect * clips,unsigned num_clips)74a0a23564SMichal Meloun fb_dirty(struct drm_framebuffer *fb, struct drm_file *file_priv,
75a0a23564SMichal Meloun unsigned flags, unsigned color, struct drm_clip_rect *clips, unsigned num_clips)
76a0a23564SMichal Meloun {
77a0a23564SMichal Meloun
78a0a23564SMichal Meloun return (0);
79a0a23564SMichal Meloun }
80a0a23564SMichal Meloun
81a0a23564SMichal Meloun static const struct drm_framebuffer_funcs fb_funcs = {
82a0a23564SMichal Meloun .destroy = fb_destroy,
83a0a23564SMichal Meloun .create_handle = fb_create_handle,
84a0a23564SMichal Meloun .dirty = fb_dirty,
85a0a23564SMichal Meloun };
86a0a23564SMichal Meloun
87a0a23564SMichal Meloun static int
fb_alloc(struct drm_device * drm,struct drm_mode_fb_cmd2 * mode_cmd,struct tegra_bo ** planes,int num_planes,struct tegra_fb ** res_fb)88a0a23564SMichal Meloun fb_alloc(struct drm_device *drm, struct drm_mode_fb_cmd2 *mode_cmd,
89a0a23564SMichal Meloun struct tegra_bo **planes, int num_planes, struct tegra_fb **res_fb)
90a0a23564SMichal Meloun {
91a0a23564SMichal Meloun struct tegra_fb *fb;
92a0a23564SMichal Meloun int i;
93a0a23564SMichal Meloun int rv;
94a0a23564SMichal Meloun
95a0a23564SMichal Meloun fb = malloc(sizeof(*fb), DRM_MEM_DRIVER, M_WAITOK | M_ZERO);
96a0a23564SMichal Meloun fb->planes = malloc(num_planes * sizeof(*fb->planes), DRM_MEM_DRIVER,
97a0a23564SMichal Meloun M_WAITOK | M_ZERO);
98a0a23564SMichal Meloun fb->nplanes = num_planes;
99a0a23564SMichal Meloun
100a0a23564SMichal Meloun drm_helper_mode_fill_fb_struct(&fb->drm_fb, mode_cmd);
101a0a23564SMichal Meloun for (i = 0; i < fb->nplanes; i++)
102a0a23564SMichal Meloun fb->planes[i] = planes[i];
103a0a23564SMichal Meloun rv = drm_framebuffer_init(drm, &fb->drm_fb, &fb_funcs);
104a0a23564SMichal Meloun if (rv < 0) {
105a0a23564SMichal Meloun device_printf(drm->dev,
106a0a23564SMichal Meloun "Cannot initialize frame buffer %d\n", rv);
107a0a23564SMichal Meloun free(fb->planes, DRM_MEM_DRIVER);
108a0a23564SMichal Meloun return (rv);
109a0a23564SMichal Meloun }
110a0a23564SMichal Meloun *res_fb = fb;
111a0a23564SMichal Meloun return (0);
112a0a23564SMichal Meloun }
113a0a23564SMichal Meloun
114a0a23564SMichal Meloun static int
tegra_fb_probe(struct drm_fb_helper * helper,struct drm_fb_helper_surface_size * sizes)115a0a23564SMichal Meloun tegra_fb_probe(struct drm_fb_helper *helper,
116a0a23564SMichal Meloun struct drm_fb_helper_surface_size *sizes)
117a0a23564SMichal Meloun {
118a0a23564SMichal Meloun u_int bpp, size;
119a0a23564SMichal Meloun struct tegra_drm *drm;
120a0a23564SMichal Meloun struct tegra_fb *fb;
121a0a23564SMichal Meloun struct fb_info *info;
122a0a23564SMichal Meloun struct tegra_bo *bo;
123a0a23564SMichal Meloun struct drm_mode_fb_cmd2 mode_cmd;
124a0a23564SMichal Meloun struct drm_device *drm_dev;
125a0a23564SMichal Meloun int rv;
126a0a23564SMichal Meloun
127a0a23564SMichal Meloun if (helper->fb != NULL)
128a0a23564SMichal Meloun return (0);
129a0a23564SMichal Meloun
130a0a23564SMichal Meloun DRM_DEBUG_KMS("surface: %d x %d (bpp: %d)\n", sizes->surface_width,
131a0a23564SMichal Meloun sizes->surface_height, sizes->surface_bpp);
132a0a23564SMichal Meloun
133a0a23564SMichal Meloun drm_dev = helper->dev;
134a0a23564SMichal Meloun fb = container_of(helper, struct tegra_fb, fb_helper);
135a0a23564SMichal Meloun drm = container_of(drm_dev, struct tegra_drm, drm_dev);
136a0a23564SMichal Meloun bpp = (sizes->surface_bpp + 7) / 8;
137a0a23564SMichal Meloun
138a0a23564SMichal Meloun /* Create mode_cmd */
139a0a23564SMichal Meloun memset(&mode_cmd, 0, sizeof(mode_cmd));
140a0a23564SMichal Meloun mode_cmd.width = sizes->surface_width;
141a0a23564SMichal Meloun mode_cmd.height = sizes->surface_height;
142a0a23564SMichal Meloun mode_cmd.pitches[0] = roundup(sizes->surface_width * bpp,
143a0a23564SMichal Meloun drm->pitch_align);
144a0a23564SMichal Meloun mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
145a0a23564SMichal Meloun sizes->surface_depth);
146a0a23564SMichal Meloun size = mode_cmd.pitches[0] * mode_cmd.height;
147a0a23564SMichal Meloun
148a0a23564SMichal Meloun DRM_LOCK(drm_dev);
149a0a23564SMichal Meloun rv = tegra_bo_create(drm_dev, size, &bo);
150a0a23564SMichal Meloun DRM_UNLOCK(drm_dev);
151a0a23564SMichal Meloun if (rv != 0)
152a0a23564SMichal Meloun return (rv);
153a0a23564SMichal Meloun
154a0a23564SMichal Meloun info = framebuffer_alloc();
155a0a23564SMichal Meloun if (info == NULL) {
156a0a23564SMichal Meloun device_printf(drm_dev->dev,
157a0a23564SMichal Meloun "Cannot allocate DRM framebuffer info.\n");
158a0a23564SMichal Meloun rv = -ENOMEM;
159a0a23564SMichal Meloun goto err_object;
160a0a23564SMichal Meloun }
161a0a23564SMichal Meloun
162a0a23564SMichal Meloun rv = fb_alloc(drm_dev, &mode_cmd, &bo, 1, &fb);
163a0a23564SMichal Meloun if (rv != 0) {
164a0a23564SMichal Meloun device_printf(drm_dev->dev,
165a0a23564SMichal Meloun "Cannot allocate DRM framebuffer.\n");
166a0a23564SMichal Meloun goto err_fb;
167a0a23564SMichal Meloun }
168a0a23564SMichal Meloun helper->fb = &fb->drm_fb;
169a0a23564SMichal Meloun helper->fbdev = info;
170a0a23564SMichal Meloun
171a0a23564SMichal Meloun /* Fill FB info */
172a0a23564SMichal Meloun info->fb_vbase = bo->vbase;
173a0a23564SMichal Meloun info->fb_pbase = bo->pbase;
174a0a23564SMichal Meloun info->fb_size = size;
175a0a23564SMichal Meloun info->fb_bpp = sizes->surface_bpp;
176a0a23564SMichal Meloun drm_fb_helper_fill_fix(info, fb->drm_fb.pitches[0], fb->drm_fb.depth);
177a0a23564SMichal Meloun drm_fb_helper_fill_var(info, helper, fb->drm_fb.width,
178a0a23564SMichal Meloun fb->drm_fb.height);
179a0a23564SMichal Meloun
180a0a23564SMichal Meloun DRM_DEBUG_KMS("allocated %dx%d (s %dbits) fb size: %d, bo %p\n",
181a0a23564SMichal Meloun fb->drm_fb.width, fb->drm_fb.height, fb->drm_fb.depth,
182a0a23564SMichal Meloun size, bo);
183a0a23564SMichal Meloun return (1);
184a0a23564SMichal Meloun err_fb:
185a0a23564SMichal Meloun drm_gem_object_unreference_unlocked(&bo->gem_obj);
186a0a23564SMichal Meloun framebuffer_release(info);
187a0a23564SMichal Meloun err_object:
188a0a23564SMichal Meloun drm_gem_object_release(&bo->gem_obj);
189a0a23564SMichal Meloun return (rv);
190a0a23564SMichal Meloun }
191a0a23564SMichal Meloun
192a0a23564SMichal Meloun static struct drm_fb_helper_funcs fb_helper_funcs = {
193a0a23564SMichal Meloun .fb_probe = tegra_fb_probe,
194a0a23564SMichal Meloun };
195a0a23564SMichal Meloun
196a0a23564SMichal Meloun /*
197a0a23564SMichal Meloun * Exported functions
198a0a23564SMichal Meloun */
199a0a23564SMichal Meloun struct fb_info *
tegra_drm_fb_getinfo(struct drm_device * drm_dev)200a0a23564SMichal Meloun tegra_drm_fb_getinfo(struct drm_device *drm_dev)
201a0a23564SMichal Meloun {
202a0a23564SMichal Meloun struct tegra_fb *fb;
203a0a23564SMichal Meloun struct tegra_drm *drm;
204a0a23564SMichal Meloun
205a0a23564SMichal Meloun drm = container_of(drm_dev, struct tegra_drm, drm_dev);
206a0a23564SMichal Meloun fb = drm->fb;
207a0a23564SMichal Meloun if (fb == NULL)
208a0a23564SMichal Meloun return (NULL);
209a0a23564SMichal Meloun return (fb->fb_helper.fbdev);
210a0a23564SMichal Meloun }
211a0a23564SMichal Meloun
212a0a23564SMichal Meloun struct tegra_bo *
tegra_fb_get_plane(struct tegra_fb * fb,int idx)213a0a23564SMichal Meloun tegra_fb_get_plane(struct tegra_fb *fb, int idx)
214a0a23564SMichal Meloun {
215a0a23564SMichal Meloun
216a0a23564SMichal Meloun if (idx >= drm_format_num_planes(fb->drm_fb.pixel_format))
217a0a23564SMichal Meloun return (NULL);
218a0a23564SMichal Meloun if (idx >= fb->nplanes)
219a0a23564SMichal Meloun return (NULL);
220a0a23564SMichal Meloun return (fb->planes[idx]);
221a0a23564SMichal Meloun }
222a0a23564SMichal Meloun
223a0a23564SMichal Meloun int
tegra_drm_fb_init(struct drm_device * drm_dev)224a0a23564SMichal Meloun tegra_drm_fb_init(struct drm_device *drm_dev)
225a0a23564SMichal Meloun {
226a0a23564SMichal Meloun struct tegra_fb *fb;
227a0a23564SMichal Meloun struct tegra_drm *drm;
228a0a23564SMichal Meloun int rv;
229a0a23564SMichal Meloun
230a0a23564SMichal Meloun drm = drm_dev->dev_private;
231a0a23564SMichal Meloun drm = container_of(drm_dev, struct tegra_drm, drm_dev);
232a0a23564SMichal Meloun fb = malloc(sizeof(*fb), DRM_MEM_DRIVER, M_WAITOK | M_ZERO);
233a0a23564SMichal Meloun drm->fb = fb;
234a0a23564SMichal Meloun
235a0a23564SMichal Meloun fb->fb_helper.funcs = &fb_helper_funcs;
236a0a23564SMichal Meloun rv = drm_fb_helper_init(drm_dev, &fb->fb_helper,
237a0a23564SMichal Meloun drm_dev->mode_config.num_crtc, drm_dev->mode_config.num_connector);
238a0a23564SMichal Meloun if (rv != 0) {
239a0a23564SMichal Meloun device_printf(drm_dev->dev,
240a0a23564SMichal Meloun "Cannot initialize frame buffer %d\n", rv);
241a0a23564SMichal Meloun return (rv);
242a0a23564SMichal Meloun }
243a0a23564SMichal Meloun
244a0a23564SMichal Meloun rv = drm_fb_helper_single_add_all_connectors(&fb->fb_helper);
245a0a23564SMichal Meloun if (rv != 0) {
246a0a23564SMichal Meloun device_printf(drm_dev->dev, "Cannot add all connectors: %d\n",
247a0a23564SMichal Meloun rv);
248a0a23564SMichal Meloun goto err_fini;
249a0a23564SMichal Meloun }
250a0a23564SMichal Meloun
251a0a23564SMichal Meloun rv = drm_fb_helper_initial_config(&fb->fb_helper, 32);
252a0a23564SMichal Meloun if (rv != 0) {
253a0a23564SMichal Meloun device_printf(drm_dev->dev,
254a0a23564SMichal Meloun "Cannot set initial config: %d\n", rv);
255a0a23564SMichal Meloun goto err_fini;
256a0a23564SMichal Meloun }
257a0a23564SMichal Meloun /* XXXX Setup initial mode for FB */
258a0a23564SMichal Meloun /* drm_fb_helper_set_par(fb->fb_helper.fbdev); */
259a0a23564SMichal Meloun return 0;
260a0a23564SMichal Meloun
261a0a23564SMichal Meloun err_fini:
262a0a23564SMichal Meloun drm_fb_helper_fini(&fb->fb_helper);
263a0a23564SMichal Meloun return (rv);
264a0a23564SMichal Meloun }
265a0a23564SMichal Meloun
266a0a23564SMichal Meloun int
tegra_drm_fb_create(struct drm_device * drm,struct drm_file * file,struct drm_mode_fb_cmd2 * cmd,struct drm_framebuffer ** fb_res)267a0a23564SMichal Meloun tegra_drm_fb_create(struct drm_device *drm, struct drm_file *file,
268a0a23564SMichal Meloun struct drm_mode_fb_cmd2 *cmd, struct drm_framebuffer **fb_res)
269a0a23564SMichal Meloun {
270a0a23564SMichal Meloun int hsub, vsub, i;
271a0a23564SMichal Meloun int width, height, size, bpp;
272a0a23564SMichal Meloun struct tegra_bo *planes[4];
273a0a23564SMichal Meloun struct drm_gem_object *gem_obj;
274a0a23564SMichal Meloun struct tegra_fb *fb;
275a0a23564SMichal Meloun int rv, nplanes;
276a0a23564SMichal Meloun
277a0a23564SMichal Meloun hsub = drm_format_horz_chroma_subsampling(cmd->pixel_format);
278a0a23564SMichal Meloun vsub = drm_format_vert_chroma_subsampling(cmd->pixel_format);
279a0a23564SMichal Meloun
280a0a23564SMichal Meloun nplanes = drm_format_num_planes(cmd->pixel_format);
281a0a23564SMichal Meloun for (i = 0; i < nplanes; i++) {
282a0a23564SMichal Meloun width = cmd->width;
283a0a23564SMichal Meloun height = cmd->height;
284a0a23564SMichal Meloun if (i != 0) {
285a0a23564SMichal Meloun width /= hsub;
286a0a23564SMichal Meloun height /= vsub;
287a0a23564SMichal Meloun }
288a0a23564SMichal Meloun gem_obj = drm_gem_object_lookup(drm, file, cmd->handles[i]);
289a0a23564SMichal Meloun if (gem_obj == NULL) {
290a0a23564SMichal Meloun rv = -ENXIO;
291a0a23564SMichal Meloun goto fail;
292a0a23564SMichal Meloun }
293a0a23564SMichal Meloun
294a0a23564SMichal Meloun bpp = drm_format_plane_cpp(cmd->pixel_format, i);
295a0a23564SMichal Meloun size = (height - 1) * cmd->pitches[i] +
296a0a23564SMichal Meloun width * bpp + cmd->offsets[i];
297a0a23564SMichal Meloun if (gem_obj->size < size) {
298a0a23564SMichal Meloun rv = -EINVAL;
299a0a23564SMichal Meloun goto fail;
300a0a23564SMichal Meloun }
301a0a23564SMichal Meloun planes[i] = container_of(gem_obj, struct tegra_bo, gem_obj);
302a0a23564SMichal Meloun }
303a0a23564SMichal Meloun
304a0a23564SMichal Meloun rv = fb_alloc(drm, cmd, planes, nplanes, &fb);
305a0a23564SMichal Meloun if (rv != 0)
306a0a23564SMichal Meloun goto fail;
307a0a23564SMichal Meloun
308a0a23564SMichal Meloun *fb_res = &fb->drm_fb;
309a0a23564SMichal Meloun return (0);
310a0a23564SMichal Meloun
311a0a23564SMichal Meloun fail:
312a0a23564SMichal Meloun while (i--)
313a0a23564SMichal Meloun drm_gem_object_unreference_unlocked(&planes[i]->gem_obj);
314a0a23564SMichal Meloun return (rv);
315a0a23564SMichal Meloun }
316a0a23564SMichal Meloun
317a0a23564SMichal Meloun void
tegra_drm_fb_destroy(struct drm_device * drm_dev)318a0a23564SMichal Meloun tegra_drm_fb_destroy(struct drm_device *drm_dev)
319a0a23564SMichal Meloun {
320a0a23564SMichal Meloun struct fb_info *info;
321a0a23564SMichal Meloun struct tegra_fb *fb;
322a0a23564SMichal Meloun struct tegra_drm *drm;
323a0a23564SMichal Meloun
324a0a23564SMichal Meloun drm = container_of(drm_dev, struct tegra_drm, drm_dev);
325a0a23564SMichal Meloun fb = drm->fb;
326a0a23564SMichal Meloun if (fb == NULL)
327a0a23564SMichal Meloun return;
328a0a23564SMichal Meloun info = fb->fb_helper.fbdev;
329a0a23564SMichal Meloun drm_framebuffer_remove(&fb->drm_fb);
330a0a23564SMichal Meloun framebuffer_release(info);
331a0a23564SMichal Meloun drm_fb_helper_fini(&fb->fb_helper);
332a0a23564SMichal Meloun drm_framebuffer_cleanup(&fb->drm_fb);
333a0a23564SMichal Meloun free(fb, DRM_MEM_DRIVER);
334a0a23564SMichal Meloun drm->fb = NULL;
335a0a23564SMichal Meloun }
336