drivers/char/drm/drm_bufs.c

   1 /**
   2  * \file drm_bufs.c
   3  * Generic buffer template
   4  *
   5  * \author Rickard E. (Rik) Faith <faith@valinux.com>
   6  * \author Gareth Hughes <gareth@valinux.com>
   7  */
   8
   9 /*
  10  * Created: Thu Nov 23 03:10:50 2000 by gareth@valinux.com
  11  *
  12  * Copyright 1999, 2000 Precision Insight, Inc., Cedar Park, Texas.
  13  * Copyright 2000 VA Linux Systems, Inc., Sunnyvale, California.
  14  * All Rights Reserved.
  15  *
  16  * Permission is hereby granted, free of charge, to any person obtaining a
  17  * copy of this software and associated documentation files (the "Software"),
  18  * to deal in the Software without restriction, including without limitation
  19  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  20  * and/or sell copies of the Software, and to permit persons to whom the
  21  * Software is furnished to do so, subject to the following conditions:
  22  *
  23  * The above copyright notice and this permission notice (including the next
  24  * paragraph) shall be included in all copies or substantial portions of the
  25  * Software.
  26  *
  27  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  28  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  29  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  30  * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
  31  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  32  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  33  * OTHER DEALINGS IN THE SOFTWARE.
  34  */
  35
  36 #include <linux/vmalloc.h>
  37 #include "drmP.h"
  38
  39 unsigned long drm_get_resource_start(drm_device_t *dev, unsigned int resource)
  40 {
  41         return pci_resource_start(dev->pdev, resource);
  42 }
  43 EXPORT_SYMBOL(drm_get_resource_start);
  44
  45 unsigned long drm_get_resource_len(drm_device_t *dev, unsigned int resource)
  46 {
  47         return pci_resource_len(dev->pdev, resource);
  48 }
  49
  50 EXPORT_SYMBOL(drm_get_resource_len);
  51
  52 static drm_map_list_t *drm_find_matching_map(drm_device_t *dev,
  53                                              drm_local_map_t *map)
  54 {
  55         drm_map_list_t *entry;
  56         list_for_each_entry(entry, &dev->maplist, head) {
  57                 if (entry->map && map->type == entry->map->type &&
  58                     ((entry->map->offset == map->offset) ||
  59                      (map->type == _DRM_SHM && map->flags==_DRM_CONTAINS_LOCK))) {
  60                         return entry;
  61                 }
  62         }
  63
  64         return NULL;
  65 }
  66
  67 static int drm_map_handle(drm_device_t *dev, drm_hash_item_t *hash,
  68                           unsigned long user_token, int hashed_handle)
  69 {
  70         int use_hashed_handle;
  71 #if (BITS_PER_LONG == 64)
  72         use_hashed_handle = ((user_token & 0xFFFFFFFF00000000UL) || hashed_handle);
  73 #elif (BITS_PER_LONG == 32)
  74         use_hashed_handle = hashed_handle;
  75 #else
  76 #error Unsupported long size. Neither 64 nor 32 bits.
  77 #endif
  78
  79         if (!use_hashed_handle) {
  80                 int ret;
  81                 hash->key = user_token >> PAGE_SHIFT;
  82                 ret = drm_ht_insert_item(&dev->map_hash, hash);
  83                 if (ret != -EINVAL)
  84                         return ret;
  85         }
  86         return drm_ht_just_insert_please(&dev->map_hash, hash,
  87                                          user_token, 32 - PAGE_SHIFT - 3,
  88                                          0, DRM_MAP_HASH_OFFSET >> PAGE_SHIFT);
  89 }
  90
  91 /**
  92  * Ioctl to specify a range of memory that is available for mapping by a non-root process.
  93  *
  94  * \param inode device inode.
  95  * \param filp file pointer.
  96  * \param cmd command.
  97  * \param arg pointer to a drm_map structure.
  98  * \return zero on success or a negative value on error.
  99  *
 100  * Adjusts the memory offset to its absolute value according to the mapping
 101  * type.  Adds the map to the map list drm_device::maplist. Adds MTRR's where
 102  * applicable and if supported by the kernel.
 103  */
 104 static int drm_addmap_core(drm_device_t * dev, unsigned int offset,
 105                            unsigned int size, drm_map_type_t type,
 106                            drm_map_flags_t flags, drm_map_list_t ** maplist)
 107 {
 108         drm_map_t *map;
 109         drm_map_list_t *list;
 110         drm_dma_handle_t *dmah;
 111         unsigned long user_token;
 112         int ret;
 113
 114         map = drm_alloc(sizeof(*map), DRM_MEM_MAPS);
 115         if (!map)
 116                 return -ENOMEM;
 117
 118         map->offset = offset;
 119         map->size = size;
 120         map->flags = flags;
 121         map->type = type;
 122
 123         /* Only allow shared memory to be removable since we only keep enough
 124          * book keeping information about shared memory to allow for removal
 125          * when processes fork.
 126          */
 127         if ((map->flags & _DRM_REMOVABLE) && map->type != _DRM_SHM) {
 128                 drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 129                 return -EINVAL;
 130         }
 131         DRM_DEBUG("offset = 0x%08lx, size = 0x%08lx, type = %d\n",
 132                   map->offset, map->size, map->type);
 133         if ((map->offset & (~PAGE_MASK)) || (map->size & (~PAGE_MASK))) {
 134                 drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 135                 return -EINVAL;
 136         }
 137         map->mtrr = -1;
 138         map->handle = NULL;
 139
 140         switch (map->type) {
 141         case _DRM_REGISTERS:
 142         case _DRM_FRAME_BUFFER:
 143 #if !defined(__sparc__) && !defined(__alpha__) && !defined(__ia64__) && !defined(__powerpc64__) && !defined(__x86_64__)
 144                 if (map->offset + (map->size-1) < map->offset ||
 145                     map->offset < virt_to_phys(high_memory)) {
 146                         drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 147                         return -EINVAL;
 148                 }
 149 #endif
 150 #ifdef __alpha__
 151                 map->offset += dev->hose->mem_space->start;
 152 #endif
 153                 /* Some drivers preinitialize some maps, without the X Server
 154                  * needing to be aware of it.  Therefore, we just return success
 155                  * when the server tries to create a duplicate map.
 156                  */
 157                 list = drm_find_matching_map(dev, map);
 158                 if (list != NULL) {
 159                         if (list->map->size != map->size) {
 160                                 DRM_DEBUG("Matching maps of type %d with "
 161                                           "mismatched sizes, (%ld vs %ld)\n",
 162                                           map->type, map->size,
 163                                           list->map->size);
 164                                 list->map->size = map->size;
 165                         }
 166
 167                         drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 168                         *maplist = list;
 169                         return 0;
 170                 }
 171
 172                 if (drm_core_has_MTRR(dev)) {
 173                         if (map->type == _DRM_FRAME_BUFFER ||
 174                             (map->flags & _DRM_WRITE_COMBINING)) {
 175                                 map->mtrr = mtrr_add(map->offset, map->size,
 176                                                      MTRR_TYPE_WRCOMB, 1);
 177                         }
 178                 }
 179                 if (map->type == _DRM_REGISTERS)
 180                         map->handle = ioremap(map->offset, map->size);
 181                 break;
 182         case _DRM_SHM:
 183                 list = drm_find_matching_map(dev, map);
 184                 if (list != NULL) {
 185                         if(list->map->size != map->size) {
 186                                 DRM_DEBUG("Matching maps of type %d with "
 187                                           "mismatched sizes, (%ld vs %ld)\n",
 188                                           map->type, map->size, list->map->size);
 189                                 list->map->size = map->size;
 190                         }
 191
 192                         drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 193                         *maplist = list;
 194                         return 0;
 195                 }
 196                 map->handle = vmalloc_user(map->size);
 197                 DRM_DEBUG("%lu %d %p\n",
 198                           map->size, drm_order(map->size), map->handle);
 199                 if (!map->handle) {
 200                         drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 201                         return -ENOMEM;
 202                 }
 203                 map->offset = (unsigned long)map->handle;
 204                 if (map->flags & _DRM_CONTAINS_LOCK) {
 205                         /* Prevent a 2nd X Server from creating a 2nd lock */
 206                         if (dev->lock.hw_lock != NULL) {
 207                                 vfree(map->handle);
 208                                 drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 209                                 return -EBUSY;
 210                         }
 211                         dev->sigdata.lock = dev->lock.hw_lock = map->handle;    /* Pointer to lock */
 212                 }
 213                 break;
 214         case _DRM_AGP: {
 215                 drm_agp_mem_t *entry;
 216                 int valid = 0;
 217
 218                 if (!drm_core_has_AGP(dev)) {
 219                         drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 220                         return -EINVAL;
 221                 }
 222 #ifdef __alpha__
 223                 map->offset += dev->hose->mem_space->start;
 224 #endif
 225                 /* Note: dev->agp->base may actually be 0 when the DRM
 226                  * is not in control of AGP space. But if user space is
 227                  * it should already have added the AGP base itself.
 228                  */
 229                 map->offset += dev->agp->base;
 230                 map->mtrr = dev->agp->agp_mtrr; /* for getmap */
 231
 232                 /* This assumes the DRM is in total control of AGP space.
 233                  * It's not always the case as AGP can be in the control
 234                  * of user space (i.e. i810 driver). So this loop will get
 235                  * skipped and we double check that dev->agp->memory is
 236                  * actually set as well as being invalid before EPERM'ing
 237                  */
 238                 list_for_each_entry(entry, &dev->agp->memory, head) {
 239                         if ((map->offset >= entry->bound) &&
 240                             (map->offset + map->size <= entry->bound + entry->pages * PAGE_SIZE)) {
 241                                 valid = 1;
 242                                 break;
 243                         }
 244                 }
 245                 if (!list_empty(&dev->agp->memory) && !valid) {
 246                         drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 247                         return -EPERM;
 248                 }
 249                 DRM_DEBUG("AGP offset = 0x%08lx, size = 0x%08lx\n", map->offset, map->size);
 250
 251                 break;
 252         }
 253         case _DRM_SCATTER_GATHER:
 254                 if (!dev->sg) {
 255                         drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 256                         return -EINVAL;
 257                 }
 258                 map->offset += (unsigned long)dev->sg->virtual;
 259                 break;
 260         case _DRM_CONSISTENT:
 261                 /* dma_addr_t is 64bit on i386 with CONFIG_HIGHMEM64G,
 262                  * As we're limiting the address to 2^32-1 (or less),
 263                  * casting it down to 32 bits is no problem, but we
 264                  * need to point to a 64bit variable first. */
 265                 dmah = drm_pci_alloc(dev, map->size, map->size, 0xffffffffUL);
 266                 if (!dmah) {
 267                         drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 268                         return -ENOMEM;
 269                 }
 270                 map->handle = dmah->vaddr;
 271                 map->offset = (unsigned long)dmah->busaddr;
 272                 kfree(dmah);
 273                 break;
 274         default:
 275                 drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 276                 return -EINVAL;
 277         }
 278
 279         list = drm_alloc(sizeof(*list), DRM_MEM_MAPS);
 280         if (!list) {
 281                 if (map->type == _DRM_REGISTERS)
 282                         iounmap(map->handle);
 283                 drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 284                 return -EINVAL;
 285         }
 286         memset(list, 0, sizeof(*list));
 287         list->map = map;
 288
 289         mutex_lock(&dev->struct_mutex);
 290         list_add(&list->head, &dev->maplist);
 291
 292         /* Assign a 32-bit handle */
 293         /* We do it here so that dev->struct_mutex protects the increment */
 294         user_token = (map->type == _DRM_SHM) ? (unsigned long)map->handle :
 295                 map->offset;
 296         ret = drm_map_handle(dev, &list->hash, user_token, 0);
 297         if (ret) {
 298                 if (map->type == _DRM_REGISTERS)
 299                         iounmap(map->handle);
 300                 drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 301                 drm_free(list, sizeof(*list), DRM_MEM_MAPS);
 302                 mutex_unlock(&dev->struct_mutex);
 303                 return ret;
 304         }
 305
 306         list->user_token = list->hash.key << PAGE_SHIFT;
 307         mutex_unlock(&dev->struct_mutex);
 308
 309         *maplist = list;
 310         return 0;
 311         }
 312
 313 int drm_addmap(drm_device_t * dev, unsigned int offset,
 314                unsigned int size, drm_map_type_t type,
 315                drm_map_flags_t flags, drm_local_map_t ** map_ptr)
 316 {
 317         drm_map_list_t *list;
 318         int rc;
 319
 320         rc = drm_addmap_core(dev, offset, size, type, flags, &list);
 321         if (!rc)
 322                 *map_ptr = list->map;
 323         return rc;
 324 }
 325
 326 EXPORT_SYMBOL(drm_addmap);
 327
 328 int drm_addmap_ioctl(struct inode *inode, struct file *filp,
 329                      unsigned int cmd, unsigned long arg)
 330 {
 331         drm_file_t *priv = filp->private_data;
 332         drm_device_t *dev = priv->head->dev;
 333         drm_map_t map;
 334         drm_map_list_t *maplist;
 335         drm_map_t __user *argp = (void __user *)arg;
 336         int err;
 337
 338         if (!(filp->f_mode & 3))
 339                 return -EACCES; /* Require read/write */
 340
 341         if (copy_from_user(&map, argp, sizeof(map))) {
 342                 return -EFAULT;
 343         }
 344
 345         if (!(capable(CAP_SYS_ADMIN) || map.type == _DRM_AGP))
 346                 return -EPERM;
 347
 348         err = drm_addmap_core(dev, map.offset, map.size, map.type, map.flags,
 349                               &maplist);
 350
 351         if (err)
 352                 return err;
 353
 354         if (copy_to_user(argp, maplist->map, sizeof(drm_map_t)))
 355                 return -EFAULT;
 356
 357         /* avoid a warning on 64-bit, this casting isn't very nice, but the API is set so too late */
 358         if (put_user((void *)(unsigned long)maplist->user_token, &argp->handle))
 359                 return -EFAULT;
 360         return 0;
 361 }
 362
 363 /**
 364  * Remove a map private from list and deallocate resources if the mapping
 365  * isn't in use.
 366  *
 367  * \param inode device inode.
 368  * \param filp file pointer.
 369  * \param cmd command.
 370  * \param arg pointer to a drm_map_t structure.
 371  * \return zero on success or a negative value on error.
 372  *
 373  * Searches the map on drm_device::maplist, removes it from the list, see if
 374  * its being used, and free any associate resource (such as MTRR's) if it's not
 375  * being on use.
 376  *
 377  * \sa drm_addmap
 378  */
 379 int drm_rmmap_locked(drm_device_t *dev, drm_local_map_t *map)
 380 {
 381         drm_map_list_t *r_list = NULL, *list_t;
 382         drm_dma_handle_t dmah;
 383         int found = 0;
 384
 385         /* Find the list entry for the map and remove it */
 386         list_for_each_entry_safe(r_list, list_t, &dev->maplist, head) {
 387                 if (r_list->map == map) {
 388                         list_del(&r_list->head);
 389                         drm_ht_remove_key(&dev->map_hash,
 390                                           r_list->user_token >> PAGE_SHIFT);
 391                         drm_free(r_list, sizeof(*r_list), DRM_MEM_MAPS);
 392                         found = 1;
 393                         break;
 394                 }
 395         }
 396
 397         if (!found)
 398                 return -EINVAL;
 399
 400         switch (map->type) {
 401         case _DRM_REGISTERS:
 402                 iounmap(map->handle);
 403                 /* FALLTHROUGH */
 404         case _DRM_FRAME_BUFFER:
 405                 if (drm_core_has_MTRR(dev) && map->mtrr >= 0) {
 406                         int retcode;
 407                         retcode = mtrr_del(map->mtrr, map->offset, map->size);
 408                         DRM_DEBUG("mtrr_del=%d\n", retcode);
 409                 }
 410                 break;
 411         case _DRM_SHM:
 412                 vfree(map->handle);
 413                 break;
 414         case _DRM_AGP:
 415         case _DRM_SCATTER_GATHER:
 416                 break;
 417         case _DRM_CONSISTENT:
 418                 dmah.vaddr = map->handle;
 419                 dmah.busaddr = map->offset;
 420                 dmah.size = map->size;
 421                 __drm_pci_free(dev, &dmah);
 422                 break;
 423         }
 424         drm_free(map, sizeof(*map), DRM_MEM_MAPS);
 425
 426         return 0;
 427 }
 428
 429 int drm_rmmap(drm_device_t *dev, drm_local_map_t *map)
 430 {
 431         int ret;
 432
 433         mutex_lock(&dev->struct_mutex);
 434         ret = drm_rmmap_locked(dev, map);
 435         mutex_unlock(&dev->struct_mutex);
 436
 437         return ret;
 438 }
 439
 440 /* The rmmap ioctl appears to be unnecessary.  All mappings are torn down on
 441  * the last close of the device, and this is necessary for cleanup when things
 442  * exit uncleanly.  Therefore, having userland manually remove mappings seems
 443  * like a pointless exercise since they're going away anyway.
 444  *
 445  * One use case might be after addmap is allowed for normal users for SHM and
 446  * gets used by drivers that the server doesn't need to care about.  This seems
 447  * unlikely.
 448  */
 449 int drm_rmmap_ioctl(struct inode *inode, struct file *filp,
 450                     unsigned int cmd, unsigned long arg)
 451 {
 452         drm_file_t *priv = filp->private_data;
 453         drm_device_t *dev = priv->head->dev;
 454         drm_map_t request;
 455         drm_local_map_t *map = NULL;
 456         drm_map_list_t *r_list;
 457         int ret;
 458
 459         if (copy_from_user(&request, (drm_map_t __user *) arg, sizeof(request))) {
 460                 return -EFAULT;
 461         }
 462
 463         mutex_lock(&dev->struct_mutex);
 464         list_for_each_entry(r_list, &dev->maplist, head) {
 465                 if (r_list->map &&
 466                     r_list->user_token == (unsigned long)request.handle &&
 467                     r_list->map->flags & _DRM_REMOVABLE) {
 468                         map = r_list->map;
 469                         break;
 470                 }
 471         }
 472
 473         /* List has wrapped around to the head pointer, or its empty we didn't
 474          * find anything.
 475          */
 476         if (list_empty(&dev->maplist) || !map) {
 477                 mutex_unlock(&dev->struct_mutex);
 478                 return -EINVAL;
 479         }
 480
 481         if (!map) {
 482                 mutex_unlock(&dev->struct_mutex);
 483                 return -EINVAL;
 484         }
 485
 486         /* Register and framebuffer maps are permanent */
 487         if ((map->type == _DRM_REGISTERS) || (map->type == _DRM_FRAME_BUFFER)) {
 488                 mutex_unlock(&dev->struct_mutex);
 489                 return 0;
 490         }
 491
 492         ret = drm_rmmap_locked(dev, map);
 493
 494         mutex_unlock(&dev->struct_mutex);
 495
 496         return ret;
 497 }
 498
 499 /**
 500  * Cleanup after an error on one of the addbufs() functions.
 501  *
 502  * \param dev DRM device.
 503  * \param entry buffer entry where the error occurred.
 504  *
 505  * Frees any pages and buffers associated with the given entry.
 506  */
 507 static void drm_cleanup_buf_error(drm_device_t * dev, drm_buf_entry_t * entry)
 508 {
 509         int i;
 510
 511         if (entry->seg_count) {
 512                 for (i = 0; i < entry->seg_count; i++) {
 513                         if (entry->seglist[i]) {
 514                                 drm_pci_free(dev, entry->seglist[i]);
 515                         }
 516                 }
 517                 drm_free(entry->seglist,
 518                          entry->seg_count *
 519                          sizeof(*entry->seglist), DRM_MEM_SEGS);
 520
 521                 entry->seg_count = 0;
 522         }
 523
 524         if (entry->buf_count) {
 525                 for (i = 0; i < entry->buf_count; i++) {
 526                         if (entry->buflist[i].dev_private) {
 527                                 drm_free(entry->buflist[i].dev_private,
 528                                          entry->buflist[i].dev_priv_size,
 529                                          DRM_MEM_BUFS);
 530                         }
 531                 }
 532                 drm_free(entry->buflist,
 533                          entry->buf_count *
 534                          sizeof(*entry->buflist), DRM_MEM_BUFS);
 535
 536                 entry->buf_count = 0;
 537         }
 538 }
 539
 540 #if __OS_HAS_AGP
 541 /**
 542  * Add AGP buffers for DMA transfers.
 543  *
 544  * \param dev drm_device_t to which the buffers are to be added.
 545  * \param request pointer to a drm_buf_desc_t describing the request.
 546  * \return zero on success or a negative number on failure.
 547  *
 548  * After some sanity checks creates a drm_buf structure for each buffer and
 549  * reallocates the buffer list of the same size order to accommodate the new
 550  * buffers.
 551  */
 552 int drm_addbufs_agp(drm_device_t * dev, drm_buf_desc_t * request)
 553 {
 554         drm_device_dma_t *dma = dev->dma;
 555         drm_buf_entry_t *entry;
 556         drm_agp_mem_t *agp_entry;
 557         drm_buf_t *buf;
 558         unsigned long offset;
 559         unsigned long agp_offset;
 560         int count;
 561         int order;
 562         int size;
 563         int alignment;
 564         int page_order;
 565         int total;
 566         int byte_count;
 567         int i, valid;
 568         drm_buf_t **temp_buflist;
 569
 570         if (!dma)
 571                 return -EINVAL;
 572
 573         count = request->count;
 574         order = drm_order(request->size);
 575         size = 1 << order;
 576
 577         alignment = (request->flags & _DRM_PAGE_ALIGN)
 578             ? PAGE_ALIGN(size) : size;
 579         page_order = order - PAGE_SHIFT > 0 ? order - PAGE_SHIFT : 0;
 580         total = PAGE_SIZE << page_order;
 581
 582         byte_count = 0;
 583         agp_offset = dev->agp->base + request->agp_start;
 584
 585         DRM_DEBUG("count:      %d\n", count);
 586         DRM_DEBUG("order:      %d\n", order);
 587         DRM_DEBUG("size:       %d\n", size);
 588         DRM_DEBUG("agp_offset: %lx\n", agp_offset);
 589         DRM_DEBUG("alignment:  %d\n", alignment);
 590         DRM_DEBUG("page_order: %d\n", page_order);
 591         DRM_DEBUG("total:      %d\n", total);
 592
 593         if (order < DRM_MIN_ORDER || order > DRM_MAX_ORDER)
 594                 return -EINVAL;
 595         if (dev->queue_count)
 596                 return -EBUSY;  /* Not while in use */
 597
 598         /* Make sure buffers are located in AGP memory that we own */
 599         valid = 0;
 600         list_for_each_entry(agp_entry, &dev->agp->memory, head) {
 601                 if ((agp_offset >= agp_entry->bound) &&
 602                     (agp_offset + total * count <= agp_entry->bound + agp_entry->pages * PAGE_SIZE)) {
 603                         valid = 1;
 604                         break;
 605                 }
 606         }
 607         if (!list_empty(&dev->agp->memory) && !valid) {
 608                 DRM_DEBUG("zone invalid\n");
 609                 return -EINVAL;
 610         }
 611         spin_lock(&dev->count_lock);
 612         if (dev->buf_use) {
 613                 spin_unlock(&dev->count_lock);
 614                 return -EBUSY;
 615         }
 616         atomic_inc(&dev->buf_alloc);
 617         spin_unlock(&dev->count_lock);
 618
 619         mutex_lock(&dev->struct_mutex);
 620         entry = &dma->bufs[order];
 621         if (entry->buf_count) {
 622                 mutex_unlock(&dev->struct_mutex);
 623                 atomic_dec(&dev->buf_alloc);
 624                 return -ENOMEM; /* May only call once for each order */
 625         }
 626
 627         if (count < 0 || count > 4096) {
 628                 mutex_unlock(&dev->struct_mutex);
 629                 atomic_dec(&dev->buf_alloc);
 630                 return -EINVAL;
 631         }
 632
 633         entry->buflist = drm_alloc(count * sizeof(*entry->buflist),
 634                                    DRM_MEM_BUFS);
 635         if (!entry->buflist) {
 636                 mutex_unlock(&dev->struct_mutex);
 637                 atomic_dec(&dev->buf_alloc);
 638                 return -ENOMEM;
 639         }
 640         memset(entry->buflist, 0, count * sizeof(*entry->buflist));
 641
 642         entry->buf_size = size;
 643         entry->page_order = page_order;
 644
 645         offset = 0;
 646
 647         while (entry->buf_count < count) {
 648                 buf = &entry->buflist[entry->buf_count];
 649                 buf->idx = dma->buf_count + entry->buf_count;
 650                 buf->total = alignment;
 651                 buf->order = order;
 652                 buf->used = 0;
 653
 654                 buf->offset = (dma->byte_count + offset);
 655                 buf->bus_address = agp_offset + offset;
 656                 buf->address = (void *)(agp_offset + offset);
 657                 buf->next = NULL;
 658                 buf->waiting = 0;
 659                 buf->pending = 0;
 660                 init_waitqueue_head(&buf->dma_wait);
 661                 buf->filp = NULL;
 662
 663                 buf->dev_priv_size = dev->driver->dev_priv_size;
 664                 buf->dev_private = drm_alloc(buf->dev_priv_size, DRM_MEM_BUFS);
 665                 if (!buf->dev_private) {
 666                         /* Set count correctly so we free the proper amount. */
 667                         entry->buf_count = count;
 668                         drm_cleanup_buf_error(dev, entry);
 669                         mutex_unlock(&dev->struct_mutex);
 670                         atomic_dec(&dev->buf_alloc);
 671                         return -ENOMEM;
 672                 }
 673                 memset(buf->dev_private, 0, buf->dev_priv_size);
 674
 675                 DRM_DEBUG("buffer %d @ %p\n", entry->buf_count, buf->address);
 676
 677                 offset += alignment;
 678                 entry->buf_count++;
 679                 byte_count += PAGE_SIZE << page_order;
 680         }
 681
 682         DRM_DEBUG("byte_count: %d\n", byte_count);
 683
 684         temp_buflist = drm_realloc(dma->buflist,
 685                                    dma->buf_count * sizeof(*dma->buflist),
 686                                    (dma->buf_count + entry->buf_count)
 687                                    * sizeof(*dma->buflist), DRM_MEM_BUFS);
 688         if (!temp_buflist) {
 689                 /* Free the entry because it isn't valid */
 690                 drm_cleanup_buf_error(dev, entry);
 691                 mutex_unlock(&dev->struct_mutex);
 692                 atomic_dec(&dev->buf_alloc);
 693                 return -ENOMEM;
 694         }
 695         dma->buflist = temp_buflist;
 696
 697         for (i = 0; i < entry->buf_count; i++) {
 698                 dma->buflist[i + dma->buf_count] = &entry->buflist[i];
 699         }
 700
 701         dma->buf_count += entry->buf_count;
 702         dma->seg_count += entry->seg_count;
 703         dma->page_count += byte_count >> PAGE_SHIFT;
 704         dma->byte_count += byte_count;
 705
 706         DRM_DEBUG("dma->buf_count : %d\n", dma->buf_count);
 707         DRM_DEBUG("entry->buf_count : %d\n", entry->buf_count);
 708
 709         mutex_unlock(&dev->struct_mutex);
 710
 711         request->count = entry->buf_count;
 712         request->size = size;
 713
 714         dma->flags = _DRM_DMA_USE_AGP;
 715
 716         atomic_dec(&dev->buf_alloc);
 717         return 0;
 718 }
 719 EXPORT_SYMBOL(drm_addbufs_agp);
 720 #endif                          /* __OS_HAS_AGP */
 721
 722 int drm_addbufs_pci(drm_device_t * dev, drm_buf_desc_t * request)
 723 {
 724         drm_device_dma_t *dma = dev->dma;
 725         int count;
 726         int order;
 727         int size;
 728         int total;
 729         int page_order;
 730         drm_buf_entry_t *entry;
 731         drm_dma_handle_t *dmah;
 732         drm_buf_t *buf;
 733         int alignment;
 734         unsigned long offset;
 735         int i;
 736         int byte_count;
 737         int page_count;
 738         unsigned long *temp_pagelist;
 739         drm_buf_t **temp_buflist;
 740
 741         if (!drm_core_check_feature(dev, DRIVER_PCI_DMA))
 742                 return -EINVAL;
 743
 744         if (!dma)
 745                 return -EINVAL;
 746
 747         if (!capable(CAP_SYS_ADMIN))
 748                 return -EPERM;
 749
 750         count = request->count;
 751         order = drm_order(request->size);
 752         size = 1 << order;
 753
 754         DRM_DEBUG("count=%d, size=%d (%d), order=%d, queue_count=%d\n",
 755                   request->count, request->size, size, order, dev->queue_count);
 756
 757         if (order < DRM_MIN_ORDER || order > DRM_MAX_ORDER)
 758                 return -EINVAL;
 759         if (dev->queue_count)
 760                 return -EBUSY;  /* Not while in use */
 761
 762         alignment = (request->flags & _DRM_PAGE_ALIGN)
 763             ? PAGE_ALIGN(size) : size;
 764         page_order = order - PAGE_SHIFT > 0 ? order - PAGE_SHIFT : 0;
 765         total = PAGE_SIZE << page_order;
 766
 767         spin_lock(&dev->count_lock);
 768         if (dev->buf_use) {
 769                 spin_unlock(&dev->count_lock);
 770                 return -EBUSY;
 771         }
 772         atomic_inc(&dev->buf_alloc);
 773         spin_unlock(&dev->count_lock);
 774
 775         mutex_lock(&dev->struct_mutex);
 776         entry = &dma->bufs[order];
 777         if (entry->buf_count) {
 778                 mutex_unlock(&dev->struct_mutex);
 779                 atomic_dec(&dev->buf_alloc);
 780                 return -ENOMEM; /* May only call once for each order */
 781         }
 782
 783         if (count < 0 || count > 4096) {
 784                 mutex_unlock(&dev->struct_mutex);
 785                 atomic_dec(&dev->buf_alloc);
 786                 return -EINVAL;
 787         }
 788
 789         entry->buflist = drm_alloc(count * sizeof(*entry->buflist),
 790                                    DRM_MEM_BUFS);
 791         if (!entry->buflist) {
 792                 mutex_unlock(&dev->struct_mutex);
 793                 atomic_dec(&dev->buf_alloc);
 794                 return -ENOMEM;
 795         }
 796         memset(entry->buflist, 0, count * sizeof(*entry->buflist));
 797
 798         entry->seglist = drm_alloc(count * sizeof(*entry->seglist),
 799                                    DRM_MEM_SEGS);
 800         if (!entry->seglist) {
 801                 drm_free(entry->buflist,
 802                          count * sizeof(*entry->buflist), DRM_MEM_BUFS);
 803                 mutex_unlock(&dev->struct_mutex);
 804                 atomic_dec(&dev->buf_alloc);
 805                 return -ENOMEM;
 806         }
 807         memset(entry->seglist, 0, count * sizeof(*entry->seglist));
 808
 809         /* Keep the original pagelist until we know all the allocations
 810          * have succeeded
 811          */
 812         temp_pagelist = drm_alloc((dma->page_count + (count << page_order))
 813                                   * sizeof(*dma->pagelist), DRM_MEM_PAGES);
 814         if (!temp_pagelist) {
 815                 drm_free(entry->buflist,
 816                          count * sizeof(*entry->buflist), DRM_MEM_BUFS);
 817                 drm_free(entry->seglist,
 818                          count * sizeof(*entry->seglist), DRM_MEM_SEGS);
 819                 mutex_unlock(&dev->struct_mutex);
 820                 atomic_dec(&dev->buf_alloc);
 821                 return -ENOMEM;
 822         }
 823         memcpy(temp_pagelist,
 824                dma->pagelist, dma->page_count * sizeof(*dma->pagelist));
 825         DRM_DEBUG("pagelist: %d entries\n",
 826                   dma->page_count + (count << page_order));
 827
 828         entry->buf_size = size;
 829         entry->page_order = page_order;
 830         byte_count = 0;
 831         page_count = 0;
 832
 833         while (entry->buf_count < count) {
 834
 835                 dmah = drm_pci_alloc(dev, PAGE_SIZE << page_order, 0x1000, 0xfffffffful);
 836
 837                 if (!dmah) {
 838                         /* Set count correctly so we free the proper amount. */
 839                         entry->buf_count = count;
 840                         entry->seg_count = count;
 841                         drm_cleanup_buf_error(dev, entry);
 842                         drm_free(temp_pagelist,
 843                                  (dma->page_count + (count << page_order))
 844                                  * sizeof(*dma->pagelist), DRM_MEM_PAGES);
 845                         mutex_unlock(&dev->struct_mutex);
 846                         atomic_dec(&dev->buf_alloc);
 847                         return -ENOMEM;
 848                 }
 849                 entry->seglist[entry->seg_count++] = dmah;
 850                 for (i = 0; i < (1 << page_order); i++) {
 851                         DRM_DEBUG("page %d @ 0x%08lx\n",
 852                                   dma->page_count + page_count,
 853                                   (unsigned long)dmah->vaddr + PAGE_SIZE * i);
 854                         temp_pagelist[dma->page_count + page_count++]
 855                                 = (unsigned long)dmah->vaddr + PAGE_SIZE * i;
 856                 }
 857                 for (offset = 0;
 858                      offset + size <= total && entry->buf_count < count;
 859                      offset += alignment, ++entry->buf_count) {
 860                         buf = &entry->buflist[entry->buf_count];
 861                         buf->idx = dma->buf_count + entry->buf_count;
 862                         buf->total = alignment;
 863                         buf->order = order;
 864                         buf->used = 0;
 865                         buf->offset = (dma->byte_count + byte_count + offset);
 866                         buf->address = (void *)(dmah->vaddr + offset);
 867                         buf->bus_address = dmah->busaddr + offset;
 868                         buf->next = NULL;
 869                         buf->waiting = 0;
 870                         buf->pending = 0;
 871                         init_waitqueue_head(&buf->dma_wait);
 872                         buf->filp = NULL;
 873
 874                         buf->dev_priv_size = dev->driver->dev_priv_size;
 875                         buf->dev_private = drm_alloc(buf->dev_priv_size,
 876                                                      DRM_MEM_BUFS);
 877                         if (!buf->dev_private) {
 878                                 /* Set count correctly so we free the proper amount. */
 879                                 entry->buf_count = count;
 880                                 entry->seg_count = count;
 881                                 drm_cleanup_buf_error(dev, entry);
 882                                 drm_free(temp_pagelist,
 883                                          (dma->page_count +
 884                                           (count << page_order))
 885                                          * sizeof(*dma->pagelist),
 886                                          DRM_MEM_PAGES);
 887                                 mutex_unlock(&dev->struct_mutex);
 888                                 atomic_dec(&dev->buf_alloc);
 889                                 return -ENOMEM;
 890                         }
 891                         memset(buf->dev_private, 0, buf->dev_priv_size);
 892
 893                         DRM_DEBUG("buffer %d @ %p\n",
 894                                   entry->buf_count, buf->address);
 895                 }
 896                 byte_count += PAGE_SIZE << page_order;
 897         }
 898
 899         temp_buflist = drm_realloc(dma->buflist,
 900                                    dma->buf_count * sizeof(*dma->buflist),
 901                                    (dma->buf_count + entry->buf_count)
 902                                    * sizeof(*dma->buflist), DRM_MEM_BUFS);
 903         if (!temp_buflist) {
 904                 /* Free the entry because it isn't valid */
 905                 drm_cleanup_buf_error(dev, entry);
 906                 drm_free(temp_pagelist,
 907                          (dma->page_count + (count << page_order))
 908                          * sizeof(*dma->pagelist), DRM_MEM_PAGES);
 909                 mutex_unlock(&dev->struct_mutex);
 910                 atomic_dec(&dev->buf_alloc);
 911                 return -ENOMEM;
 912         }
 913         dma->buflist = temp_buflist;
 914
 915         for (i = 0; i < entry->buf_count; i++) {
 916                 dma->buflist[i + dma->buf_count] = &entry->buflist[i];
 917         }
 918
 919         /* No allocations failed, so now we can replace the orginal pagelist
 920          * with the new one.
 921          */
 922         if (dma->page_count) {
 923                 drm_free(dma->pagelist,
 924                          dma->page_count * sizeof(*dma->pagelist),
 925                          DRM_MEM_PAGES);
 926         }
 927         dma->pagelist = temp_pagelist;
 928
 929         dma->buf_count += entry->buf_count;
 930         dma->seg_count += entry->seg_count;
 931         dma->page_count += entry->seg_count << page_order;
 932         dma->byte_count += PAGE_SIZE * (entry->seg_count << page_order);
 933
 934         mutex_unlock(&dev->struct_mutex);
 935
 936         request->count = entry->buf_count;
 937         request->size = size;
 938
 939         if (request->flags & _DRM_PCI_BUFFER_RO)
 940                 dma->flags = _DRM_DMA_USE_PCI_RO;
 941
 942         atomic_dec(&dev->buf_alloc);
 943         return 0;
 944
 945 }
 946 EXPORT_SYMBOL(drm_addbufs_pci);
 947
 948 static int drm_addbufs_sg(drm_device_t * dev, drm_buf_desc_t * request)
 949 {
 950         drm_device_dma_t *dma = dev->dma;
 951         drm_buf_entry_t *entry;
 952         drm_buf_t *buf;
 953         unsigned long offset;
 954         unsigned long agp_offset;
 955         int count;
 956         int order;
 957         int size;
 958         int alignment;
 959         int page_order;
 960         int total;
 961         int byte_count;
 962         int i;
 963         drm_buf_t **temp_buflist;
 964
 965         if (!drm_core_check_feature(dev, DRIVER_SG))
 966                 return -EINVAL;
 967
 968         if (!dma)
 969                 return -EINVAL;
 970
 971         if (!capable(CAP_SYS_ADMIN))
 972                 return -EPERM;
 973
 974         count = request->count;
 975         order = drm_order(request->size);
 976         size = 1 << order;
 977
 978         alignment = (request->flags & _DRM_PAGE_ALIGN)
 979             ? PAGE_ALIGN(size) : size;
 980         page_order = order - PAGE_SHIFT > 0 ? order - PAGE_SHIFT : 0;
 981         total = PAGE_SIZE << page_order;
 982
 983         byte_count = 0;
 984         agp_offset = request->agp_start;
 985
 986         DRM_DEBUG("count:      %d\n", count);
 987         DRM_DEBUG("order:      %d\n", order);
 988         DRM_DEBUG("size:       %d\n", size);
 989         DRM_DEBUG("agp_offset: %lu\n", agp_offset);
 990         DRM_DEBUG("alignment:  %d\n", alignment);
 991         DRM_DEBUG("page_order: %d\n", page_order);
 992         DRM_DEBUG("total:      %d\n", total);
 993
 994         if (order < DRM_MIN_ORDER || order > DRM_MAX_ORDER)
 995                 return -EINVAL;
 996         if (dev->queue_count)
 997                 return -EBUSY;  /* Not while in use */
 998
 999         spin_lock(&dev->count_lock);
1000         if (dev->buf_use) {
1001                 spin_unlock(&dev->count_lock);
1002                 return -EBUSY;
1003         }
1004         atomic_inc(&dev->buf_alloc);
1005         spin_unlock(&dev->count_lock);
1006
1007         mutex_lock(&dev->struct_mutex);
1008         entry = &dma->bufs[order];
1009         if (entry->buf_count) {
1010                 mutex_unlock(&dev->struct_mutex);
1011                 atomic_dec(&dev->buf_alloc);
1012                 return -ENOMEM; /* May only call once for each order */
1013         }
1014
1015         if (count < 0 || count > 4096) {
1016                 mutex_unlock(&dev->struct_mutex);
1017                 atomic_dec(&dev->buf_alloc);
1018                 return -EINVAL;
1019         }
1020
1021         entry->buflist = drm_alloc(count * sizeof(*entry->buflist),
1022                                    DRM_MEM_BUFS);
1023         if (!entry->buflist) {
1024                 mutex_unlock(&dev->struct_mutex);
1025                 atomic_dec(&dev->buf_alloc);
1026                 return -ENOMEM;
1027         }
1028         memset(entry->buflist, 0, count * sizeof(*entry->buflist));
1029
1030         entry->buf_size = size;
1031         entry->page_order = page_order;
1032
1033         offset = 0;
1034
1035         while (entry->buf_count < count) {
1036                 buf = &entry->buflist[entry->buf_count];
1037                 buf->idx = dma->buf_count + entry->buf_count;
1038                 buf->total = alignment;
1039                 buf->order = order;
1040                 buf->used = 0;
1041
1042                 buf->offset = (dma->byte_count + offset);
1043                 buf->bus_address = agp_offset + offset;
1044                 buf->address = (void *)(agp_offset + offset
1045                                         + (unsigned long)dev->sg->virtual);
1046                 buf->next = NULL;
1047                 buf->waiting = 0;
1048                 buf->pending = 0;
1049                 init_waitqueue_head(&buf->dma_wait);
1050                 buf->filp = NULL;
1051
1052                 buf->dev_priv_size = dev->driver->dev_priv_size;
1053                 buf->dev_private = drm_alloc(buf->dev_priv_size, DRM_MEM_BUFS);
1054                 if (!buf->dev_private) {
1055                         /* Set count correctly so we free the proper amount. */
1056                         entry->buf_count = count;
1057                         drm_cleanup_buf_error(dev, entry);
1058                         mutex_unlock(&dev->struct_mutex);
1059                         atomic_dec(&dev->buf_alloc);
1060                         return -ENOMEM;
1061                 }
1062
1063                 memset(buf->dev_private, 0, buf->dev_priv_size);
1064
1065                 DRM_DEBUG("buffer %d @ %p\n", entry->buf_count, buf->address);
1066
1067                 offset += alignment;
1068                 entry->buf_count++;
1069                 byte_count += PAGE_SIZE << page_order;
1070         }
1071
1072         DRM_DEBUG("byte_count: %d\n", byte_count);
1073
1074         temp_buflist = drm_realloc(dma->buflist,
1075                                    dma->buf_count * sizeof(*dma->buflist),
1076                                    (dma->buf_count + entry->buf_count)
1077                                    * sizeof(*dma->buflist), DRM_MEM_BUFS);
1078         if (!temp_buflist) {
1079                 /* Free the entry because it isn't valid */
1080                 drm_cleanup_buf_error(dev, entry);
1081                 mutex_unlock(&dev->struct_mutex);
1082                 atomic_dec(&dev->buf_alloc);
1083                 return -ENOMEM;
1084         }
1085         dma->buflist = temp_buflist;
1086
1087         for (i = 0; i < entry->buf_count; i++) {
1088                 dma->buflist[i + dma->buf_count] = &entry->buflist[i];
1089         }
1090
1091         dma->buf_count += entry->buf_count;
1092         dma->seg_count += entry->seg_count;
1093         dma->page_count += byte_count >> PAGE_SHIFT;
1094         dma->byte_count += byte_count;
1095
1096         DRM_DEBUG("dma->buf_count : %d\n", dma->buf_count);
1097         DRM_DEBUG("entry->buf_count : %d\n", entry->buf_count);
1098
1099         mutex_unlock(&dev->struct_mutex);
1100
1101         request->count = entry->buf_count;
1102         request->size = size;
1103
1104         dma->flags = _DRM_DMA_USE_SG;
1105
1106         atomic_dec(&dev->buf_alloc);
1107         return 0;
1108 }
1109
1110 static int drm_addbufs_fb(drm_device_t * dev, drm_buf_desc_t * request)
1111 {
1112         drm_device_dma_t *dma = dev->dma;
1113         drm_buf_entry_t *entry;
1114         drm_buf_t *buf;
1115         unsigned long offset;
1116         unsigned long agp_offset;
1117         int count;
1118         int order;
1119         int size;
1120         int alignment;
1121         int page_order;
1122         int total;
1123         int byte_count;
1124         int i;
1125         drm_buf_t **temp_buflist;
1126
1127         if (!drm_core_check_feature(dev, DRIVER_FB_DMA))
1128                 return -EINVAL;
1129
1130         if (!dma)
1131                 return -EINVAL;
1132
1133         if (!capable(CAP_SYS_ADMIN))
1134                 return -EPERM;
1135
1136         count = request->count;
1137         order = drm_order(request->size);
1138         size = 1 << order;
1139
1140         alignment = (request->flags & _DRM_PAGE_ALIGN)
1141             ? PAGE_ALIGN(size) : size;
1142         page_order = order - PAGE_SHIFT > 0 ? order - PAGE_SHIFT : 0;
1143         total = PAGE_SIZE << page_order;
1144
1145         byte_count = 0;
1146         agp_offset = request->agp_start;
1147
1148         DRM_DEBUG("count:      %d\n", count);
1149         DRM_DEBUG("order:      %d\n", order);
1150         DRM_DEBUG("size:       %d\n", size);
1151         DRM_DEBUG("agp_offset: %lu\n", agp_offset);
1152         DRM_DEBUG("alignment:  %d\n", alignment);
1153         DRM_DEBUG("page_order: %d\n", page_order);
1154         DRM_DEBUG("total:      %d\n", total);
1155
1156         if (order < DRM_MIN_ORDER || order > DRM_MAX_ORDER)
1157                 return -EINVAL;
1158         if (dev->queue_count)
1159                 return -EBUSY;  /* Not while in use */
1160
1161         spin_lock(&dev->count_lock);
1162         if (dev->buf_use) {
1163                 spin_unlock(&dev->count_lock);
1164                 return -EBUSY;
1165         }
1166         atomic_inc(&dev->buf_alloc);
1167         spin_unlock(&dev->count_lock);
1168
1169         mutex_lock(&dev->struct_mutex);
1170         entry = &dma->bufs[order];
1171         if (entry->buf_count) {
1172                 mutex_unlock(&dev->struct_mutex);
1173                 atomic_dec(&dev->buf_alloc);
1174                 return -ENOMEM; /* May only call once for each order */
1175         }
1176
1177         if (count < 0 || count > 4096) {
1178                 mutex_unlock(&dev->struct_mutex);
1179                 atomic_dec(&dev->buf_alloc);
1180                 return -EINVAL;
1181         }
1182
1183         entry->buflist = drm_alloc(count * sizeof(*entry->buflist),
1184                                    DRM_MEM_BUFS);
1185         if (!entry->buflist) {
1186                 mutex_unlock(&dev->struct_mutex);
1187                 atomic_dec(&dev->buf_alloc);
1188                 return -ENOMEM;
1189         }
1190         memset(entry->buflist, 0, count * sizeof(*entry->buflist));
1191
1192         entry->buf_size = size;
1193         entry->page_order = page_order;
1194
1195         offset = 0;
1196
1197         while (entry->buf_count < count) {
1198                 buf = &entry->buflist[entry->buf_count];
1199                 buf->idx = dma->buf_count + entry->buf_count;
1200                 buf->total = alignment;
1201                 buf->order = order;
1202                 buf->used = 0;
1203
1204                 buf->offset = (dma->byte_count + offset);
1205                 buf->bus_address = agp_offset + offset;
1206                 buf->address = (void *)(agp_offset + offset);
1207                 buf->next = NULL;
1208                 buf->waiting = 0;
1209                 buf->pending = 0;
1210                 init_waitqueue_head(&buf->dma_wait);
1211                 buf->filp = NULL;
1212
1213                 buf->dev_priv_size = dev->driver->dev_priv_size;
1214                 buf->dev_private = drm_alloc(buf->dev_priv_size, DRM_MEM_BUFS);
1215                 if (!buf->dev_private) {
1216                         /* Set count correctly so we free the proper amount. */
1217                         entry->buf_count = count;
1218                         drm_cleanup_buf_error(dev, entry);
1219                         mutex_unlock(&dev->struct_mutex);
1220                         atomic_dec(&dev->buf_alloc);
1221                         return -ENOMEM;
1222                 }
1223                 memset(buf->dev_private, 0, buf->dev_priv_size);
1224
1225                 DRM_DEBUG("buffer %d @ %p\n", entry->buf_count, buf->address);
1226
1227                 offset += alignment;
1228                 entry->buf_count++;
1229                 byte_count += PAGE_SIZE << page_order;
1230         }
1231
1232         DRM_DEBUG("byte_count: %d\n", byte_count);
1233
1234         temp_buflist = drm_realloc(dma->buflist,
1235                                    dma->buf_count * sizeof(*dma->buflist),
1236                                    (dma->buf_count + entry->buf_count)
1237                                    * sizeof(*dma->buflist), DRM_MEM_BUFS);
1238         if (!temp_buflist) {
1239                 /* Free the entry because it isn't valid */
1240                 drm_cleanup_buf_error(dev, entry);
1241                 mutex_unlock(&dev->struct_mutex);
1242                 atomic_dec(&dev->buf_alloc);
1243                 return -ENOMEM;
1244         }
1245         dma->buflist = temp_buflist;
1246
1247         for (i = 0; i < entry->buf_count; i++) {
1248                 dma->buflist[i + dma->buf_count] = &entry->buflist[i];
1249         }
1250
1251         dma->buf_count += entry->buf_count;
1252         dma->seg_count += entry->seg_count;
1253         dma->page_count += byte_count >> PAGE_SHIFT;
1254         dma->byte_count += byte_count;
1255
1256         DRM_DEBUG("dma->buf_count : %d\n", dma->buf_count);
1257         DRM_DEBUG("entry->buf_count : %d\n", entry->buf_count);
1258
1259         mutex_unlock(&dev->struct_mutex);
1260
1261         request->count = entry->buf_count;
1262         request->size = size;
1263
1264         dma->flags = _DRM_DMA_USE_FB;
1265
1266         atomic_dec(&dev->buf_alloc);
1267         return 0;
1268 }
1269
1270
1271 /**
1272  * Add buffers for DMA transfers (ioctl).
1273  *
1274  * \param inode device inode.
1275  * \param filp file pointer.
1276  * \param cmd command.
1277  * \param arg pointer to a drm_buf_desc_t request.
1278  * \return zero on success or a negative number on failure.
1279  *
1280  * According with the memory type specified in drm_buf_desc::flags and the
1281  * build options, it dispatches the call either to addbufs_agp(),
1282  * addbufs_sg() or addbufs_pci() for AGP, scatter-gather or consistent
1283  * PCI memory respectively.
1284  */
1285 int drm_addbufs(struct inode *inode, struct file *filp,
1286                 unsigned int cmd, unsigned long arg)
1287 {
1288         drm_buf_desc_t request;
1289         drm_file_t *priv = filp->private_data;
1290         drm_device_t *dev = priv->head->dev;
1291         int ret;
1292
1293         if (!drm_core_check_feature(dev, DRIVER_HAVE_DMA))
1294                 return -EINVAL;
1295
1296         if (copy_from_user(&request, (drm_buf_desc_t __user *) arg,
1297                            sizeof(request)))
1298                 return -EFAULT;
1299
1300 #if __OS_HAS_AGP
1301         if (request.flags & _DRM_AGP_BUFFER)
1302                 ret = drm_addbufs_agp(dev, &request);
1303         else
1304 #endif
1305         if (request.flags & _DRM_SG_BUFFER)
1306                 ret = drm_addbufs_sg(dev, &request);
1307         else if (request.flags & _DRM_FB_BUFFER)
1308                 ret = drm_addbufs_fb(dev, &request);
1309         else
1310                 ret = drm_addbufs_pci(dev, &request);
1311
1312         if (ret == 0) {
1313                 if (copy_to_user((void __user *)arg, &request, sizeof(request))) {
1314                         ret = -EFAULT;
1315                 }
1316         }
1317         return ret;
1318 }
1319
1320 /**
1321  * Get information about the buffer mappings.
1322  *
1323  * This was originally mean for debugging purposes, or by a sophisticated
1324  * client library to determine how best to use the available buffers (e.g.,
1325  * large buffers can be used for image transfer).
1326  *
1327  * \param inode device inode.
1328  * \param filp file pointer.
1329  * \param cmd command.
1330  * \param arg pointer to a drm_buf_info structure.
1331  * \return zero on success or a negative number on failure.
1332  *
1333  * Increments drm_device::buf_use while holding the drm_device::count_lock
1334  * lock, preventing of allocating more buffers after this call. Information
1335  * about each requested buffer is then copied into user space.
1336  */
1337 int drm_infobufs(struct inode *inode, struct file *filp,
1338                  unsigned int cmd, unsigned long arg)
1339 {
1340         drm_file_t *priv = filp->private_data;
1341         drm_device_t *dev = priv->head->dev;
1342         drm_device_dma_t *dma = dev->dma;
1343         drm_buf_info_t request;
1344         drm_buf_info_t __user *argp = (void __user *)arg;
1345         int i;
1346         int count;
1347
1348         if (!drm_core_check_feature(dev, DRIVER_HAVE_DMA))
1349                 return -EINVAL;
1350
1351         if (!dma)
1352                 return -EINVAL;
1353
1354         spin_lock(&dev->count_lock);
1355         if (atomic_read(&dev->buf_alloc)) {
1356                 spin_unlock(&dev->count_lock);
1357                 return -EBUSY;
1358         }
1359         ++dev->buf_use;         /* Can't allocate more after this call */
1360         spin_unlock(&dev->count_lock);
1361
1362         if (copy_from_user(&request, argp, sizeof(request)))
1363                 return -EFAULT;
1364
1365         for (i = 0, count = 0; i < DRM_MAX_ORDER + 1; i++) {
1366                 if (dma->bufs[i].buf_count)
1367                         ++count;
1368         }
1369
1370         DRM_DEBUG("count = %d\n", count);
1371
1372         if (request.count >= count) {
1373                 for (i = 0, count = 0; i < DRM_MAX_ORDER + 1; i++) {
1374                         if (dma->bufs[i].buf_count) {
1375                                 drm_buf_desc_t __user *to =
1376                                     &request.list[count];
1377                                 drm_buf_entry_t *from = &dma->bufs[i];
1378                                 drm_freelist_t *list = &dma->bufs[i].freelist;
1379                                 if (copy_to_user(&to->count,
1380                                                  &from->buf_count,
1381                                                  sizeof(from->buf_count)) ||
1382                                     copy_to_user(&to->size,
1383                                                  &from->buf_size,
1384                                                  sizeof(from->buf_size)) ||
1385                                     copy_to_user(&to->low_mark,
1386                                                  &list->low_mark,
1387                                                  sizeof(list->low_mark)) ||
1388                                     copy_to_user(&to->high_mark,
1389                                                  &list->high_mark,
1390                                                  sizeof(list->high_mark)))
1391                                         return -EFAULT;
1392
1393                                 DRM_DEBUG("%d %d %d %d %d\n",
1394                                           i,
1395                                           dma->bufs[i].buf_count,
1396                                           dma->bufs[i].buf_size,
1397                                           dma->bufs[i].freelist.low_mark,
1398                                           dma->bufs[i].freelist.high_mark);
1399                                 ++count;
1400                         }
1401                 }
1402         }
1403         request.count = count;
1404
1405         if (copy_to_user(argp, &request, sizeof(request)))
1406                 return -EFAULT;
1407
1408         return 0;
1409 }
1410
1411 /**
1412  * Specifies a low and high water mark for buffer allocation
1413  *
1414  * \param inode device inode.
1415  * \param filp file pointer.
1416  * \param cmd command.
1417  * \param arg a pointer to a drm_buf_desc structure.
1418  * \return zero on success or a negative number on failure.
1419  *
1420  * Verifies that the size order is bounded between the admissible orders and
1421  * updates the respective drm_device_dma::bufs entry low and high water mark.
1422  *
1423  * \note This ioctl is deprecated and mostly never used.
1424  */
1425 int drm_markbufs(struct inode *inode, struct file *filp,
1426                  unsigned int cmd, unsigned long arg)
1427 {
1428         drm_file_t *priv = filp->private_data;
1429         drm_device_t *dev = priv->head->dev;
1430         drm_device_dma_t *dma = dev->dma;
1431         drm_buf_desc_t request;
1432         int order;
1433         drm_buf_entry_t *entry;
1434
1435         if (!drm_core_check_feature(dev, DRIVER_HAVE_DMA))
1436                 return -EINVAL;
1437
1438         if (!dma)
1439                 return -EINVAL;
1440
1441         if (copy_from_user(&request,
1442                            (drm_buf_desc_t __user *) arg, sizeof(request)))
1443                 return -EFAULT;
1444
1445         DRM_DEBUG("%d, %d, %d\n",
1446                   request.size, request.low_mark, request.high_mark);
1447         order = drm_order(request.size);
1448         if (order < DRM_MIN_ORDER || order > DRM_MAX_ORDER)
1449                 return -EINVAL;
1450         entry = &dma->bufs[order];
1451
1452         if (request.low_mark < 0 || request.low_mark > entry->buf_count)
1453                 return -EINVAL;
1454         if (request.high_mark < 0 || request.high_mark > entry->buf_count)
1455                 return -EINVAL;
1456
1457         entry->freelist.low_mark = request.low_mark;
1458         entry->freelist.high_mark = request.high_mark;
1459
1460         return 0;
1461 }
1462
1463 /**
1464  * Unreserve the buffers in list, previously reserved using drmDMA.
1465  *
1466  * \param inode device inode.
1467  * \param filp file pointer.
1468  * \param cmd command.
1469  * \param arg pointer to a drm_buf_free structure.
1470  * \return zero on success or a negative number on failure.
1471  *
1472  * Calls free_buffer() for each used buffer.
1473  * This function is primarily used for debugging.
1474  */
1475 int drm_freebufs(struct inode *inode, struct file *filp,
1476                  unsigned int cmd, unsigned long arg)
1477 {
1478         drm_file_t *priv = filp->private_data;
1479         drm_device_t *dev = priv->head->dev;
1480         drm_device_dma_t *dma = dev->dma;
1481         drm_buf_free_t request;
1482         int i;
1483         int idx;
1484         drm_buf_t *buf;
1485
1486         if (!drm_core_check_feature(dev, DRIVER_HAVE_DMA))
1487                 return -EINVAL;
1488
1489         if (!dma)
1490                 return -EINVAL;
1491
1492         if (copy_from_user(&request,
1493                            (drm_buf_free_t __user *) arg, sizeof(request)))
1494                 return -EFAULT;
1495
1496         DRM_DEBUG("%d\n", request.count);
1497         for (i = 0; i < request.count; i++) {
1498                 if (copy_from_user(&idx, &request.list[i], sizeof(idx)))
1499                         return -EFAULT;
1500                 if (idx < 0 || idx >= dma->buf_count) {
1501                         DRM_ERROR("Index %d (of %d max)\n",
1502                                   idx, dma->buf_count - 1);
1503                         return -EINVAL;
1504                 }
1505                 buf = dma->buflist[idx];
1506                 if (buf->filp != filp) {
1507                         DRM_ERROR("Process %d freeing buffer not owned\n",
1508                                   current->pid);
1509                         return -EINVAL;
1510                 }
1511                 drm_free_buffer(dev, buf);
1512         }
1513
1514         return 0;
1515 }
1516
1517 /**
1518  * Maps all of the DMA buffers into client-virtual space (ioctl).
1519  *
1520  * \param inode device inode.
1521  * \param filp file pointer.
1522  * \param cmd command.
1523  * \param arg pointer to a drm_buf_map structure.
1524  * \return zero on success or a negative number on failure.
1525  *
1526  * Maps the AGP, SG or PCI buffer region with do_mmap(), and copies information
1527  * about each buffer into user space. For PCI buffers, it calls do_mmap() with
1528  * offset equal to 0, which drm_mmap() interpretes as PCI buffers and calls
1529  * drm_mmap_dma().
1530  */
1531 int drm_mapbufs(struct inode *inode, struct file *filp,
1532                 unsigned int cmd, unsigned long arg)
1533 {
1534         drm_file_t *priv = filp->private_data;
1535         drm_device_t *dev = priv->head->dev;
1536         drm_device_dma_t *dma = dev->dma;
1537         drm_buf_map_t __user *argp = (void __user *)arg;
1538         int retcode = 0;
1539         const int zero = 0;
1540         unsigned long virtual;
1541         unsigned long address;
1542         drm_buf_map_t request;
1543         int i;
1544
1545         if (!drm_core_check_feature(dev, DRIVER_HAVE_DMA))
1546                 return -EINVAL;
1547
1548         if (!dma)
1549                 return -EINVAL;
1550
1551         spin_lock(&dev->count_lock);
1552         if (atomic_read(&dev->buf_alloc)) {
1553                 spin_unlock(&dev->count_lock);
1554                 return -EBUSY;
1555         }
1556         dev->buf_use++;         /* Can't allocate more after this call */
1557         spin_unlock(&dev->count_lock);
1558
1559         if (copy_from_user(&request, argp, sizeof(request)))
1560                 return -EFAULT;
1561
1562         if (request.count >= dma->buf_count) {
1563                 if ((drm_core_has_AGP(dev) && (dma->flags & _DRM_DMA_USE_AGP))
1564                     || (drm_core_check_feature(dev, DRIVER_SG)
1565                         && (dma->flags & _DRM_DMA_USE_SG))
1566                     || (drm_core_check_feature(dev, DRIVER_FB_DMA)
1567                         && (dma->flags & _DRM_DMA_USE_FB))) {
1568                         drm_map_t *map = dev->agp_buffer_map;
1569                         unsigned long token = dev->agp_buffer_token;
1570
1571                         if (!map) {
1572                                 retcode = -EINVAL;
1573                                 goto done;
1574                         }
1575
1576                         down_write(&current->mm->mmap_sem);
1577                         virtual = do_mmap(filp, 0, map->size,
1578                                           PROT_READ | PROT_WRITE,
1579                                           MAP_SHARED, token);
1580                         up_write(&current->mm->mmap_sem);
1581                 } else {
1582                         down_write(&current->mm->mmap_sem);
1583                         virtual = do_mmap(filp, 0, dma->byte_count,
1584                                           PROT_READ | PROT_WRITE,
1585                                           MAP_SHARED, 0);
1586                         up_write(&current->mm->mmap_sem);
1587                 }
1588                 if (virtual > -1024UL) {
1589                         /* Real error */
1590                         retcode = (signed long)virtual;
1591                         goto done;
1592                 }
1593                 request.virtual = (void __user *)virtual;
1594
1595                 for (i = 0; i < dma->buf_count; i++) {
1596                         if (copy_to_user(&request.list[i].idx,
1597                                          &dma->buflist[i]->idx,
1598                                          sizeof(request.list[0].idx))) {
1599                                 retcode = -EFAULT;
1600                                 goto done;
1601                         }
1602                         if (copy_to_user(&request.list[i].total,
1603                                          &dma->buflist[i]->total,
1604                                          sizeof(request.list[0].total))) {
1605                                 retcode = -EFAULT;
1606                                 goto done;
1607                         }
1608                         if (copy_to_user(&request.list[i].used,
1609                                          &zero, sizeof(zero))) {
1610                                 retcode = -EFAULT;
1611                                 goto done;
1612                         }
1613                         address = virtual + dma->buflist[i]->offset;    /* *** */
1614                         if (copy_to_user(&request.list[i].address,
1615                                          &address, sizeof(address))) {
1616                                 retcode = -EFAULT;
1617                                 goto done;
1618                         }
1619                 }
1620         }
1621       done:
1622         request.count = dma->buf_count;
1623         DRM_DEBUG("%d buffers, retcode = %d\n", request.count, retcode);
1624
1625         if (copy_to_user(argp, &request, sizeof(request)))
1626                 return -EFAULT;
1627
1628         return retcode;
1629 }
1630
1631 /**
1632  * Compute size order.  Returns the exponent of the smaller power of two which
1633  * is greater or equal to given number.
1634  *
1635  * \param size size.
1636  * \return order.
1637  *
1638  * \todo Can be made faster.
1639  */
1640 int drm_order(unsigned long size)
1641 {
1642         int order;
1643         unsigned long tmp;
1644
1645         for (order = 0, tmp = size >> 1; tmp; tmp >>= 1, order++) ;
1646
1647         if (size & (size - 1))
1648                 ++order;
1649
1650         return order;
1651 }
1652 EXPORT_SYMBOL(drm_order);
1653
1654