2 * Copyright (C) 2012-2013 Avionic Design GmbH
3 * Copyright (C) 2012 NVIDIA CORPORATION. All rights reserved.
5 * Based on the KMS/FB CMA helpers
6 * Copyright (C) 2012 Analog Device Inc.
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
16 static inline struct tegra_fb
*to_tegra_fb(struct drm_framebuffer
*fb
)
18 return container_of(fb
, struct tegra_fb
, base
);
21 #ifdef CONFIG_DRM_TEGRA_FBDEV
22 static inline struct tegra_fbdev
*to_tegra_fbdev(struct drm_fb_helper
*helper
)
24 return container_of(helper
, struct tegra_fbdev
, base
);
28 struct tegra_bo
*tegra_fb_get_plane(struct drm_framebuffer
*framebuffer
,
31 struct tegra_fb
*fb
= to_tegra_fb(framebuffer
);
33 if (index
>= drm_format_num_planes(framebuffer
->pixel_format
))
36 return fb
->planes
[index
];
39 bool tegra_fb_is_bottom_up(struct drm_framebuffer
*framebuffer
)
41 struct tegra_fb
*fb
= to_tegra_fb(framebuffer
);
43 if (fb
->planes
[0]->flags
& TEGRA_BO_BOTTOM_UP
)
49 int tegra_fb_get_tiling(struct drm_framebuffer
*framebuffer
,
50 struct tegra_bo_tiling
*tiling
)
52 struct tegra_fb
*fb
= to_tegra_fb(framebuffer
);
54 /* TODO: handle YUV formats? */
55 *tiling
= fb
->planes
[0]->tiling
;
60 static void tegra_fb_destroy(struct drm_framebuffer
*framebuffer
)
62 struct tegra_fb
*fb
= to_tegra_fb(framebuffer
);
65 for (i
= 0; i
< fb
->num_planes
; i
++) {
66 struct tegra_bo
*bo
= fb
->planes
[i
];
69 drm_gem_object_unreference_unlocked(&bo
->gem
);
72 drm_framebuffer_cleanup(framebuffer
);
77 static int tegra_fb_create_handle(struct drm_framebuffer
*framebuffer
,
78 struct drm_file
*file
, unsigned int *handle
)
80 struct tegra_fb
*fb
= to_tegra_fb(framebuffer
);
82 return drm_gem_handle_create(file
, &fb
->planes
[0]->gem
, handle
);
85 static struct drm_framebuffer_funcs tegra_fb_funcs
= {
86 .destroy
= tegra_fb_destroy
,
87 .create_handle
= tegra_fb_create_handle
,
90 static struct tegra_fb
*tegra_fb_alloc(struct drm_device
*drm
,
91 struct drm_mode_fb_cmd2
*mode_cmd
,
92 struct tegra_bo
**planes
,
93 unsigned int num_planes
)
99 fb
= kzalloc(sizeof(*fb
), GFP_KERNEL
);
101 return ERR_PTR(-ENOMEM
);
103 fb
->planes
= kzalloc(num_planes
* sizeof(*planes
), GFP_KERNEL
);
106 return ERR_PTR(-ENOMEM
);
109 fb
->num_planes
= num_planes
;
111 drm_helper_mode_fill_fb_struct(&fb
->base
, mode_cmd
);
113 for (i
= 0; i
< fb
->num_planes
; i
++)
114 fb
->planes
[i
] = planes
[i
];
116 err
= drm_framebuffer_init(drm
, &fb
->base
, &tegra_fb_funcs
);
118 dev_err(drm
->dev
, "failed to initialize framebuffer: %d\n",
128 static struct drm_framebuffer
*tegra_fb_create(struct drm_device
*drm
,
129 struct drm_file
*file
,
130 struct drm_mode_fb_cmd2
*cmd
)
132 unsigned int hsub
, vsub
, i
;
133 struct tegra_bo
*planes
[4];
134 struct drm_gem_object
*gem
;
138 hsub
= drm_format_horz_chroma_subsampling(cmd
->pixel_format
);
139 vsub
= drm_format_vert_chroma_subsampling(cmd
->pixel_format
);
141 for (i
= 0; i
< drm_format_num_planes(cmd
->pixel_format
); i
++) {
142 unsigned int width
= cmd
->width
/ (i
? hsub
: 1);
143 unsigned int height
= cmd
->height
/ (i
? vsub
: 1);
144 unsigned int size
, bpp
;
146 gem
= drm_gem_object_lookup(drm
, file
, cmd
->handles
[i
]);
152 bpp
= drm_format_plane_cpp(cmd
->pixel_format
, i
);
154 size
= (height
- 1) * cmd
->pitches
[i
] +
155 width
* bpp
+ cmd
->offsets
[i
];
157 if (gem
->size
< size
) {
162 planes
[i
] = to_tegra_bo(gem
);
165 fb
= tegra_fb_alloc(drm
, cmd
, planes
, i
);
175 drm_gem_object_unreference_unlocked(&planes
[i
]->gem
);
180 #ifdef CONFIG_DRM_TEGRA_FBDEV
181 static struct fb_ops tegra_fb_ops
= {
182 .owner
= THIS_MODULE
,
183 .fb_fillrect
= sys_fillrect
,
184 .fb_copyarea
= sys_copyarea
,
185 .fb_imageblit
= sys_imageblit
,
186 .fb_check_var
= drm_fb_helper_check_var
,
187 .fb_set_par
= drm_fb_helper_set_par
,
188 .fb_blank
= drm_fb_helper_blank
,
189 .fb_pan_display
= drm_fb_helper_pan_display
,
190 .fb_setcmap
= drm_fb_helper_setcmap
,
193 static int tegra_fbdev_probe(struct drm_fb_helper
*helper
,
194 struct drm_fb_helper_surface_size
*sizes
)
196 struct tegra_fbdev
*fbdev
= to_tegra_fbdev(helper
);
197 struct drm_device
*drm
= helper
->dev
;
198 struct drm_mode_fb_cmd2 cmd
= { 0 };
199 unsigned int bytes_per_pixel
;
200 struct drm_framebuffer
*fb
;
201 unsigned long offset
;
202 struct fb_info
*info
;
207 bytes_per_pixel
= DIV_ROUND_UP(sizes
->surface_bpp
, 8);
209 cmd
.width
= sizes
->surface_width
;
210 cmd
.height
= sizes
->surface_height
;
211 cmd
.pitches
[0] = sizes
->surface_width
* bytes_per_pixel
;
212 cmd
.pixel_format
= drm_mode_legacy_fb_format(sizes
->surface_bpp
,
213 sizes
->surface_depth
);
215 size
= cmd
.pitches
[0] * cmd
.height
;
217 bo
= tegra_bo_create(drm
, size
, 0);
221 info
= framebuffer_alloc(0, drm
->dev
);
223 dev_err(drm
->dev
, "failed to allocate framebuffer info\n");
224 tegra_bo_free_object(&bo
->gem
);
228 fbdev
->fb
= tegra_fb_alloc(drm
, &cmd
, &bo
, 1);
229 if (IS_ERR(fbdev
->fb
)) {
230 dev_err(drm
->dev
, "failed to allocate DRM framebuffer\n");
231 err
= PTR_ERR(fbdev
->fb
);
235 fb
= &fbdev
->fb
->base
;
237 helper
->fbdev
= info
;
240 info
->flags
= FBINFO_FLAG_DEFAULT
;
241 info
->fbops
= &tegra_fb_ops
;
243 err
= fb_alloc_cmap(&info
->cmap
, 256, 0);
245 dev_err(drm
->dev
, "failed to allocate color map: %d\n", err
);
249 drm_fb_helper_fill_fix(info
, fb
->pitches
[0], fb
->depth
);
250 drm_fb_helper_fill_var(info
, helper
, fb
->width
, fb
->height
);
252 offset
= info
->var
.xoffset
* bytes_per_pixel
+
253 info
->var
.yoffset
* fb
->pitches
[0];
255 drm
->mode_config
.fb_base
= (resource_size_t
)bo
->paddr
;
256 info
->screen_base
= (void __iomem
*)bo
->vaddr
+ offset
;
257 info
->screen_size
= size
;
258 info
->fix
.smem_start
= (unsigned long)(bo
->paddr
+ offset
);
259 info
->fix
.smem_len
= size
;
264 drm_framebuffer_unregister_private(fb
);
265 tegra_fb_destroy(fb
);
267 framebuffer_release(info
);
271 static const struct drm_fb_helper_funcs tegra_fb_helper_funcs
= {
272 .fb_probe
= tegra_fbdev_probe
,
275 static struct tegra_fbdev
*tegra_fbdev_create(struct drm_device
*drm
)
277 struct tegra_fbdev
*fbdev
;
279 fbdev
= kzalloc(sizeof(*fbdev
), GFP_KERNEL
);
281 dev_err(drm
->dev
, "failed to allocate DRM fbdev\n");
282 return ERR_PTR(-ENOMEM
);
285 drm_fb_helper_prepare(drm
, &fbdev
->base
, &tegra_fb_helper_funcs
);
290 static int tegra_fbdev_init(struct tegra_fbdev
*fbdev
,
291 unsigned int preferred_bpp
,
292 unsigned int num_crtc
,
293 unsigned int max_connectors
)
295 struct drm_device
*drm
= fbdev
->base
.dev
;
298 err
= drm_fb_helper_init(drm
, &fbdev
->base
, num_crtc
, max_connectors
);
300 dev_err(drm
->dev
, "failed to initialize DRM FB helper\n");
304 err
= drm_fb_helper_single_add_all_connectors(&fbdev
->base
);
306 dev_err(drm
->dev
, "failed to add connectors\n");
310 err
= drm_fb_helper_initial_config(&fbdev
->base
, preferred_bpp
);
312 dev_err(drm
->dev
, "failed to set initial configuration\n");
319 drm_fb_helper_fini(&fbdev
->base
);
323 static void tegra_fbdev_free(struct tegra_fbdev
*fbdev
)
325 struct fb_info
*info
= fbdev
->base
.fbdev
;
330 err
= unregister_framebuffer(info
);
332 DRM_DEBUG_KMS("failed to unregister framebuffer\n");
335 fb_dealloc_cmap(&info
->cmap
);
337 framebuffer_release(info
);
341 drm_framebuffer_unregister_private(&fbdev
->fb
->base
);
342 tegra_fb_destroy(&fbdev
->fb
->base
);
345 drm_fb_helper_fini(&fbdev
->base
);
349 void tegra_fbdev_restore_mode(struct tegra_fbdev
*fbdev
)
352 drm_fb_helper_restore_fbdev_mode_unlocked(&fbdev
->base
);
355 static void tegra_fb_output_poll_changed(struct drm_device
*drm
)
357 struct tegra_drm
*tegra
= drm
->dev_private
;
360 drm_fb_helper_hotplug_event(&tegra
->fbdev
->base
);
364 static const struct drm_mode_config_funcs tegra_drm_mode_funcs
= {
365 .fb_create
= tegra_fb_create
,
366 #ifdef CONFIG_DRM_TEGRA_FBDEV
367 .output_poll_changed
= tegra_fb_output_poll_changed
,
371 int tegra_drm_fb_prepare(struct drm_device
*drm
)
373 #ifdef CONFIG_DRM_TEGRA_FBDEV
374 struct tegra_drm
*tegra
= drm
->dev_private
;
377 drm
->mode_config
.min_width
= 0;
378 drm
->mode_config
.min_height
= 0;
380 drm
->mode_config
.max_width
= 4096;
381 drm
->mode_config
.max_height
= 4096;
383 drm
->mode_config
.funcs
= &tegra_drm_mode_funcs
;
385 #ifdef CONFIG_DRM_TEGRA_FBDEV
386 tegra
->fbdev
= tegra_fbdev_create(drm
);
387 if (IS_ERR(tegra
->fbdev
))
388 return PTR_ERR(tegra
->fbdev
);
394 int tegra_drm_fb_init(struct drm_device
*drm
)
396 #ifdef CONFIG_DRM_TEGRA_FBDEV
397 struct tegra_drm
*tegra
= drm
->dev_private
;
400 err
= tegra_fbdev_init(tegra
->fbdev
, 32, drm
->mode_config
.num_crtc
,
401 drm
->mode_config
.num_connector
);
409 void tegra_drm_fb_exit(struct drm_device
*drm
)
411 #ifdef CONFIG_DRM_TEGRA_FBDEV
412 struct tegra_drm
*tegra
= drm
->dev_private
;
414 tegra_fbdev_free(tegra
->fbdev
);