Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * IOMMU helper functions for the free area management
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) #include <linux/bitmap.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) #include <linux/iommu-helper.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) unsigned long iommu_area_alloc(unsigned long *map, unsigned long size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) 			       unsigned long start, unsigned int nr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 			       unsigned long shift, unsigned long boundary_size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 			       unsigned long align_mask)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 	unsigned long index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	/* We don't want the last of the limit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 	size -= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) again:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	index = bitmap_find_next_zero_area(map, size, start, nr, align_mask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	if (index < size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 		if (iommu_is_span_boundary(index, nr, shift, boundary_size)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 			start = ALIGN(shift + index, boundary_size) - shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 			goto again;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 		bitmap_set(map, index, nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 		return index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) }