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