| FUJITA Tomonori | 0291df8 | 2008-02-04 22:28:07 -0800 | [diff] [blame] | 1 | /* | 
|  | 2 | * IOMMU helper functions for the free area management | 
|  | 3 | */ | 
|  | 4 |  | 
|  | 5 | #include <linux/module.h> | 
| Akinobu Mita | a66022c | 2009-12-15 16:48:28 -0800 | [diff] [blame] | 6 | #include <linux/bitmap.h> | 
| FUJITA Tomonori | 0291df8 | 2008-02-04 22:28:07 -0800 | [diff] [blame] | 7 |  | 
| FUJITA Tomonori | 3715863 | 2008-03-04 14:29:27 -0800 | [diff] [blame] | 8 | int iommu_is_span_boundary(unsigned int index, unsigned int nr, | 
|  | 9 | unsigned long shift, | 
|  | 10 | unsigned long boundary_size) | 
| FUJITA Tomonori | 0291df8 | 2008-02-04 22:28:07 -0800 | [diff] [blame] | 11 | { | 
| FUJITA Tomonori | 3715863 | 2008-03-04 14:29:27 -0800 | [diff] [blame] | 12 | BUG_ON(!is_power_of_2(boundary_size)); | 
|  | 13 |  | 
| FUJITA Tomonori | 0291df8 | 2008-02-04 22:28:07 -0800 | [diff] [blame] | 14 | shift = (shift + index) & (boundary_size - 1); | 
|  | 15 | return shift + nr > boundary_size; | 
|  | 16 | } | 
|  | 17 |  | 
|  | 18 | unsigned long iommu_area_alloc(unsigned long *map, unsigned long size, | 
|  | 19 | unsigned long start, unsigned int nr, | 
|  | 20 | unsigned long shift, unsigned long boundary_size, | 
|  | 21 | unsigned long align_mask) | 
|  | 22 | { | 
|  | 23 | unsigned long index; | 
| Akinobu Mita | a66022c | 2009-12-15 16:48:28 -0800 | [diff] [blame] | 24 |  | 
|  | 25 | /* We don't want the last of the limit */ | 
|  | 26 | size -= 1; | 
| FUJITA Tomonori | 0291df8 | 2008-02-04 22:28:07 -0800 | [diff] [blame] | 27 | again: | 
| Akinobu Mita | a66022c | 2009-12-15 16:48:28 -0800 | [diff] [blame] | 28 | index = bitmap_find_next_zero_area(map, size, start, nr, align_mask); | 
|  | 29 | if (index < size) { | 
| FUJITA Tomonori | 3715863 | 2008-03-04 14:29:27 -0800 | [diff] [blame] | 30 | if (iommu_is_span_boundary(index, nr, shift, boundary_size)) { | 
| FUJITA Tomonori | 0291df8 | 2008-02-04 22:28:07 -0800 | [diff] [blame] | 31 | /* we could do more effectively */ | 
|  | 32 | start = index + 1; | 
|  | 33 | goto again; | 
|  | 34 | } | 
| Akinobu Mita | a66022c | 2009-12-15 16:48:28 -0800 | [diff] [blame] | 35 | bitmap_set(map, index, nr); | 
|  | 36 | return index; | 
| FUJITA Tomonori | 0291df8 | 2008-02-04 22:28:07 -0800 | [diff] [blame] | 37 | } | 
| Akinobu Mita | a66022c | 2009-12-15 16:48:28 -0800 | [diff] [blame] | 38 | return -1; | 
| FUJITA Tomonori | 0291df8 | 2008-02-04 22:28:07 -0800 | [diff] [blame] | 39 | } | 
|  | 40 | EXPORT_SYMBOL(iommu_area_alloc); |