drivers/gpu/drm/drm_fb_cma_helper.c

   1 /*
   2  * drm kms/fb cma (contiguous memory allocator) helper functions
   3  *
   4  * Copyright (C) 2012 Analog Device Inc.
   5  *   Author: Lars-Peter Clausen <lars@metafoo.de>
   6  *
   7  * Based on udl_fbdev.c
   8  *  Copyright (C) 2012 Red Hat
   9  *
  10  * This program is free software; you can redistribute it and/or
  11  * modify it under the terms of the GNU General Public License
  12  * as published by the Free Software Foundation; either version 2
  13  * of the License, or (at your option) any later version.
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  */
  19
  20 #include <drm/drmP.h>
  21 #include <drm/drm_client.h>
  22 #include <drm/drm_fb_helper.h>
  23 #include <drm/drm_framebuffer.h>
  24 #include <drm/drm_gem_cma_helper.h>
  25 #include <drm/drm_gem_framebuffer_helper.h>
  26 #include <drm/drm_fb_cma_helper.h>
  27 #include <drm/drm_print.h>
  28 #include <linux/module.h>
  29
  30 struct drm_fbdev_cma {
  31         struct drm_fb_helper    fb_helper;
  32 };
  33
  34 /**
  35  * DOC: framebuffer cma helper functions
  36  *
  37  * Provides helper functions for creating a cma (contiguous memory allocator)
  38  * backed framebuffer.
  39  *
  40  * drm_gem_fb_create() is used in the &drm_mode_config_funcs.fb_create
  41  * callback function to create a cma backed framebuffer.
  42  *
  43  * An fbdev framebuffer backed by cma is also available by calling
  44  * drm_fb_cma_fbdev_init(). drm_fb_cma_fbdev_fini() tears it down.
  45  */
  46
  47 static inline struct drm_fbdev_cma *to_fbdev_cma(struct drm_fb_helper *helper)
  48 {
  49         return container_of(helper, struct drm_fbdev_cma, fb_helper);
  50 }
  51
  52 /**
  53  * drm_fb_cma_get_gem_obj() - Get CMA GEM object for framebuffer
  54  * @fb: The framebuffer
  55  * @plane: Which plane
  56  *
  57  * Return the CMA GEM object for given framebuffer.
  58  *
  59  * This function will usually be called from the CRTC callback functions.
  60  */
  61 struct drm_gem_cma_object *drm_fb_cma_get_gem_obj(struct drm_framebuffer *fb,
  62                                                   unsigned int plane)
  63 {
  64         struct drm_gem_object *gem;
  65
  66         gem = drm_gem_fb_get_obj(fb, plane);
  67         if (!gem)
  68                 return NULL;
  69
  70         return to_drm_gem_cma_obj(gem);
  71 }
  72 EXPORT_SYMBOL_GPL(drm_fb_cma_get_gem_obj);
  73
  74 /**
  75  * drm_fb_cma_get_gem_addr() - Get physical address for framebuffer
  76  * @fb: The framebuffer
  77  * @state: Which state of drm plane
  78  * @plane: Which plane
  79  * Return the CMA GEM address for given framebuffer.
  80  *
  81  * This function will usually be called from the PLANE callback functions.
  82  */
  83 dma_addr_t drm_fb_cma_get_gem_addr(struct drm_framebuffer *fb,
  84                                    struct drm_plane_state *state,
  85                                    unsigned int plane)
  86 {
  87         struct drm_gem_cma_object *obj;
  88         dma_addr_t paddr;
  89
  90         obj = drm_fb_cma_get_gem_obj(fb, plane);
  91         if (!obj)
  92                 return 0;
  93
  94         paddr = obj->paddr + fb->offsets[plane];
  95         paddr += fb->format->cpp[plane] * (state->src_x >> 16);
  96         paddr += fb->pitches[plane] * (state->src_y >> 16);
  97
  98         return paddr;
  99 }
 100 EXPORT_SYMBOL_GPL(drm_fb_cma_get_gem_addr);
 101
 102 /**
 103  * drm_fb_cma_fbdev_init() - Allocate and initialize fbdev emulation
 104  * @dev: DRM device
 105  * @preferred_bpp: Preferred bits per pixel for the device.
 106  *                 @dev->mode_config.preferred_depth is used if this is zero.
 107  * @max_conn_count: Maximum number of connectors.
 108  *                  @dev->mode_config.num_connector is used if this is zero.
 109  *
 110  * Returns:
 111  * Zero on success or negative error code on failure.
 112  */
 113 int drm_fb_cma_fbdev_init(struct drm_device *dev, unsigned int preferred_bpp,
 114                           unsigned int max_conn_count)
 115 {
 116         struct drm_fbdev_cma *fbdev_cma;
 117
 118         /* dev->fb_helper will indirectly point to fbdev_cma after this call */
 119         fbdev_cma = drm_fbdev_cma_init(dev, preferred_bpp, max_conn_count);
 120         if (IS_ERR(fbdev_cma))
 121                 return PTR_ERR(fbdev_cma);
 122
 123         return 0;
 124 }
 125 EXPORT_SYMBOL_GPL(drm_fb_cma_fbdev_init);
 126
 127 /**
 128  * drm_fb_cma_fbdev_fini() - Teardown fbdev emulation
 129  * @dev: DRM device
 130  */
 131 void drm_fb_cma_fbdev_fini(struct drm_device *dev)
 132 {
 133         if (dev->fb_helper)
 134                 drm_fbdev_cma_fini(to_fbdev_cma(dev->fb_helper));
 135 }
 136 EXPORT_SYMBOL_GPL(drm_fb_cma_fbdev_fini);
 137
 138 static const struct drm_fb_helper_funcs drm_fb_cma_helper_funcs = {
 139         .fb_probe = drm_fb_helper_generic_probe,
 140 };
 141
 142 /**
 143  * drm_fbdev_cma_init() - Allocate and initializes a drm_fbdev_cma struct
 144  * @dev: DRM device
 145  * @preferred_bpp: Preferred bits per pixel for the device
 146  * @max_conn_count: Maximum number of connectors
 147  *
 148  * Returns a newly allocated drm_fbdev_cma struct or a ERR_PTR.
 149  */
 150 struct drm_fbdev_cma *drm_fbdev_cma_init(struct drm_device *dev,
 151         unsigned int preferred_bpp, unsigned int max_conn_count)
 152 {
 153         struct drm_fbdev_cma *fbdev_cma;
 154         struct drm_fb_helper *fb_helper;
 155         int ret;
 156
 157         fbdev_cma = kzalloc(sizeof(*fbdev_cma), GFP_KERNEL);
 158         if (!fbdev_cma)
 159                 return ERR_PTR(-ENOMEM);
 160
 161         fb_helper = &fbdev_cma->fb_helper;
 162
 163         ret = drm_client_new(dev, &fb_helper->client, "fbdev", NULL);
 164         if (ret)
 165                 goto err_free;
 166
 167         ret = drm_fb_helper_fbdev_setup(dev, fb_helper, &drm_fb_cma_helper_funcs,
 168                                         preferred_bpp, max_conn_count);
 169         if (ret)
 170                 goto err_client_put;
 171
 172         return fbdev_cma;
 173
 174 err_client_put:
 175         drm_client_release(&fb_helper->client);
 176 err_free:
 177         kfree(fbdev_cma);
 178
 179         return ERR_PTR(ret);
 180 }
 181 EXPORT_SYMBOL_GPL(drm_fbdev_cma_init);
 182
 183 /**
 184  * drm_fbdev_cma_fini() - Free drm_fbdev_cma struct
 185  * @fbdev_cma: The drm_fbdev_cma struct
 186  */
 187 void drm_fbdev_cma_fini(struct drm_fbdev_cma *fbdev_cma)
 188 {
 189         drm_fb_helper_unregister_fbi(&fbdev_cma->fb_helper);
 190         /* All resources have now been freed by drm_fbdev_fb_destroy() */
 191 }
 192 EXPORT_SYMBOL_GPL(drm_fbdev_cma_fini);
 193
 194 /**
 195  * drm_fbdev_cma_restore_mode() - Restores initial framebuffer mode
 196  * @fbdev_cma: The drm_fbdev_cma struct, may be NULL
 197  *
 198  * This function is usually called from the &drm_driver.lastclose callback.
 199  */
 200 void drm_fbdev_cma_restore_mode(struct drm_fbdev_cma *fbdev_cma)
 201 {
 202         if (fbdev_cma)
 203                 drm_fb_helper_restore_fbdev_mode_unlocked(&fbdev_cma->fb_helper);
 204 }
 205 EXPORT_SYMBOL_GPL(drm_fbdev_cma_restore_mode);
 206
 207 /**
 208  * drm_fbdev_cma_hotplug_event() - Poll for hotpulug events
 209  * @fbdev_cma: The drm_fbdev_cma struct, may be NULL
 210  *
 211  * This function is usually called from the &drm_mode_config.output_poll_changed
 212  * callback.
 213  */
 214 void drm_fbdev_cma_hotplug_event(struct drm_fbdev_cma *fbdev_cma)
 215 {
 216         if (fbdev_cma)
 217                 drm_fb_helper_hotplug_event(&fbdev_cma->fb_helper);
 218 }
 219 EXPORT_SYMBOL_GPL(drm_fbdev_cma_hotplug_event);
 220
 221 /**
 222  * drm_fbdev_cma_set_suspend - wrapper around drm_fb_helper_set_suspend
 223  * @fbdev_cma: The drm_fbdev_cma struct, may be NULL
 224  * @state: desired state, zero to resume, non-zero to suspend
 225  *
 226  * Calls drm_fb_helper_set_suspend, which is a wrapper around
 227  * fb_set_suspend implemented by fbdev core.
 228  */
 229 void drm_fbdev_cma_set_suspend(struct drm_fbdev_cma *fbdev_cma, bool state)
 230 {
 231         if (fbdev_cma)
 232                 drm_fb_helper_set_suspend(&fbdev_cma->fb_helper, state);
 233 }
 234 EXPORT_SYMBOL(drm_fbdev_cma_set_suspend);
 235
 236 /**
 237  * drm_fbdev_cma_set_suspend_unlocked - wrapper around
 238  *                                      drm_fb_helper_set_suspend_unlocked
 239  * @fbdev_cma: The drm_fbdev_cma struct, may be NULL
 240  * @state: desired state, zero to resume, non-zero to suspend
 241  *
 242  * Calls drm_fb_helper_set_suspend, which is a wrapper around
 243  * fb_set_suspend implemented by fbdev core.
 244  */
 245 void drm_fbdev_cma_set_suspend_unlocked(struct drm_fbdev_cma *fbdev_cma,
 246                                         bool state)
 247 {
 248         if (fbdev_cma)
 249                 drm_fb_helper_set_suspend_unlocked(&fbdev_cma->fb_helper,
 250                                                    state);
 251 }
 252 EXPORT_SYMBOL(drm_fbdev_cma_set_suspend_unlocked);