shared-core/via_mm.c

   1 /*
   2  * Copyright 1998-2003 VIA Technologies, Inc. All Rights Reserved.
   3  * Copyright 2001-2003 S3 Graphics, Inc. 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, sub license,
   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
  13  * next paragraph) shall be included in all copies or substantial portions
  14  * of the 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 NON-INFRINGEMENT. IN NO EVENT SHALL
  19  * VIA, S3 GRAPHICS, AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
  20  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  21  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
  22  * DEALINGS IN THE SOFTWARE.
  23  */
  24 #include "drmP.h"
  25 #include "via_drm.h"
  26 #include "via_drv.h"
  27 #include "via_ds.h"
  28 #include "via_mm.h"
  29
  30 #define MAX_CONTEXT 100
  31
  32 typedef struct {
  33         int used;
  34         int context;
  35         set_t *sets[2];         /* 0 for frame buffer, 1 for AGP , 2 for System */
  36 } via_context_t;
  37
  38 static via_context_t global_ppriv[MAX_CONTEXT];
  39
  40 static int via_agp_alloc(drm_via_mem_t * mem);
  41 static int via_agp_free(drm_via_mem_t * mem);
  42 static int via_fb_alloc(drm_via_mem_t * mem);
  43 static int via_fb_free(drm_via_mem_t * mem);
  44
  45 static int add_alloc_set(int context, int type, unsigned int val)
  46 {
  47         int i, retval = 0;
  48
  49         for (i = 0; i < MAX_CONTEXT; i++) {
  50                 if (global_ppriv[i].used && global_ppriv[i].context == context) {
  51                         retval = via_setAdd(global_ppriv[i].sets[type], val);
  52                         break;
  53                 }
  54         }
  55
  56         return retval;
  57 }
  58
  59 static int del_alloc_set(int context, int type, unsigned int val)
  60 {
  61         int i, retval = 0;
  62
  63         for (i = 0; i < MAX_CONTEXT; i++)
  64                 if (global_ppriv[i].used && global_ppriv[i].context == context) {
  65                         retval = via_setDel(global_ppriv[i].sets[type], val);
  66                         break;
  67                 }
  68
  69         return retval;
  70 }
  71
  72 /* agp memory management */
  73 static memHeap_t *AgpHeap = NULL;
  74
  75 int via_agp_init(DRM_IOCTL_ARGS)
  76 {
  77         drm_via_agp_t agp;
  78
  79         DRM_COPY_FROM_USER_IOCTL(agp, (drm_via_agp_t *) data, sizeof(agp));
  80
  81         AgpHeap = via_mmInit(agp.offset, agp.size);
  82
  83         DRM_DEBUG("offset = %lu, size = %lu", (unsigned long)agp.offset, (unsigned long)agp.size);
  84
  85         return 0;
  86 }
  87
  88 /* fb memory management */
  89 static memHeap_t *FBHeap = NULL;
  90
  91 int via_fb_init(DRM_IOCTL_ARGS)
  92 {
  93         drm_via_fb_t fb;
  94
  95         DRM_COPY_FROM_USER_IOCTL(fb, (drm_via_fb_t *) data, sizeof(fb));
  96
  97         FBHeap = via_mmInit(fb.offset, fb.size);
  98
  99         DRM_DEBUG("offset = %lu, size = %lu", (unsigned long)fb.offset, (unsigned long)fb.size);
 100
 101         return 0;
 102 }
 103
 104 int via_init_context(struct drm_device *dev, int context)
 105 {
 106         int i;
 107
 108         for (i = 0; i < MAX_CONTEXT; i++)
 109                 if (global_ppriv[i].used &&
 110                     (global_ppriv[i].context == context))
 111                         break;
 112
 113         if (i >= MAX_CONTEXT) {
 114                 for (i = 0; i < MAX_CONTEXT; i++) {
 115                         if (!global_ppriv[i].used) {
 116                                 global_ppriv[i].context = context;
 117                                 global_ppriv[i].used = 1;
 118                                 global_ppriv[i].sets[0] = via_setInit();
 119                                 global_ppriv[i].sets[1] = via_setInit();
 120                                 DRM_DEBUG("init allocation set, socket=%d,"
 121                                           " context = %d\n", i, context);
 122                                 break;
 123                         }
 124                 }
 125
 126                 if ((i >= MAX_CONTEXT) || (global_ppriv[i].sets[0] == NULL) ||
 127                     (global_ppriv[i].sets[1] == NULL)) {
 128                         return 0;
 129                 }
 130         }
 131
 132         return 1;
 133 }
 134
 135 int via_final_context(struct drm_device *dev, int context)
 136 {
 137         int i;
 138         volatile int *lock;
 139         drm_via_private_t *dev_priv = (drm_via_private_t *) dev->dev_private;
 140         drm_via_sarea_t *sAPriv = dev_priv->sarea_priv;
 141
 142         for (i = 0; i < MAX_CONTEXT; i++)
 143                 if (global_ppriv[i].used &&
 144                     (global_ppriv[i].context == context))
 145                         break;
 146
 147         if (i < MAX_CONTEXT) {
 148                 set_t *set;
 149                 unsigned int item;
 150                 int retval;
 151
 152                 DRM_DEBUG("find socket %d, context = %d\n", i, context);
 153
 154                 /* Video Memory */
 155                 set = global_ppriv[i].sets[0];
 156                 retval = via_setFirst(set, &item);
 157                 while (retval) {
 158                         DRM_DEBUG("free video memory 0x%x\n", item);
 159                         via_mmFreeMem((PMemBlock) item);
 160                         retval = via_setNext(set, &item);
 161                 }
 162                 via_setDestroy(set);
 163
 164                 /* AGP Memory */
 165                 set = global_ppriv[i].sets[1];
 166                 retval = via_setFirst(set, &item);
 167                 while (retval) {
 168                         DRM_DEBUG("free agp memory 0x%x\n", item);
 169                         via_mmFreeMem((PMemBlock) item);
 170                         retval = via_setNext(set, &item);
 171                 }
 172                 via_setDestroy(set);
 173
 174                 global_ppriv[i].used = 0;
 175         }
 176
 177         /*
 178          * Release futex locks.
 179          */
 180
 181         for (i=0; i < VIA_NR_XVMC_LOCKS; ++i) {
 182                 lock = XVMCLOCKPTR(sAPriv, i);
 183                 if ( (_DRM_LOCKING_CONTEXT( *lock ) == i) &&
 184                      (_DRM_LOCK_IS_HELD( *lock ))) {
 185                         if ( *lock & _DRM_LOCK_CONT) {
 186                                 DRM_WAKEUP( &(dev_priv->decoder_queue[i]));
 187                         }
 188                         *lock &= ~( _DRM_LOCK_HELD | _DRM_LOCK_CONT );
 189                 }
 190         }
 191
 192 #if defined(__linux__)
 193         /* Linux specific until context tracking code gets ported to BSD */
 194         /* Last context, perform cleanup */
 195         if (dev->ctx_count == 1 && dev->dev_private) {
 196                 DRM_DEBUG("Last Context\n");
 197                 if (dev->irq)
 198                         drm_irq_uninstall(dev);
 199
 200                 via_do_cleanup_map(dev);
 201         }
 202 #endif
 203
 204         return 1;
 205 }
 206
 207 int via_mem_alloc(DRM_IOCTL_ARGS)
 208 {
 209         drm_via_mem_t mem;
 210
 211         DRM_COPY_FROM_USER_IOCTL(mem, (drm_via_mem_t *) data, sizeof(mem));
 212         switch (mem.type) {
 213         case VIDEO:
 214                 if (via_fb_alloc(&mem) < 0)
 215                         return -EFAULT;
 216                 DRM_COPY_TO_USER_IOCTL((drm_via_mem_t *) data, mem,
 217                                        sizeof(mem));
 218                 return 0;
 219         case AGP:
 220                 if (via_agp_alloc(&mem) < 0)
 221                         return -EFAULT;
 222                 DRM_COPY_TO_USER_IOCTL((drm_via_mem_t *) data, mem,
 223                                        sizeof(mem));
 224                 return 0;
 225         }
 226
 227         return -EFAULT;
 228 }
 229
 230 static int via_fb_alloc(drm_via_mem_t * mem)
 231 {
 232         drm_via_mm_t fb;
 233         PMemBlock block;
 234         int retval = 0;
 235
 236         if (!FBHeap)
 237                 return -1;
 238
 239         fb.size = mem->size;
 240         fb.context = mem->context;
 241
 242         block = via_mmAllocMem(FBHeap, fb.size, 5, 0);
 243         if (block) {
 244                 fb.offset = block->ofs;
 245                 fb.free = (unsigned int)block;
 246                 if (!add_alloc_set(fb.context, VIDEO, fb.free)) {
 247                         DRM_DEBUG("adding to allocation set fails\n");
 248                         via_mmFreeMem((PMemBlock) fb.free);
 249                         retval = -1;
 250                 }
 251         } else {
 252                 fb.offset = 0;
 253                 fb.size = 0;
 254                 fb.free = 0;
 255                 retval = -1;
 256         }
 257
 258         mem->offset = fb.offset;
 259         mem->index = fb.free;
 260
 261         DRM_DEBUG("alloc fb, size = %d, offset = %d\n", fb.size,
 262                   (int)fb.offset);
 263
 264         return retval;
 265 }
 266
 267 static int via_agp_alloc(drm_via_mem_t * mem)
 268 {
 269         drm_via_mm_t agp;
 270         PMemBlock block;
 271         int retval = 0;
 272
 273         if (!AgpHeap)
 274                 return -1;
 275
 276         agp.size = mem->size;
 277         agp.context = mem->context;
 278
 279         block = via_mmAllocMem(AgpHeap, agp.size, 5, 0);
 280         if (block) {
 281                 agp.offset = block->ofs;
 282                 agp.free = (unsigned int)block;
 283                 if (!add_alloc_set(agp.context, AGP, agp.free)) {
 284                         DRM_DEBUG("adding to allocation set fails\n");
 285                         via_mmFreeMem((PMemBlock) agp.free);
 286                         retval = -1;
 287                 }
 288         } else {
 289                 agp.offset = 0;
 290                 agp.size = 0;
 291                 agp.free = 0;
 292         }
 293
 294         mem->offset = agp.offset;
 295         mem->index = agp.free;
 296
 297         DRM_DEBUG("alloc agp, size = %d, offset = %d\n", agp.size,
 298                   (unsigned int)agp.offset);
 299         return retval;
 300 }
 301
 302 int via_mem_free(DRM_IOCTL_ARGS)
 303 {
 304         drm_via_mem_t mem;
 305
 306         DRM_COPY_FROM_USER_IOCTL(mem, (drm_via_mem_t *) data, sizeof(mem));
 307
 308         switch (mem.type) {
 309
 310         case VIDEO:
 311                 if (via_fb_free(&mem) == 0)
 312                         return 0;
 313                 break;
 314         case AGP:
 315                 if (via_agp_free(&mem) == 0)
 316                         return 0;
 317                 break;
 318         }
 319
 320         return -EFAULT;
 321 }
 322
 323 static int via_fb_free(drm_via_mem_t * mem)
 324 {
 325         drm_via_mm_t fb;
 326         int retval = 0;
 327
 328         if (!FBHeap) {
 329                 return -1;
 330         }
 331
 332         fb.free = mem->index;
 333         fb.context = mem->context;
 334
 335         if (!fb.free) {
 336                 return -1;
 337
 338         }
 339
 340         via_mmFreeMem((PMemBlock) fb.free);
 341
 342         if (!del_alloc_set(fb.context, VIDEO, fb.free)) {
 343                 retval = -1;
 344         }
 345
 346         DRM_DEBUG("free fb, free = %d\n", fb.free);
 347
 348         return retval;
 349 }
 350
 351 static int via_agp_free(drm_via_mem_t * mem)
 352 {
 353         drm_via_mm_t agp;
 354
 355         int retval = 0;
 356
 357         agp.free = mem->index;
 358         agp.context = mem->context;
 359
 360         if (!agp.free)
 361                 return -1;
 362
 363         via_mmFreeMem((PMemBlock) agp.free);
 364
 365         if (!del_alloc_set(agp.context, AGP, agp.free)) {
 366                 retval = -1;
 367         }
 368
 369         DRM_DEBUG("free agp, free = %d\n", agp.free);
 370
 371         return retval;
 372 }