vmwgfx_gmr.c 4.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150
  1. // SPDX-License-Identifier: GPL-2.0 OR MIT
  2. /**************************************************************************
  3. *
  4. * Copyright 2009-2015 VMware, Inc., Palo Alto, CA., USA
  5. *
  6. * Permission is hereby granted, free of charge, to any person obtaining a
  7. * copy of this software and associated documentation files (the
  8. * "Software"), to deal in the Software without restriction, including
  9. * without limitation the rights to use, copy, modify, merge, publish,
  10. * distribute, sub license, and/or sell copies of the Software, and to
  11. * permit persons to whom the Software is furnished to do so, subject to
  12. * the following conditions:
  13. *
  14. * The above copyright notice and this permission notice (including the
  15. * next paragraph) shall be included in all copies or substantial portions
  16. * of the Software.
  17. *
  18. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  19. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  20. * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
  21. * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
  22. * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
  23. * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
  24. * USE OR OTHER DEALINGS IN THE SOFTWARE.
  25. *
  26. **************************************************************************/
  27. #include <drm/ttm/ttm_bo_driver.h>
  28. #include "vmwgfx_drv.h"
  29. #define VMW_PPN_SIZE (sizeof(unsigned long))
  30. /* A future safe maximum remap size. */
  31. #define VMW_PPN_PER_REMAP ((31 * 1024) / VMW_PPN_SIZE)
  32. #define DMA_ADDR_INVALID ((dma_addr_t) 0)
  33. #define DMA_PAGE_INVALID 0UL
  34. static int vmw_gmr2_bind(struct vmw_private *dev_priv,
  35. struct vmw_piter *iter,
  36. unsigned long num_pages,
  37. int gmr_id)
  38. {
  39. SVGAFifoCmdDefineGMR2 define_cmd;
  40. SVGAFifoCmdRemapGMR2 remap_cmd;
  41. uint32_t *cmd;
  42. uint32_t *cmd_orig;
  43. uint32_t define_size = sizeof(define_cmd) + sizeof(*cmd);
  44. uint32_t remap_num = num_pages / VMW_PPN_PER_REMAP + ((num_pages % VMW_PPN_PER_REMAP) > 0);
  45. uint32_t remap_size = VMW_PPN_SIZE * num_pages + (sizeof(remap_cmd) + sizeof(*cmd)) * remap_num;
  46. uint32_t remap_pos = 0;
  47. uint32_t cmd_size = define_size + remap_size;
  48. uint32_t i;
  49. cmd_orig = cmd = VMW_FIFO_RESERVE(dev_priv, cmd_size);
  50. if (unlikely(cmd == NULL))
  51. return -ENOMEM;
  52. define_cmd.gmrId = gmr_id;
  53. define_cmd.numPages = num_pages;
  54. *cmd++ = SVGA_CMD_DEFINE_GMR2;
  55. memcpy(cmd, &define_cmd, sizeof(define_cmd));
  56. cmd += sizeof(define_cmd) / sizeof(*cmd);
  57. /*
  58. * Need to split the command if there are too many
  59. * pages that goes into the gmr.
  60. */
  61. remap_cmd.gmrId = gmr_id;
  62. remap_cmd.flags = (VMW_PPN_SIZE > sizeof(*cmd)) ?
  63. SVGA_REMAP_GMR2_PPN64 : SVGA_REMAP_GMR2_PPN32;
  64. while (num_pages > 0) {
  65. unsigned long nr = min(num_pages, (unsigned long)VMW_PPN_PER_REMAP);
  66. remap_cmd.offsetPages = remap_pos;
  67. remap_cmd.numPages = nr;
  68. *cmd++ = SVGA_CMD_REMAP_GMR2;
  69. memcpy(cmd, &remap_cmd, sizeof(remap_cmd));
  70. cmd += sizeof(remap_cmd) / sizeof(*cmd);
  71. for (i = 0; i < nr; ++i) {
  72. if (VMW_PPN_SIZE <= 4)
  73. *cmd = vmw_piter_dma_addr(iter) >> PAGE_SHIFT;
  74. else
  75. *((uint64_t *)cmd) = vmw_piter_dma_addr(iter) >>
  76. PAGE_SHIFT;
  77. cmd += VMW_PPN_SIZE / sizeof(*cmd);
  78. vmw_piter_next(iter);
  79. }
  80. num_pages -= nr;
  81. remap_pos += nr;
  82. }
  83. BUG_ON(cmd != cmd_orig + cmd_size / sizeof(*cmd));
  84. vmw_fifo_commit(dev_priv, cmd_size);
  85. return 0;
  86. }
  87. static void vmw_gmr2_unbind(struct vmw_private *dev_priv,
  88. int gmr_id)
  89. {
  90. SVGAFifoCmdDefineGMR2 define_cmd;
  91. uint32_t define_size = sizeof(define_cmd) + 4;
  92. uint32_t *cmd;
  93. cmd = VMW_FIFO_RESERVE(dev_priv, define_size);
  94. if (unlikely(cmd == NULL))
  95. return;
  96. define_cmd.gmrId = gmr_id;
  97. define_cmd.numPages = 0;
  98. *cmd++ = SVGA_CMD_DEFINE_GMR2;
  99. memcpy(cmd, &define_cmd, sizeof(define_cmd));
  100. vmw_fifo_commit(dev_priv, define_size);
  101. }
  102. int vmw_gmr_bind(struct vmw_private *dev_priv,
  103. const struct vmw_sg_table *vsgt,
  104. unsigned long num_pages,
  105. int gmr_id)
  106. {
  107. struct vmw_piter data_iter;
  108. vmw_piter_start(&data_iter, vsgt, 0);
  109. if (unlikely(!vmw_piter_next(&data_iter)))
  110. return 0;
  111. if (unlikely(!(dev_priv->capabilities & SVGA_CAP_GMR2)))
  112. return -EINVAL;
  113. return vmw_gmr2_bind(dev_priv, &data_iter, num_pages, gmr_id);
  114. }
  115. void vmw_gmr_unbind(struct vmw_private *dev_priv, int gmr_id)
  116. {
  117. if (likely(dev_priv->capabilities & SVGA_CAP_GMR2))
  118. vmw_gmr2_unbind(dev_priv, gmr_id);
  119. }