1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
296f60e37SRussell King /*
396f60e37SRussell King * Copyright (C) 2012 Russell King
496f60e37SRussell King * Written from the i915 driver.
596f60e37SRussell King */
625e28ef2SSam Ravnborg
796f60e37SRussell King #include <linux/errno.h>
8eb958c99SThomas Zimmermann #include <linux/fb.h>
996f60e37SRussell King #include <linux/kernel.h>
1096f60e37SRussell King #include <linux/module.h>
1196f60e37SRussell King
1263c38155SThomas Zimmermann #include <drm/drm_crtc_helper.h>
1363c38155SThomas Zimmermann #include <drm/drm_drv.h>
1496f60e37SRussell King #include <drm/drm_fb_helper.h>
1525e28ef2SSam Ravnborg #include <drm/drm_fourcc.h>
1625e28ef2SSam Ravnborg
1796f60e37SRussell King #include "armada_crtc.h"
1896f60e37SRussell King #include "armada_drm.h"
1996f60e37SRussell King #include "armada_fb.h"
2096f60e37SRussell King #include "armada_gem.h"
2196f60e37SRussell King
armada_fbdev_fb_destroy(struct fb_info * info)2263c38155SThomas Zimmermann static void armada_fbdev_fb_destroy(struct fb_info *info)
2363c38155SThomas Zimmermann {
2463c38155SThomas Zimmermann struct drm_fb_helper *fbh = info->par;
2563c38155SThomas Zimmermann
2663c38155SThomas Zimmermann drm_fb_helper_fini(fbh);
2763c38155SThomas Zimmermann
2863c38155SThomas Zimmermann fbh->fb->funcs->destroy(fbh->fb);
2963c38155SThomas Zimmermann
3063c38155SThomas Zimmermann drm_client_release(&fbh->client);
3163c38155SThomas Zimmermann drm_fb_helper_unprepare(fbh);
3263c38155SThomas Zimmermann kfree(fbh);
3363c38155SThomas Zimmermann }
3463c38155SThomas Zimmermann
35b6ff753aSJani Nikula static const struct fb_ops armada_fb_ops = {
3696f60e37SRussell King .owner = THIS_MODULE,
37*4520844bSThomas Zimmermann FB_DEFAULT_IOMEM_OPS,
381caae277SStefan Christ DRM_FB_HELPER_DEFAULT_OPS,
3963c38155SThomas Zimmermann .fb_destroy = armada_fbdev_fb_destroy,
4096f60e37SRussell King };
4196f60e37SRussell King
armada_fbdev_create(struct drm_fb_helper * fbh,struct drm_fb_helper_surface_size * sizes)423382a6b9SRussell King static int armada_fbdev_create(struct drm_fb_helper *fbh,
4396f60e37SRussell King struct drm_fb_helper_surface_size *sizes)
4496f60e37SRussell King {
4596f60e37SRussell King struct drm_device *dev = fbh->dev;
4696f60e37SRussell King struct drm_mode_fb_cmd2 mode;
4796f60e37SRussell King struct armada_framebuffer *dfb;
4896f60e37SRussell King struct armada_gem_object *obj;
4996f60e37SRussell King struct fb_info *info;
5096f60e37SRussell King int size, ret;
5196f60e37SRussell King void *ptr;
5296f60e37SRussell King
5396f60e37SRussell King memset(&mode, 0, sizeof(mode));
5496f60e37SRussell King mode.width = sizes->surface_width;
5596f60e37SRussell King mode.height = sizes->surface_height;
5696f60e37SRussell King mode.pitches[0] = armada_pitch(mode.width, sizes->surface_bpp);
5796f60e37SRussell King mode.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
5896f60e37SRussell King sizes->surface_depth);
5996f60e37SRussell King
6096f60e37SRussell King size = mode.pitches[0] * mode.height;
6196f60e37SRussell King obj = armada_gem_alloc_private_object(dev, size);
6296f60e37SRussell King if (!obj) {
6396f60e37SRussell King DRM_ERROR("failed to allocate fb memory\n");
6496f60e37SRussell King return -ENOMEM;
6596f60e37SRussell King }
6696f60e37SRussell King
6796f60e37SRussell King ret = armada_gem_linear_back(dev, obj);
6896f60e37SRussell King if (ret) {
69dda156cfSEmil Velikov drm_gem_object_put(&obj->obj);
7096f60e37SRussell King return ret;
7196f60e37SRussell King }
7296f60e37SRussell King
7396f60e37SRussell King ptr = armada_gem_map_object(dev, obj);
7496f60e37SRussell King if (!ptr) {
75dda156cfSEmil Velikov drm_gem_object_put(&obj->obj);
7696f60e37SRussell King return -ENOMEM;
7796f60e37SRussell King }
7896f60e37SRussell King
7996f60e37SRussell King dfb = armada_framebuffer_create(dev, &mode, obj);
8096f60e37SRussell King
8196f60e37SRussell King /*
8296f60e37SRussell King * A reference is now held by the framebuffer object if
8396f60e37SRussell King * successful, otherwise this drops the ref for the error path.
8496f60e37SRussell King */
85dda156cfSEmil Velikov drm_gem_object_put(&obj->obj);
8696f60e37SRussell King
8796f60e37SRussell King if (IS_ERR(dfb))
8896f60e37SRussell King return PTR_ERR(dfb);
8996f60e37SRussell King
907fd50bc3SThomas Zimmermann info = drm_fb_helper_alloc_info(fbh);
91e8b70e4dSArchit Taneja if (IS_ERR(info)) {
92e8b70e4dSArchit Taneja ret = PTR_ERR(info);
9396f60e37SRussell King goto err_fballoc;
9496f60e37SRussell King }
9596f60e37SRussell King
9696f60e37SRussell King info->fbops = &armada_fb_ops;
9796f60e37SRussell King info->fix.smem_start = obj->phys_addr;
9896f60e37SRussell King info->fix.smem_len = obj->obj.size;
9996f60e37SRussell King info->screen_size = obj->obj.size;
10096f60e37SRussell King info->screen_base = ptr;
10196f60e37SRussell King fbh->fb = &dfb->fb;
102e8b70e4dSArchit Taneja
103f21b6e47SDaniel Vetter drm_fb_helper_fill_info(info, fbh, sizes);
10496f60e37SRussell King
1057513e095SRussell King DRM_DEBUG_KMS("allocated %dx%d %dbpp fb: 0x%08llx\n",
106272725c7SVille Syrjälä dfb->fb.width, dfb->fb.height, dfb->fb.format->cpp[0] * 8,
1077513e095SRussell King (unsigned long long)obj->phys_addr);
10896f60e37SRussell King
10996f60e37SRussell King return 0;
11096f60e37SRussell King
11196f60e37SRussell King err_fballoc:
11296f60e37SRussell King dfb->fb.funcs->destroy(&dfb->fb);
11396f60e37SRussell King return ret;
11496f60e37SRussell King }
11596f60e37SRussell King
armada_fb_probe(struct drm_fb_helper * fbh,struct drm_fb_helper_surface_size * sizes)11696f60e37SRussell King static int armada_fb_probe(struct drm_fb_helper *fbh,
11796f60e37SRussell King struct drm_fb_helper_surface_size *sizes)
11896f60e37SRussell King {
11996f60e37SRussell King int ret = 0;
12096f60e37SRussell King
12196f60e37SRussell King if (!fbh->fb) {
1223382a6b9SRussell King ret = armada_fbdev_create(fbh, sizes);
12396f60e37SRussell King if (ret == 0)
12496f60e37SRussell King ret = 1;
12596f60e37SRussell King }
12696f60e37SRussell King return ret;
12796f60e37SRussell King }
12896f60e37SRussell King
1293a493879SThierry Reding static const struct drm_fb_helper_funcs armada_fb_helper_funcs = {
13096f60e37SRussell King .fb_probe = armada_fb_probe,
13196f60e37SRussell King };
13296f60e37SRussell King
133174c3c38SThomas Zimmermann /*
134174c3c38SThomas Zimmermann * Fbdev client and struct drm_client_funcs
135174c3c38SThomas Zimmermann */
136174c3c38SThomas Zimmermann
armada_fbdev_client_unregister(struct drm_client_dev * client)137174c3c38SThomas Zimmermann static void armada_fbdev_client_unregister(struct drm_client_dev *client)
13863c38155SThomas Zimmermann {
13963c38155SThomas Zimmermann struct drm_fb_helper *fbh = drm_fb_helper_from_client(client);
14063c38155SThomas Zimmermann
14163c38155SThomas Zimmermann if (fbh->info) {
14263c38155SThomas Zimmermann drm_fb_helper_unregister_info(fbh);
14363c38155SThomas Zimmermann } else {
14463c38155SThomas Zimmermann drm_client_release(&fbh->client);
14563c38155SThomas Zimmermann drm_fb_helper_unprepare(fbh);
14663c38155SThomas Zimmermann kfree(fbh);
14763c38155SThomas Zimmermann }
14863c38155SThomas Zimmermann }
149174c3c38SThomas Zimmermann
armada_fbdev_client_restore(struct drm_client_dev * client)150174c3c38SThomas Zimmermann static int armada_fbdev_client_restore(struct drm_client_dev *client)
151174c3c38SThomas Zimmermann {
152174c3c38SThomas Zimmermann drm_fb_helper_lastclose(client->dev);
153174c3c38SThomas Zimmermann
154174c3c38SThomas Zimmermann return 0;
155174c3c38SThomas Zimmermann }
156174c3c38SThomas Zimmermann
armada_fbdev_client_hotplug(struct drm_client_dev * client)157174c3c38SThomas Zimmermann static int armada_fbdev_client_hotplug(struct drm_client_dev *client)
158174c3c38SThomas Zimmermann {
15963c38155SThomas Zimmermann struct drm_fb_helper *fbh = drm_fb_helper_from_client(client);
16063c38155SThomas Zimmermann struct drm_device *dev = client->dev;
16163c38155SThomas Zimmermann int ret;
16263c38155SThomas Zimmermann
16363c38155SThomas Zimmermann if (dev->fb_helper)
16463c38155SThomas Zimmermann return drm_fb_helper_hotplug_event(dev->fb_helper);
16563c38155SThomas Zimmermann
16663c38155SThomas Zimmermann ret = drm_fb_helper_init(dev, fbh);
16763c38155SThomas Zimmermann if (ret)
16863c38155SThomas Zimmermann goto err_drm_err;
16963c38155SThomas Zimmermann
17063c38155SThomas Zimmermann if (!drm_drv_uses_atomic_modeset(dev))
17163c38155SThomas Zimmermann drm_helper_disable_unused_functions(dev);
17263c38155SThomas Zimmermann
17363c38155SThomas Zimmermann ret = drm_fb_helper_initial_config(fbh);
17463c38155SThomas Zimmermann if (ret)
17563c38155SThomas Zimmermann goto err_drm_fb_helper_fini;
17663c38155SThomas Zimmermann
177174c3c38SThomas Zimmermann return 0;
17863c38155SThomas Zimmermann
17963c38155SThomas Zimmermann err_drm_fb_helper_fini:
18063c38155SThomas Zimmermann drm_fb_helper_fini(fbh);
18163c38155SThomas Zimmermann err_drm_err:
18263c38155SThomas Zimmermann drm_err(dev, "armada: Failed to setup fbdev emulation (ret=%d)\n", ret);
18363c38155SThomas Zimmermann return ret;
184174c3c38SThomas Zimmermann }
185174c3c38SThomas Zimmermann
186174c3c38SThomas Zimmermann static const struct drm_client_funcs armada_fbdev_client_funcs = {
187174c3c38SThomas Zimmermann .owner = THIS_MODULE,
188174c3c38SThomas Zimmermann .unregister = armada_fbdev_client_unregister,
189174c3c38SThomas Zimmermann .restore = armada_fbdev_client_restore,
190174c3c38SThomas Zimmermann .hotplug = armada_fbdev_client_hotplug,
191174c3c38SThomas Zimmermann };
192174c3c38SThomas Zimmermann
armada_fbdev_setup(struct drm_device * dev)19363c38155SThomas Zimmermann void armada_fbdev_setup(struct drm_device *dev)
19496f60e37SRussell King {
19596f60e37SRussell King struct drm_fb_helper *fbh;
19696f60e37SRussell King int ret;
19796f60e37SRussell King
19863c38155SThomas Zimmermann drm_WARN(dev, !dev->registered, "Device has not been registered.\n");
19963c38155SThomas Zimmermann drm_WARN(dev, dev->fb_helper, "fb_helper is already set!\n");
20063c38155SThomas Zimmermann
20163c38155SThomas Zimmermann fbh = kzalloc(sizeof(*fbh), GFP_KERNEL);
20296f60e37SRussell King if (!fbh)
20363c38155SThomas Zimmermann return;
2046c80a93bSThomas Zimmermann drm_fb_helper_prepare(dev, fbh, 32, &armada_fb_helper_funcs);
20596f60e37SRussell King
20663c38155SThomas Zimmermann ret = drm_client_init(dev, &fbh->client, "fbdev", &armada_fbdev_client_funcs);
20763c38155SThomas Zimmermann if (ret) {
20863c38155SThomas Zimmermann drm_err(dev, "Failed to register client: %d\n", ret);
20963c38155SThomas Zimmermann goto err_drm_client_init;
21063c38155SThomas Zimmermann }
21163c38155SThomas Zimmermann
21263c38155SThomas Zimmermann drm_client_register(&fbh->client);
21396f60e37SRussell King
21463c38155SThomas Zimmermann return;
21596f60e37SRussell King
21663c38155SThomas Zimmermann err_drm_client_init:
2173fb1f62fSThomas Zimmermann drm_fb_helper_unprepare(fbh);
21863c38155SThomas Zimmermann kfree(fbh);
21963c38155SThomas Zimmermann return;
22096f60e37SRussell King }
221