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