drivers/gpu/drm/vmwgfx/vmwgfx_gmr.c

   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
  28
  29 #include "vmwgfx_drv.h"
  30
  31 #define VMW_PPN_SIZE (sizeof(unsigned long))
  32 /* A future safe maximum remap size. */
  33 #define VMW_PPN_PER_REMAP ((31 * 1024) / VMW_PPN_SIZE)
  34 #define DMA_ADDR_INVALID ((dma_addr_t) 0)
  35 #define DMA_PAGE_INVALID 0UL
  36
  37 static int vmw_gmr2_bind(struct vmw_private *dev_priv,
  38                          struct vmw_piter *iter,
  39                          unsigned long num_pages,
  40                          int gmr_id)
  41 {
  42         SVGAFifoCmdDefineGMR2 define_cmd;
  43         SVGAFifoCmdRemapGMR2 remap_cmd;
  44         uint32_t *cmd;
  45         uint32_t *cmd_orig;
  46         uint32_t define_size = sizeof(define_cmd) + sizeof(*cmd);
  47         uint32_t remap_num = num_pages / VMW_PPN_PER_REMAP + ((num_pages % VMW_PPN_PER_REMAP) > 0);
  48         uint32_t remap_size = VMW_PPN_SIZE * num_pages + (sizeof(remap_cmd) + sizeof(*cmd)) * remap_num;
  49         uint32_t remap_pos = 0;
  50         uint32_t cmd_size = define_size + remap_size;
  51         uint32_t i;
  52
  53         cmd_orig = cmd = VMW_CMD_RESERVE(dev_priv, cmd_size);
  54         if (unlikely(cmd == NULL))
  55                 return -ENOMEM;
  56
  57         define_cmd.gmrId = gmr_id;
  58         define_cmd.numPages = num_pages;
  59
  60         *cmd++ = SVGA_CMD_DEFINE_GMR2;
  61         memcpy(cmd, &define_cmd, sizeof(define_cmd));
  62         cmd += sizeof(define_cmd) / sizeof(*cmd);
  63
  64         /*
  65          * Need to split the command if there are too many
  66          * pages that goes into the gmr.
  67          */
  68
  69         remap_cmd.gmrId = gmr_id;
  70         remap_cmd.flags = (VMW_PPN_SIZE > sizeof(*cmd)) ?
  71                 SVGA_REMAP_GMR2_PPN64 : SVGA_REMAP_GMR2_PPN32;
  72
  73         while (num_pages > 0) {
  74                 unsigned long nr = min_t(unsigned long, num_pages, VMW_PPN_PER_REMAP);
  75
  76                 remap_cmd.offsetPages = remap_pos;
  77                 remap_cmd.numPages = nr;
  78
  79                 *cmd++ = SVGA_CMD_REMAP_GMR2;
  80                 memcpy(cmd, &remap_cmd, sizeof(remap_cmd));
  81                 cmd += sizeof(remap_cmd) / sizeof(*cmd);
  82
  83                 for (i = 0; i < nr; ++i) {
  84                         if (VMW_PPN_SIZE <= 4)
  85                                 *cmd = vmw_piter_dma_addr(iter) >> PAGE_SHIFT;
  86                         else
  87                                 *((uint64_t *)cmd) = vmw_piter_dma_addr(iter) >>
  88                                         PAGE_SHIFT;
  89
  90                         cmd += VMW_PPN_SIZE / sizeof(*cmd);
  91                         vmw_piter_next(iter);
  92                 }
  93
  94                 num_pages -= nr;
  95                 remap_pos += nr;
  96         }
  97
  98         BUG_ON(cmd != cmd_orig + cmd_size / sizeof(*cmd));
  99
 100         vmw_cmd_commit(dev_priv, cmd_size);
 101
 102         return 0;
 103 }
 104
 105 static void vmw_gmr2_unbind(struct vmw_private *dev_priv,
 106                             int gmr_id)
 107 {
 108         SVGAFifoCmdDefineGMR2 define_cmd;
 109         uint32_t define_size = sizeof(define_cmd) + 4;
 110         uint32_t *cmd;
 111
 112         cmd = VMW_CMD_RESERVE(dev_priv, define_size);
 113         if (unlikely(cmd == NULL))
 114                 return;
 115
 116         define_cmd.gmrId = gmr_id;
 117         define_cmd.numPages = 0;
 118
 119         *cmd++ = SVGA_CMD_DEFINE_GMR2;
 120         memcpy(cmd, &define_cmd, sizeof(define_cmd));
 121
 122         vmw_cmd_commit(dev_priv, define_size);
 123 }
 124
 125
 126 int vmw_gmr_bind(struct vmw_private *dev_priv,
 127                  const struct vmw_sg_table *vsgt,
 128                  unsigned long num_pages,
 129                  int gmr_id)
 130 {
 131         struct vmw_piter data_iter;
 132
 133         vmw_piter_start(&data_iter, vsgt, 0);
 134
 135         if (unlikely(!vmw_piter_next(&data_iter)))
 136                 return 0;
 137
 138         if (unlikely(!(dev_priv->capabilities & SVGA_CAP_GMR2)))
 139                 return -EINVAL;
 140
 141         return vmw_gmr2_bind(dev_priv, &data_iter, num_pages, gmr_id);
 142 }
 143
 144
 145 void vmw_gmr_unbind(struct vmw_private *dev_priv, int gmr_id)
 146 {
 147         if (likely(dev_priv->capabilities & SVGA_CAP_GMR2))
 148                 vmw_gmr2_unbind(dev_priv, gmr_id);
 149 }