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