| // SPDX-License-Identifier: GPL-2.0-or-later | |
| /* exynos_drm_fbdev.c | |
| * | |
| * Copyright (c) 2011 Samsung Electronics Co., Ltd. | |
| * Authors: | |
| * Inki Dae <inki.dae@samsung.com> | |
| * Joonyoung Shim <jy0922.shim@samsung.com> | |
| * Seung-Woo Kim <sw0312.kim@samsung.com> | |
| */ | |
| #include <linux/fb.h> | |
| #include <drm/drm_crtc_helper.h> | |
| #include <drm/drm_drv.h> | |
| #include <drm/drm_fb_helper.h> | |
| #include <drm/drm_framebuffer.h> | |
| #include <drm/drm_gem_framebuffer_helper.h> | |
| #include <drm/drm_prime.h> | |
| #include <drm/exynos_drm.h> | |
| #include "exynos_drm_drv.h" | |
| #include "exynos_drm_fb.h" | |
| #include "exynos_drm_fbdev.h" | |
| #define MAX_CONNECTOR 4 | |
| #define PREFERRED_BPP 32 | |
| static int exynos_drm_fb_mmap(struct fb_info *info, struct vm_area_struct *vma) | |
| { | |
| struct drm_fb_helper *helper = info->par; | |
| struct drm_gem_object *obj = drm_gem_fb_get_obj(helper->fb, 0); | |
| return drm_gem_prime_mmap(obj, vma); | |
| } | |
| static void exynos_drm_fb_destroy(struct fb_info *info) | |
| { | |
| struct drm_fb_helper *fb_helper = info->par; | |
| struct drm_framebuffer *fb = fb_helper->fb; | |
| drm_fb_helper_fini(fb_helper); | |
| drm_framebuffer_remove(fb); | |
| drm_client_release(&fb_helper->client); | |
| drm_fb_helper_unprepare(fb_helper); | |
| kfree(fb_helper); | |
| } | |
| static const struct fb_ops exynos_drm_fb_ops = { | |
| .owner = THIS_MODULE, | |
| __FB_DEFAULT_DMAMEM_OPS_RDWR, | |
| DRM_FB_HELPER_DEFAULT_OPS, | |
| __FB_DEFAULT_DMAMEM_OPS_DRAW, | |
| .fb_mmap = exynos_drm_fb_mmap, | |
| .fb_destroy = exynos_drm_fb_destroy, | |
| }; | |
| static int exynos_drm_fbdev_update(struct drm_fb_helper *helper, | |
| struct drm_fb_helper_surface_size *sizes, | |
| struct exynos_drm_gem *exynos_gem) | |
| { | |
| struct fb_info *fbi; | |
| struct drm_framebuffer *fb = helper->fb; | |
| unsigned int size = fb->width * fb->height * fb->format->cpp[0]; | |
| unsigned long offset; | |
| fbi = drm_fb_helper_alloc_info(helper); | |
| if (IS_ERR(fbi)) { | |
| DRM_DEV_ERROR(to_dma_dev(helper->dev), | |
| "failed to allocate fb info.\n"); | |
| return PTR_ERR(fbi); | |
| } | |
| fbi->fbops = &exynos_drm_fb_ops; | |
| drm_fb_helper_fill_info(fbi, helper, sizes); | |
| offset = fbi->var.xoffset * fb->format->cpp[0]; | |
| offset += fbi->var.yoffset * fb->pitches[0]; | |
| fbi->flags |= FBINFO_VIRTFB; | |
| fbi->screen_buffer = exynos_gem->kvaddr + offset; | |
| fbi->screen_size = size; | |
| fbi->fix.smem_len = size; | |
| return 0; | |
| } | |
| static int exynos_drm_fbdev_create(struct drm_fb_helper *helper, | |
| struct drm_fb_helper_surface_size *sizes) | |
| { | |
| struct exynos_drm_gem *exynos_gem; | |
| struct drm_device *dev = helper->dev; | |
| struct drm_mode_fb_cmd2 mode_cmd = { 0 }; | |
| unsigned long size; | |
| int ret; | |
| DRM_DEV_DEBUG_KMS(dev->dev, | |
| "surface width(%d), height(%d) and bpp(%d\n", | |
| sizes->surface_width, sizes->surface_height, | |
| sizes->surface_bpp); | |
| mode_cmd.width = sizes->surface_width; | |
| mode_cmd.height = sizes->surface_height; | |
| mode_cmd.pitches[0] = sizes->surface_width * (sizes->surface_bpp >> 3); | |
| mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp, | |
| sizes->surface_depth); | |
| size = mode_cmd.pitches[0] * mode_cmd.height; | |
| exynos_gem = exynos_drm_gem_create(dev, EXYNOS_BO_WC, size, true); | |
| if (IS_ERR(exynos_gem)) | |
| return PTR_ERR(exynos_gem); | |
| helper->fb = | |
| exynos_drm_framebuffer_init(dev, &mode_cmd, &exynos_gem, 1); | |
| if (IS_ERR(helper->fb)) { | |
| DRM_DEV_ERROR(dev->dev, "failed to create drm framebuffer.\n"); | |
| ret = PTR_ERR(helper->fb); | |
| goto err_destroy_gem; | |
| } | |
| ret = exynos_drm_fbdev_update(helper, sizes, exynos_gem); | |
| if (ret < 0) | |
| goto err_destroy_framebuffer; | |
| return 0; | |
| err_destroy_framebuffer: | |
| drm_framebuffer_cleanup(helper->fb); | |
| helper->fb = NULL; | |
| err_destroy_gem: | |
| exynos_drm_gem_destroy(exynos_gem); | |
| return ret; | |
| } | |
| static const struct drm_fb_helper_funcs exynos_drm_fb_helper_funcs = { | |
| .fb_probe = exynos_drm_fbdev_create, | |
| }; | |
| /* | |
| * struct drm_client | |
| */ | |
| static void exynos_drm_fbdev_client_unregister(struct drm_client_dev *client) | |
| { | |
| struct drm_fb_helper *fb_helper = drm_fb_helper_from_client(client); | |
| if (fb_helper->info) { | |
| drm_fb_helper_unregister_info(fb_helper); | |
| } else { | |
| drm_client_release(&fb_helper->client); | |
| drm_fb_helper_unprepare(fb_helper); | |
| kfree(fb_helper); | |
| } | |
| } | |
| static int exynos_drm_fbdev_client_restore(struct drm_client_dev *client) | |
| { | |
| drm_fb_helper_lastclose(client->dev); | |
| return 0; | |
| } | |
| static int exynos_drm_fbdev_client_hotplug(struct drm_client_dev *client) | |
| { | |
| struct drm_fb_helper *fb_helper = drm_fb_helper_from_client(client); | |
| struct drm_device *dev = client->dev; | |
| int ret; | |
| if (dev->fb_helper) | |
| return drm_fb_helper_hotplug_event(dev->fb_helper); | |
| ret = drm_fb_helper_init(dev, fb_helper); | |
| if (ret) | |
| goto err_drm_err; | |
| if (!drm_drv_uses_atomic_modeset(dev)) | |
| drm_helper_disable_unused_functions(dev); | |
| ret = drm_fb_helper_initial_config(fb_helper); | |
| if (ret) | |
| goto err_drm_fb_helper_fini; | |
| return 0; | |
| err_drm_fb_helper_fini: | |
| drm_fb_helper_fini(fb_helper); | |
| err_drm_err: | |
| drm_err(dev, "Failed to setup fbdev emulation (ret=%d)\n", ret); | |
| return ret; | |
| } | |
| static const struct drm_client_funcs exynos_drm_fbdev_client_funcs = { | |
| .owner = THIS_MODULE, | |
| .unregister = exynos_drm_fbdev_client_unregister, | |
| .restore = exynos_drm_fbdev_client_restore, | |
| .hotplug = exynos_drm_fbdev_client_hotplug, | |
| }; | |
| void exynos_drm_fbdev_setup(struct drm_device *dev) | |
| { | |
| struct drm_fb_helper *fb_helper; | |
| int ret; | |
| drm_WARN(dev, !dev->registered, "Device has not been registered.\n"); | |
| drm_WARN(dev, dev->fb_helper, "fb_helper is already set!\n"); | |
| fb_helper = kzalloc(sizeof(*fb_helper), GFP_KERNEL); | |
| if (!fb_helper) | |
| return; | |
| drm_fb_helper_prepare(dev, fb_helper, PREFERRED_BPP, &exynos_drm_fb_helper_funcs); | |
| ret = drm_client_init(dev, &fb_helper->client, "fbdev", &exynos_drm_fbdev_client_funcs); | |
| if (ret) | |
| goto err_drm_client_init; | |
| drm_client_register(&fb_helper->client); | |
| return; | |
| err_drm_client_init: | |
| drm_fb_helper_unprepare(fb_helper); | |
| kfree(fb_helper); | |
| } |