armada_fbdev.c 4.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197
  1. /*
  2. * Copyright (C) 2012 Russell King
  3. * Written from the i915 driver.
  4. *
  5. * This program is free software; you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License version 2 as
  7. * published by the Free Software Foundation.
  8. */
  9. #include <linux/errno.h>
  10. #include <linux/kernel.h>
  11. #include <linux/module.h>
  12. #include <drm/drmP.h>
  13. #include <drm/drm_fb_helper.h>
  14. #include "armada_crtc.h"
  15. #include "armada_drm.h"
  16. #include "armada_fb.h"
  17. #include "armada_gem.h"
  18. static /*const*/ struct fb_ops armada_fb_ops = {
  19. .owner = THIS_MODULE,
  20. .fb_check_var = drm_fb_helper_check_var,
  21. .fb_set_par = drm_fb_helper_set_par,
  22. .fb_fillrect = drm_fb_helper_cfb_fillrect,
  23. .fb_copyarea = drm_fb_helper_cfb_copyarea,
  24. .fb_imageblit = drm_fb_helper_cfb_imageblit,
  25. .fb_pan_display = drm_fb_helper_pan_display,
  26. .fb_blank = drm_fb_helper_blank,
  27. .fb_setcmap = drm_fb_helper_setcmap,
  28. .fb_debug_enter = drm_fb_helper_debug_enter,
  29. .fb_debug_leave = drm_fb_helper_debug_leave,
  30. };
  31. static int armada_fb_create(struct drm_fb_helper *fbh,
  32. struct drm_fb_helper_surface_size *sizes)
  33. {
  34. struct drm_device *dev = fbh->dev;
  35. struct drm_mode_fb_cmd2 mode;
  36. struct armada_framebuffer *dfb;
  37. struct armada_gem_object *obj;
  38. struct fb_info *info;
  39. int size, ret;
  40. void *ptr;
  41. memset(&mode, 0, sizeof(mode));
  42. mode.width = sizes->surface_width;
  43. mode.height = sizes->surface_height;
  44. mode.pitches[0] = armada_pitch(mode.width, sizes->surface_bpp);
  45. mode.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
  46. sizes->surface_depth);
  47. size = mode.pitches[0] * mode.height;
  48. obj = armada_gem_alloc_private_object(dev, size);
  49. if (!obj) {
  50. DRM_ERROR("failed to allocate fb memory\n");
  51. return -ENOMEM;
  52. }
  53. ret = armada_gem_linear_back(dev, obj);
  54. if (ret) {
  55. drm_gem_object_unreference_unlocked(&obj->obj);
  56. return ret;
  57. }
  58. ptr = armada_gem_map_object(dev, obj);
  59. if (!ptr) {
  60. drm_gem_object_unreference_unlocked(&obj->obj);
  61. return -ENOMEM;
  62. }
  63. dfb = armada_framebuffer_create(dev, &mode, obj);
  64. /*
  65. * A reference is now held by the framebuffer object if
  66. * successful, otherwise this drops the ref for the error path.
  67. */
  68. drm_gem_object_unreference_unlocked(&obj->obj);
  69. if (IS_ERR(dfb))
  70. return PTR_ERR(dfb);
  71. info = drm_fb_helper_alloc_fbi(fbh);
  72. if (IS_ERR(info)) {
  73. ret = PTR_ERR(info);
  74. goto err_fballoc;
  75. }
  76. strlcpy(info->fix.id, "armada-drmfb", sizeof(info->fix.id));
  77. info->par = fbh;
  78. info->flags = FBINFO_DEFAULT | FBINFO_CAN_FORCE_OUTPUT;
  79. info->fbops = &armada_fb_ops;
  80. info->fix.smem_start = obj->phys_addr;
  81. info->fix.smem_len = obj->obj.size;
  82. info->screen_size = obj->obj.size;
  83. info->screen_base = ptr;
  84. fbh->fb = &dfb->fb;
  85. drm_fb_helper_fill_fix(info, dfb->fb.pitches[0], dfb->fb.depth);
  86. drm_fb_helper_fill_var(info, fbh, sizes->fb_width, sizes->fb_height);
  87. DRM_DEBUG_KMS("allocated %dx%d %dbpp fb: 0x%08llx\n",
  88. dfb->fb.width, dfb->fb.height, dfb->fb.bits_per_pixel,
  89. (unsigned long long)obj->phys_addr);
  90. return 0;
  91. err_fballoc:
  92. dfb->fb.funcs->destroy(&dfb->fb);
  93. return ret;
  94. }
  95. static int armada_fb_probe(struct drm_fb_helper *fbh,
  96. struct drm_fb_helper_surface_size *sizes)
  97. {
  98. int ret = 0;
  99. if (!fbh->fb) {
  100. ret = armada_fb_create(fbh, sizes);
  101. if (ret == 0)
  102. ret = 1;
  103. }
  104. return ret;
  105. }
  106. static const struct drm_fb_helper_funcs armada_fb_helper_funcs = {
  107. .gamma_set = armada_drm_crtc_gamma_set,
  108. .gamma_get = armada_drm_crtc_gamma_get,
  109. .fb_probe = armada_fb_probe,
  110. };
  111. int armada_fbdev_init(struct drm_device *dev)
  112. {
  113. struct armada_private *priv = dev->dev_private;
  114. struct drm_fb_helper *fbh;
  115. int ret;
  116. fbh = devm_kzalloc(dev->dev, sizeof(*fbh), GFP_KERNEL);
  117. if (!fbh)
  118. return -ENOMEM;
  119. priv->fbdev = fbh;
  120. drm_fb_helper_prepare(dev, fbh, &armada_fb_helper_funcs);
  121. ret = drm_fb_helper_init(dev, fbh, 1, 1);
  122. if (ret) {
  123. DRM_ERROR("failed to initialize drm fb helper\n");
  124. goto err_fb_helper;
  125. }
  126. ret = drm_fb_helper_single_add_all_connectors(fbh);
  127. if (ret) {
  128. DRM_ERROR("failed to add fb connectors\n");
  129. goto err_fb_setup;
  130. }
  131. ret = drm_fb_helper_initial_config(fbh, 32);
  132. if (ret) {
  133. DRM_ERROR("failed to set initial config\n");
  134. goto err_fb_setup;
  135. }
  136. return 0;
  137. err_fb_setup:
  138. drm_fb_helper_release_fbi(fbh);
  139. drm_fb_helper_fini(fbh);
  140. err_fb_helper:
  141. priv->fbdev = NULL;
  142. return ret;
  143. }
  144. void armada_fbdev_lastclose(struct drm_device *dev)
  145. {
  146. struct armada_private *priv = dev->dev_private;
  147. if (priv->fbdev)
  148. drm_fb_helper_restore_fbdev_mode_unlocked(priv->fbdev);
  149. }
  150. void armada_fbdev_fini(struct drm_device *dev)
  151. {
  152. struct armada_private *priv = dev->dev_private;
  153. struct drm_fb_helper *fbh = priv->fbdev;
  154. if (fbh) {
  155. drm_fb_helper_unregister_fbi(fbh);
  156. drm_fb_helper_release_fbi(fbh);
  157. drm_fb_helper_fini(fbh);
  158. if (fbh->fb)
  159. fbh->fb->funcs->destroy(fbh->fb);
  160. priv->fbdev = NULL;
  161. }
  162. }