drm/armada/armada_fbdev.c

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 /*
0003  * Copyright (C) 2012 Russell King
0004  *  Written from the i915 driver.
0005  */
0006
0007 #include <linux/errno.h>
0008 #include <linux/kernel.h>
0009 #include <linux/module.h>
0010
0011 #include <drm/drm_fb_helper.h>
0012 #include <drm/drm_fourcc.h>
0013
0014 #include "armada_crtc.h"
0015 #include "armada_drm.h"
0016 #include "armada_fb.h"
0017 #include "armada_gem.h"
0018
0019 static const struct fb_ops armada_fb_ops = {
0020     .owner      = THIS_MODULE,
0021     DRM_FB_HELPER_DEFAULT_OPS,
0022     .fb_fillrect    = drm_fb_helper_cfb_fillrect,
0023     .fb_copyarea    = drm_fb_helper_cfb_copyarea,
0024     .fb_imageblit   = drm_fb_helper_cfb_imageblit,
0025 };
0026
0027 static int armada_fbdev_create(struct drm_fb_helper *fbh,
0028     struct drm_fb_helper_surface_size *sizes)
0029 {
0030     struct drm_device *dev = fbh->dev;
0031     struct drm_mode_fb_cmd2 mode;
0032     struct armada_framebuffer *dfb;
0033     struct armada_gem_object *obj;
0034     struct fb_info *info;
0035     int size, ret;
0036     void *ptr;
0037
0038     memset(&mode, 0, sizeof(mode));
0039     mode.width = sizes->surface_width;
0040     mode.height = sizes->surface_height;
0041     mode.pitches[0] = armada_pitch(mode.width, sizes->surface_bpp);
0042     mode.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
0043                     sizes->surface_depth);
0044
0045     size = mode.pitches[0] * mode.height;
0046     obj = armada_gem_alloc_private_object(dev, size);
0047     if (!obj) {
0048         DRM_ERROR("failed to allocate fb memory\n");
0049         return -ENOMEM;
0050     }
0051
0052     ret = armada_gem_linear_back(dev, obj);
0053     if (ret) {
0054         drm_gem_object_put(&obj->obj);
0055         return ret;
0056     }
0057
0058     ptr = armada_gem_map_object(dev, obj);
0059     if (!ptr) {
0060         drm_gem_object_put(&obj->obj);
0061         return -ENOMEM;
0062     }
0063
0064     dfb = armada_framebuffer_create(dev, &mode, obj);
0065
0066     /*
0067      * A reference is now held by the framebuffer object if
0068      * successful, otherwise this drops the ref for the error path.
0069      */
0070     drm_gem_object_put(&obj->obj);
0071
0072     if (IS_ERR(dfb))
0073         return PTR_ERR(dfb);
0074
0075     info = drm_fb_helper_alloc_fbi(fbh);
0076     if (IS_ERR(info)) {
0077         ret = PTR_ERR(info);
0078         goto err_fballoc;
0079     }
0080
0081     info->fbops = &armada_fb_ops;
0082     info->fix.smem_start = obj->phys_addr;
0083     info->fix.smem_len = obj->obj.size;
0084     info->screen_size = obj->obj.size;
0085     info->screen_base = ptr;
0086     fbh->fb = &dfb->fb;
0087
0088     drm_fb_helper_fill_info(info, fbh, sizes);
0089
0090     DRM_DEBUG_KMS("allocated %dx%d %dbpp fb: 0x%08llx\n",
0091         dfb->fb.width, dfb->fb.height, dfb->fb.format->cpp[0] * 8,
0092         (unsigned long long)obj->phys_addr);
0093
0094     return 0;
0095
0096  err_fballoc:
0097     dfb->fb.funcs->destroy(&dfb->fb);
0098     return ret;
0099 }
0100
0101 static int armada_fb_probe(struct drm_fb_helper *fbh,
0102     struct drm_fb_helper_surface_size *sizes)
0103 {
0104     int ret = 0;
0105
0106     if (!fbh->fb) {
0107         ret = armada_fbdev_create(fbh, sizes);
0108         if (ret == 0)
0109             ret = 1;
0110     }
0111     return ret;
0112 }
0113
0114 static const struct drm_fb_helper_funcs armada_fb_helper_funcs = {
0115     .fb_probe   = armada_fb_probe,
0116 };
0117
0118 int armada_fbdev_init(struct drm_device *dev)
0119 {
0120     struct armada_private *priv = drm_to_armada_dev(dev);
0121     struct drm_fb_helper *fbh;
0122     int ret;
0123
0124     fbh = devm_kzalloc(dev->dev, sizeof(*fbh), GFP_KERNEL);
0125     if (!fbh)
0126         return -ENOMEM;
0127
0128     priv->fbdev = fbh;
0129
0130     drm_fb_helper_prepare(dev, fbh, &armada_fb_helper_funcs);
0131
0132     ret = drm_fb_helper_init(dev, fbh);
0133     if (ret) {
0134         DRM_ERROR("failed to initialize drm fb helper\n");
0135         goto err_fb_helper;
0136     }
0137
0138     ret = drm_fb_helper_initial_config(fbh, 32);
0139     if (ret) {
0140         DRM_ERROR("failed to set initial config\n");
0141         goto err_fb_setup;
0142     }
0143
0144     return 0;
0145  err_fb_setup:
0146     drm_fb_helper_fini(fbh);
0147  err_fb_helper:
0148     priv->fbdev = NULL;
0149     return ret;
0150 }
0151
0152 void armada_fbdev_fini(struct drm_device *dev)
0153 {
0154     struct armada_private *priv = drm_to_armada_dev(dev);
0155     struct drm_fb_helper *fbh = priv->fbdev;
0156
0157     if (fbh) {
0158         drm_fb_helper_unregister_fbi(fbh);
0159
0160         drm_fb_helper_fini(fbh);
0161
0162         if (fbh->fb)
0163             fbh->fb->funcs->destroy(fbh->fb);
0164
0165         priv->fbdev = NULL;
0166     }
0167 }