1182 static int extend_iommu_mapping(struct dma_iommu_mapping *mapping);
1184 static inline dma_addr_t __alloc_iova(struct dma_iommu_mapping *mapping,  in __alloc_iova()  argument
1190 	size_t mapping_size = mapping->bits << PAGE_SHIFT;  in __alloc_iova()
1201 	spin_lock_irqsave(&mapping->lock, flags);  in __alloc_iova()
1202 	for (i = 0; i < mapping->nr_bitmaps; i++) {  in __alloc_iova()
1203 		start = bitmap_find_next_zero_area(mapping->bitmaps[i],  in __alloc_iova()
1204 				mapping->bits, 0, count, align);  in __alloc_iova()
1206 		if (start > mapping->bits)  in __alloc_iova()
1209 		bitmap_set(mapping->bitmaps[i], start, count);  in __alloc_iova()
1218 	if (i == mapping->nr_bitmaps) {  in __alloc_iova()
1219 		if (extend_iommu_mapping(mapping)) {  in __alloc_iova()
1220 			spin_unlock_irqrestore(&mapping->lock, flags);  in __alloc_iova()
1224 		start = bitmap_find_next_zero_area(mapping->bitmaps[i],  in __alloc_iova()
1225 				mapping->bits, 0, count, align);  in __alloc_iova()
1227 		if (start > mapping->bits) {  in __alloc_iova()
1228 			spin_unlock_irqrestore(&mapping->lock, flags);  in __alloc_iova()
1232 		bitmap_set(mapping->bitmaps[i], start, count);  in __alloc_iova()
1234 	spin_unlock_irqrestore(&mapping->lock, flags);  in __alloc_iova()
1236 	iova = mapping->base + (mapping_size * i);  in __alloc_iova()
1242 static inline void __free_iova(struct dma_iommu_mapping *mapping,  in __free_iova()  argument
1246 	size_t mapping_size = mapping->bits << PAGE_SHIFT;  in __free_iova()
1254 	bitmap_index = (u32) (addr - mapping->base) / (u32) mapping_size;  in __free_iova()
1255 	BUG_ON(addr < mapping->base || bitmap_index > mapping->extensions);  in __free_iova()
1257 	bitmap_base = mapping->base + mapping_size * bitmap_index;  in __free_iova()
1272 	spin_lock_irqsave(&mapping->lock, flags);  in __free_iova()
1273 	bitmap_clear(mapping->bitmaps[bitmap_index], start, count);  in __free_iova()
1274 	spin_unlock_irqrestore(&mapping->lock, flags);  in __free_iova()
1407 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in __iommu_create_mapping()  local
1412 	dma_addr = __alloc_iova(mapping, size);  in __iommu_create_mapping()
1429 		ret = iommu_map(mapping->domain, iova, phys, len,  in __iommu_create_mapping()
1438 	iommu_unmap(mapping->domain, dma_addr, iova-dma_addr);  in __iommu_create_mapping()
1439 	__free_iova(mapping, dma_addr, size);  in __iommu_create_mapping()
1445 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in __iommu_remove_mapping()  local
1454 	iommu_unmap(mapping->domain, iova, size);  in __iommu_remove_mapping()
1455 	__free_iova(mapping, iova, size);  in __iommu_remove_mapping()
1692 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in __map_sg_chunk()  local
1702 	iova_base = iova = __alloc_iova(mapping, size);  in __map_sg_chunk()
1715 		ret = iommu_map(mapping->domain, iova, phys, len, prot);  in __map_sg_chunk()
1725 	iommu_unmap(mapping->domain, iova_base, count * PAGE_SIZE);  in __map_sg_chunk()
1726 	__free_iova(mapping, iova_base, size);  in __map_sg_chunk()
1913 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_coherent_iommu_map_page()  local
1917 	dma_addr = __alloc_iova(mapping, len);  in arm_coherent_iommu_map_page()
1923 	ret = iommu_map(mapping->domain, dma_addr, page_to_phys(page), len, prot);  in arm_coherent_iommu_map_page()
1929 	__free_iova(mapping, dma_addr, len);  in arm_coherent_iommu_map_page()
1965 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_coherent_iommu_unmap_page()  local
1973 	iommu_unmap(mapping->domain, iova, len);  in arm_coherent_iommu_unmap_page()
1974 	__free_iova(mapping, iova, len);  in arm_coherent_iommu_unmap_page()
1989 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_unmap_page()  local
1991 	struct page *page = phys_to_page(iommu_iova_to_phys(mapping->domain, iova));  in arm_iommu_unmap_page()
2001 	iommu_unmap(mapping->domain, iova, len);  in arm_iommu_unmap_page()
2002 	__free_iova(mapping, iova, len);  in arm_iommu_unmap_page()
2016 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_map_resource()  local
2023 	dma_addr = __alloc_iova(mapping, len);  in arm_iommu_map_resource()
2029 	ret = iommu_map(mapping->domain, dma_addr, addr, len, prot);  in arm_iommu_map_resource()
2035 	__free_iova(mapping, dma_addr, len);  in arm_iommu_map_resource()
2050 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_unmap_resource()  local
2058 	iommu_unmap(mapping->domain, iova, len);  in arm_iommu_unmap_resource()
2059 	__free_iova(mapping, iova, len);  in arm_iommu_unmap_resource()
2065 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_sync_single_for_cpu()  local
2067 	struct page *page = phys_to_page(iommu_iova_to_phys(mapping->domain, iova));  in arm_iommu_sync_single_for_cpu()
2079 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_sync_single_for_device()  local
2081 	struct page *page = phys_to_page(iommu_iova_to_phys(mapping->domain, iova));  in arm_iommu_sync_single_for_device()
2150 	struct dma_iommu_mapping *mapping;  in arm_iommu_create_mapping()  local
2166 	mapping = kzalloc(sizeof(struct dma_iommu_mapping), GFP_KERNEL);  in arm_iommu_create_mapping()
2167 	if (!mapping)  in arm_iommu_create_mapping()
2170 	mapping->bitmap_size = bitmap_size;  in arm_iommu_create_mapping()
2171 	mapping->bitmaps = kcalloc(extensions, sizeof(unsigned long *),  in arm_iommu_create_mapping()
2173 	if (!mapping->bitmaps)  in arm_iommu_create_mapping()
2176 	mapping->bitmaps[0] = kzalloc(bitmap_size, GFP_KERNEL);  in arm_iommu_create_mapping()
2177 	if (!mapping->bitmaps[0])  in arm_iommu_create_mapping()
2180 	mapping->nr_bitmaps = 1;  in arm_iommu_create_mapping()
2181 	mapping->extensions = extensions;  in arm_iommu_create_mapping()
2182 	mapping->base = base;  in arm_iommu_create_mapping()
2183 	mapping->bits = BITS_PER_BYTE * bitmap_size;  in arm_iommu_create_mapping()
2185 	spin_lock_init(&mapping->lock);  in arm_iommu_create_mapping()
2187 	mapping->domain = iommu_domain_alloc(bus);  in arm_iommu_create_mapping()
2188 	if (!mapping->domain)  in arm_iommu_create_mapping()
2191 	kref_init(&mapping->kref);  in arm_iommu_create_mapping()
2192 	return mapping;  in arm_iommu_create_mapping()
2194 	kfree(mapping->bitmaps[0]);  in arm_iommu_create_mapping()
2196 	kfree(mapping->bitmaps);  in arm_iommu_create_mapping()
2198 	kfree(mapping);  in arm_iommu_create_mapping()
2207 	struct dma_iommu_mapping *mapping =  in release_iommu_mapping()  local
2210 	iommu_domain_free(mapping->domain);  in release_iommu_mapping()
2211 	for (i = 0; i < mapping->nr_bitmaps; i++)  in release_iommu_mapping()
2212 		kfree(mapping->bitmaps[i]);  in release_iommu_mapping()
2213 	kfree(mapping->bitmaps);  in release_iommu_mapping()
2214 	kfree(mapping);  in release_iommu_mapping()
2217 static int extend_iommu_mapping(struct dma_iommu_mapping *mapping)  in extend_iommu_mapping()  argument
2221 	if (mapping->nr_bitmaps >= mapping->extensions)  in extend_iommu_mapping()
2224 	next_bitmap = mapping->nr_bitmaps;  in extend_iommu_mapping()
2225 	mapping->bitmaps[next_bitmap] = kzalloc(mapping->bitmap_size,  in extend_iommu_mapping()
2227 	if (!mapping->bitmaps[next_bitmap])  in extend_iommu_mapping()
2230 	mapping->nr_bitmaps++;  in extend_iommu_mapping()
2235 void arm_iommu_release_mapping(struct dma_iommu_mapping *mapping)  in arm_iommu_release_mapping()  argument
2237 	if (mapping)  in arm_iommu_release_mapping()
2238 		kref_put(&mapping->kref, release_iommu_mapping);  in arm_iommu_release_mapping()
2243 				     struct dma_iommu_mapping *mapping)  in __arm_iommu_attach_device()  argument
2247 	err = iommu_attach_device(mapping->domain, dev);  in __arm_iommu_attach_device()
2251 	kref_get(&mapping->kref);  in __arm_iommu_attach_device()
2252 	to_dma_iommu_mapping(dev) = mapping;  in __arm_iommu_attach_device()
2272 			    struct dma_iommu_mapping *mapping)  in arm_iommu_attach_device()  argument
2276 	err = __arm_iommu_attach_device(dev, mapping);  in arm_iommu_attach_device()
2294 	struct dma_iommu_mapping *mapping;  in arm_iommu_detach_device()  local
2296 	mapping = to_dma_iommu_mapping(dev);  in arm_iommu_detach_device()
2297 	if (!mapping) {  in arm_iommu_detach_device()
2302 	iommu_detach_device(mapping->domain, dev);  in arm_iommu_detach_device()
2303 	kref_put(&mapping->kref, release_iommu_mapping);  in arm_iommu_detach_device()
2319 	struct dma_iommu_mapping *mapping;  in arm_setup_iommu_dma_ops()  local
2324 	mapping = arm_iommu_create_mapping(dev->bus, dma_base, size);  in arm_setup_iommu_dma_ops()
2325 	if (IS_ERR(mapping)) {  in arm_setup_iommu_dma_ops()
2331 	if (__arm_iommu_attach_device(dev, mapping)) {  in arm_setup_iommu_dma_ops()
2334 		arm_iommu_release_mapping(mapping);  in arm_setup_iommu_dma_ops()
2343 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_teardown_iommu_dma_ops()  local
2345 	if (!mapping)  in arm_teardown_iommu_dma_ops()
2349 	arm_iommu_release_mapping(mapping);  in arm_teardown_iommu_dma_ops()