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