18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * IOMMU helper functions for the free area management
48c2ecf20Sopenharmony_ci */
58c2ecf20Sopenharmony_ci
68c2ecf20Sopenharmony_ci#include <linux/bitmap.h>
78c2ecf20Sopenharmony_ci#include <linux/iommu-helper.h>
88c2ecf20Sopenharmony_ci
98c2ecf20Sopenharmony_ciunsigned long iommu_area_alloc(unsigned long *map, unsigned long size,
108c2ecf20Sopenharmony_ci			       unsigned long start, unsigned int nr,
118c2ecf20Sopenharmony_ci			       unsigned long shift, unsigned long boundary_size,
128c2ecf20Sopenharmony_ci			       unsigned long align_mask)
138c2ecf20Sopenharmony_ci{
148c2ecf20Sopenharmony_ci	unsigned long index;
158c2ecf20Sopenharmony_ci
168c2ecf20Sopenharmony_ci	/* We don't want the last of the limit */
178c2ecf20Sopenharmony_ci	size -= 1;
188c2ecf20Sopenharmony_ciagain:
198c2ecf20Sopenharmony_ci	index = bitmap_find_next_zero_area(map, size, start, nr, align_mask);
208c2ecf20Sopenharmony_ci	if (index < size) {
218c2ecf20Sopenharmony_ci		if (iommu_is_span_boundary(index, nr, shift, boundary_size)) {
228c2ecf20Sopenharmony_ci			start = ALIGN(shift + index, boundary_size) - shift;
238c2ecf20Sopenharmony_ci			goto again;
248c2ecf20Sopenharmony_ci		}
258c2ecf20Sopenharmony_ci		bitmap_set(map, index, nr);
268c2ecf20Sopenharmony_ci		return index;
278c2ecf20Sopenharmony_ci	}
288c2ecf20Sopenharmony_ci	return -1;
298c2ecf20Sopenharmony_ci}
30