sys/dev/drm2/drm_vm.c

   1 /*-
   2  * Copyright 2003 Eric Anholt
   3  * All Rights Reserved.
   4  *
   5  * Permission is hereby granted, free of charge, to any person obtaining a
   6  * copy of this software and associated documentation files (the "Software"),
   7  * to deal in the Software without restriction, including without limitation
   8  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   9  * and/or sell copies of the Software, and to permit persons to whom the
  10  * Software is furnished to do so, subject to the following conditions:
  11  *
  12  * The above copyright notice and this permission notice (including the next
  13  * paragraph) shall be included in all copies or substantial portions of the
  14  * Software.
  15  *
  16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  19  * ERIC ANHOLT BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
  20  * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  21  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  22  *
  23  * $FreeBSD: head/sys/dev/drm2/drm_vm.c 235783 2012-05-22 11:07:44Z kib $"
  24  */
  25
  26 /** @file drm_vm.c
  27  * Support code for mmaping of DRM maps.
  28  */
  29
  30 #include <sys/conf.h>
  31 #include <dev/drm2/drmP.h>
  32 #include <dev/drm2/drm.h>
  33 #include <sys/mutex2.h>
  34 #include <vm/vm_page.h>
  35 #include <vm/vm_pager.h>
  36
  37 int
  38 drm_mmap(struct dev_mmap_args *ap)
  39 /*
  40                 struct cdev *kdev, vm_ooffset_t offset, vm_paddr_t *paddr,
  41     int prot, vm_memattr_t *memattr)*/
  42 {
  43         struct cdev *kdev = ap->a_head.a_dev;
  44         vm_offset_t offset = ap->a_offset;
  45         struct drm_device *dev = drm_get_device_from_kdev(kdev);
  46         struct drm_file *file_priv = NULL;
  47         drm_local_map_t *map;
  48         enum drm_map_type type;
  49         vm_paddr_t phys;
  50
  51         /* d_mmap gets called twice, we can only reference file_priv during
  52          * the first call.  We need to assume that if error is EBADF the
  53          * call was succesful and the client is authenticated.
  54          */
  55         DRM_LOCK(dev);
  56         file_priv = drm_find_file_by_proc(dev, curthread);
  57         DRM_UNLOCK(dev);
  58
  59         if (!file_priv) {
  60                 DRM_ERROR("Could not find authenticator!\n");
  61                 return EINVAL;
  62         }
  63
  64         if (!file_priv->authenticated)
  65                 return EACCES;
  66
  67         DRM_DEBUG("called with offset %016jx\n", (uintmax_t)offset);
  68         if (dev->dma && offset < ptoa(dev->dma->page_count)) {
  69                 drm_device_dma_t *dma = dev->dma;
  70
  71                 DRM_SPINLOCK(&dev->dma_lock);
  72
  73                 if (dma->pagelist != NULL) {
  74                         unsigned long page = offset >> PAGE_SHIFT;
  75                         phys = dma->pagelist[page];
  76
  77                         DRM_SPINUNLOCK(&dev->dma_lock);
  78                         return 0;
  79                 } else {
  80                         DRM_SPINUNLOCK(&dev->dma_lock);
  81                         return -1;
  82                 }
  83         }
  84
  85         /* A sequential search of a linked list is
  86            fine here because: 1) there will only be
  87            about 5-10 entries in the list and, 2) a
  88            DRI client only has to do this mapping
  89            once, so it doesn't have to be optimized
  90            for performance, even if the list was a
  91            bit longer.
  92         */
  93         DRM_LOCK(dev);
  94         TAILQ_FOREACH(map, &dev->maplist, link) {
  95                 if (offset >> DRM_MAP_HANDLE_SHIFT ==
  96                     (unsigned long)map->handle >> DRM_MAP_HANDLE_SHIFT)
  97                         break;
  98         }
  99
 100         if (map == NULL) {
 101                 DRM_DEBUG("Can't find map, request offset = %016jx\n",
 102                     (uintmax_t)offset);
 103                 TAILQ_FOREACH(map, &dev->maplist, link) {
 104                         DRM_DEBUG("map offset = %016lx, handle = %016lx\n",
 105                             map->offset, (unsigned long)map->handle);
 106                 }
 107                 DRM_UNLOCK(dev);
 108                 return -1;
 109         }
 110         if (((map->flags & _DRM_RESTRICTED) && !DRM_SUSER(DRM_CURPROC))) {
 111                 DRM_UNLOCK(dev);
 112                 DRM_DEBUG("restricted map\n");
 113                 return -1;
 114         }
 115         type = map->type;
 116         DRM_UNLOCK(dev);
 117
 118         offset = offset & ((1ULL << DRM_MAP_HANDLE_SHIFT) - 1);
 119
 120         switch (type) {
 121         case _DRM_FRAME_BUFFER:
 122         case _DRM_AGP:
 123 #if 0   /* XXX */
 124                 memattr = VM_MEMATTR_WRITE_COMBINING;
 125 #endif
 126                 /* FALLTHROUGH */
 127         case _DRM_REGISTERS:
 128                 phys = map->offset + offset;
 129                 break;
 130         case _DRM_SCATTER_GATHER:
 131 #if 0   /* XXX */
 132                 memattr = VM_MEMATTR_WRITE_COMBINING;
 133 #endif
 134                 /* FALLTHROUGH */
 135         case _DRM_CONSISTENT:
 136         case _DRM_SHM:
 137                 phys = vtophys((char *)map->virtual + offset);
 138                 break;
 139         default:
 140                 DRM_ERROR("bad map type %d\n", type);
 141                 return -1;      /* This should never happen. */
 142         }
 143
 144         ap->a_result = atop(phys);
 145         return 0;
 146 }
 147
 148 /* XXX The following is just temporary hack to replace the
 149  * vm_phys_fictitious functions available on FreeBSD
 150  */
 151 #define VM_PHYS_FICTITIOUS_NSEGS        8
 152 static struct vm_phys_fictitious_seg {
 153         vm_paddr_t      start;
 154         vm_paddr_t      end;
 155         vm_page_t       first_page;
 156 } vm_phys_fictitious_segs[VM_PHYS_FICTITIOUS_NSEGS];
 157 static struct mtx vm_phys_fictitious_reg_mtx = MTX_INITIALIZER;
 158
 159 vm_page_t
 160 vm_phys_fictitious_to_vm_page(vm_paddr_t pa)
 161 {
 162         struct vm_phys_fictitious_seg *seg;
 163         vm_page_t m;
 164         int segind;
 165
 166         m = NULL;
 167         for (segind = 0; segind < VM_PHYS_FICTITIOUS_NSEGS; segind++) {
 168                 seg = &vm_phys_fictitious_segs[segind];
 169                 if (pa >= seg->start && pa < seg->end) {
 170                         m = &seg->first_page[atop(pa - seg->start)];
 171                         KASSERT((m->flags & PG_FICTITIOUS) != 0,
 172                             ("%p not fictitious", m));
 173                         break;
 174                 }
 175         }
 176         return (m);
 177 }
 178
 179 static void page_init(vm_page_t m, vm_paddr_t paddr, int pat_mode)
 180 {
 181         bzero(m, sizeof(*m));
 182
 183         pmap_page_init(m);
 184
 185         //m->flags = PG_BUSY | PG_FICTITIOUS;
 186         m->flags = PG_FICTITIOUS;
 187         m->valid = VM_PAGE_BITS_ALL;
 188         m->dirty = 0;
 189         m->busy = 0;
 190         m->queue = PQ_NONE;
 191         m->object = NULL;
 192         m->pat_mode = pat_mode;
 193
 194         m->wire_count = 1;
 195         m->hold_count = 0;
 196         m->phys_addr = paddr;
 197 }
 198
 199 int
 200 vm_phys_fictitious_reg_range(vm_paddr_t start, vm_paddr_t end, int pat_mode)
 201 {
 202         struct vm_phys_fictitious_seg *seg;
 203         vm_page_t fp;
 204         long i, page_count;
 205         int segind;
 206
 207         page_count = (end - start) / PAGE_SIZE;
 208
 209         fp = kmalloc(page_count * sizeof(struct vm_page), DRM_MEM_DRIVER,
 210                     M_WAITOK | M_ZERO);
 211
 212         for (i = 0; i < page_count; i++) {
 213                 page_init(&fp[i], start + PAGE_SIZE * i, pat_mode);
 214         }
 215         mtx_lock(&vm_phys_fictitious_reg_mtx);
 216         for (segind = 0; segind < VM_PHYS_FICTITIOUS_NSEGS; segind++) {
 217                 seg = &vm_phys_fictitious_segs[segind];
 218                 if (seg->start == 0 && seg->end == 0) {
 219                         seg->start = start;
 220                         seg->end = end;
 221                         seg->first_page = fp;
 222                         mtx_unlock(&vm_phys_fictitious_reg_mtx);
 223                         return (0);
 224                 }
 225         }
 226         mtx_unlock(&vm_phys_fictitious_reg_mtx);
 227         drm_free(fp, DRM_MEM_DRIVER);
 228         return (EBUSY);
 229 }