| 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); |