1138 static int extend_iommu_mapping(struct dma_iommu_mapping *mapping);
1140 static inline dma_addr_t __alloc_iova(struct dma_iommu_mapping *mapping,  in __alloc_iova()  argument
1146 	size_t mapping_size = mapping->bits << PAGE_SHIFT;  in __alloc_iova()
1157 	spin_lock_irqsave(&mapping->lock, flags);  in __alloc_iova()
1158 	for (i = 0; i < mapping->nr_bitmaps; i++) {  in __alloc_iova()
1159 		start = bitmap_find_next_zero_area(mapping->bitmaps[i],  in __alloc_iova()
1160 				mapping->bits, 0, count, align);  in __alloc_iova()
1162 		if (start > mapping->bits)  in __alloc_iova()
1165 		bitmap_set(mapping->bitmaps[i], start, count);  in __alloc_iova()
1174 	if (i == mapping->nr_bitmaps) {  in __alloc_iova()
1175 		if (extend_iommu_mapping(mapping)) {  in __alloc_iova()
1176 			spin_unlock_irqrestore(&mapping->lock, flags);  in __alloc_iova()
1180 		start = bitmap_find_next_zero_area(mapping->bitmaps[i],  in __alloc_iova()
1181 				mapping->bits, 0, count, align);  in __alloc_iova()
1183 		if (start > mapping->bits) {  in __alloc_iova()
1184 			spin_unlock_irqrestore(&mapping->lock, flags);  in __alloc_iova()
1188 		bitmap_set(mapping->bitmaps[i], start, count);  in __alloc_iova()
1190 	spin_unlock_irqrestore(&mapping->lock, flags);  in __alloc_iova()
1192 	iova = mapping->base + (mapping_size * i);  in __alloc_iova()
1198 static inline void __free_iova(struct dma_iommu_mapping *mapping,  in __free_iova()  argument
1202 	size_t mapping_size = mapping->bits << PAGE_SHIFT;  in __free_iova()
1210 	bitmap_index = (u32) (addr - mapping->base) / (u32) mapping_size;  in __free_iova()
1211 	BUG_ON(addr < mapping->base || bitmap_index > mapping->extensions);  in __free_iova()
1213 	bitmap_base = mapping->base + mapping_size * bitmap_index;  in __free_iova()
1228 	spin_lock_irqsave(&mapping->lock, flags);  in __free_iova()
1229 	bitmap_clear(mapping->bitmaps[bitmap_index], start, count);  in __free_iova()
1230 	spin_unlock_irqrestore(&mapping->lock, flags);  in __free_iova()
1352 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in __iommu_create_mapping()  local
1357 	dma_addr = __alloc_iova(mapping, size);  in __iommu_create_mapping()
1374 		ret = iommu_map(mapping->domain, iova, phys, len,  in __iommu_create_mapping()
1383 	iommu_unmap(mapping->domain, dma_addr, iova-dma_addr);  in __iommu_create_mapping()
1384 	__free_iova(mapping, dma_addr, size);  in __iommu_create_mapping()
1390 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in __iommu_remove_mapping()  local
1399 	iommu_unmap(mapping->domain, iova, size);  in __iommu_remove_mapping()
1400 	__free_iova(mapping, iova, size);  in __iommu_remove_mapping()
1620 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in __map_sg_chunk()  local
1630 	iova_base = iova = __alloc_iova(mapping, size);  in __map_sg_chunk()
1643 		ret = iommu_map(mapping->domain, iova, phys, len, prot);  in __map_sg_chunk()
1653 	iommu_unmap(mapping->domain, iova_base, count * PAGE_SIZE);  in __map_sg_chunk()
1654 	__free_iova(mapping, iova_base, size);  in __map_sg_chunk()
1841 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_coherent_iommu_map_page()  local
1845 	dma_addr = __alloc_iova(mapping, len);  in arm_coherent_iommu_map_page()
1851 	ret = iommu_map(mapping->domain, dma_addr, page_to_phys(page), len, prot);  in arm_coherent_iommu_map_page()
1857 	__free_iova(mapping, dma_addr, len);  in arm_coherent_iommu_map_page()
1893 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_coherent_iommu_unmap_page()  local
1901 	iommu_unmap(mapping->domain, iova, len);  in arm_coherent_iommu_unmap_page()
1902 	__free_iova(mapping, iova, len);  in arm_coherent_iommu_unmap_page()
1917 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_unmap_page()  local
1919 	struct page *page = phys_to_page(iommu_iova_to_phys(mapping->domain, iova));  in arm_iommu_unmap_page()
1929 	iommu_unmap(mapping->domain, iova, len);  in arm_iommu_unmap_page()
1930 	__free_iova(mapping, iova, len);  in arm_iommu_unmap_page()
1944 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_map_resource()  local
1951 	dma_addr = __alloc_iova(mapping, len);  in arm_iommu_map_resource()
1957 	ret = iommu_map(mapping->domain, dma_addr, addr, len, prot);  in arm_iommu_map_resource()
1963 	__free_iova(mapping, dma_addr, len);  in arm_iommu_map_resource()
1978 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_unmap_resource()  local
1986 	iommu_unmap(mapping->domain, iova, len);  in arm_iommu_unmap_resource()
1987 	__free_iova(mapping, iova, len);  in arm_iommu_unmap_resource()
1993 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_sync_single_for_cpu()  local
1995 	struct page *page = phys_to_page(iommu_iova_to_phys(mapping->domain, iova));  in arm_iommu_sync_single_for_cpu()
2007 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_sync_single_for_device()  local
2009 	struct page *page = phys_to_page(iommu_iova_to_phys(mapping->domain, iova));  in arm_iommu_sync_single_for_device()
2076 	struct dma_iommu_mapping *mapping;  in arm_iommu_create_mapping()  local
2092 	mapping = kzalloc(sizeof(struct dma_iommu_mapping), GFP_KERNEL);  in arm_iommu_create_mapping()
2093 	if (!mapping)  in arm_iommu_create_mapping()
2096 	mapping->bitmap_size = bitmap_size;  in arm_iommu_create_mapping()
2097 	mapping->bitmaps = kcalloc(extensions, sizeof(unsigned long *),  in arm_iommu_create_mapping()
2099 	if (!mapping->bitmaps)  in arm_iommu_create_mapping()
2102 	mapping->bitmaps[0] = kzalloc(bitmap_size, GFP_KERNEL);  in arm_iommu_create_mapping()
2103 	if (!mapping->bitmaps[0])  in arm_iommu_create_mapping()
2106 	mapping->nr_bitmaps = 1;  in arm_iommu_create_mapping()
2107 	mapping->extensions = extensions;  in arm_iommu_create_mapping()
2108 	mapping->base = base;  in arm_iommu_create_mapping()
2109 	mapping->bits = BITS_PER_BYTE * bitmap_size;  in arm_iommu_create_mapping()
2111 	spin_lock_init(&mapping->lock);  in arm_iommu_create_mapping()
2113 	mapping->domain = iommu_domain_alloc(bus);  in arm_iommu_create_mapping()
2114 	if (!mapping->domain)  in arm_iommu_create_mapping()
2117 	kref_init(&mapping->kref);  in arm_iommu_create_mapping()
2118 	return mapping;  in arm_iommu_create_mapping()
2120 	kfree(mapping->bitmaps[0]);  in arm_iommu_create_mapping()
2122 	kfree(mapping->bitmaps);  in arm_iommu_create_mapping()
2124 	kfree(mapping);  in arm_iommu_create_mapping()
2133 	struct dma_iommu_mapping *mapping =  in release_iommu_mapping()  local
2136 	iommu_domain_free(mapping->domain);  in release_iommu_mapping()
2137 	for (i = 0; i < mapping->nr_bitmaps; i++)  in release_iommu_mapping()
2138 		kfree(mapping->bitmaps[i]);  in release_iommu_mapping()
2139 	kfree(mapping->bitmaps);  in release_iommu_mapping()
2140 	kfree(mapping);  in release_iommu_mapping()
2143 static int extend_iommu_mapping(struct dma_iommu_mapping *mapping)  in extend_iommu_mapping()  argument
2147 	if (mapping->nr_bitmaps >= mapping->extensions)  in extend_iommu_mapping()
2150 	next_bitmap = mapping->nr_bitmaps;  in extend_iommu_mapping()
2151 	mapping->bitmaps[next_bitmap] = kzalloc(mapping->bitmap_size,  in extend_iommu_mapping()
2153 	if (!mapping->bitmaps[next_bitmap])  in extend_iommu_mapping()
2156 	mapping->nr_bitmaps++;  in extend_iommu_mapping()
2161 void arm_iommu_release_mapping(struct dma_iommu_mapping *mapping)  in arm_iommu_release_mapping()  argument
2163 	if (mapping)  in arm_iommu_release_mapping()
2164 		kref_put(&mapping->kref, release_iommu_mapping);  in arm_iommu_release_mapping()
2169 				     struct dma_iommu_mapping *mapping)  in __arm_iommu_attach_device()  argument
2173 	err = iommu_attach_device(mapping->domain, dev);  in __arm_iommu_attach_device()
2177 	kref_get(&mapping->kref);  in __arm_iommu_attach_device()
2178 	to_dma_iommu_mapping(dev) = mapping;  in __arm_iommu_attach_device()
2198 			    struct dma_iommu_mapping *mapping)  in arm_iommu_attach_device()  argument
2202 	err = __arm_iommu_attach_device(dev, mapping);  in arm_iommu_attach_device()
2220 	struct dma_iommu_mapping *mapping;  in arm_iommu_detach_device()  local
2222 	mapping = to_dma_iommu_mapping(dev);  in arm_iommu_detach_device()
2223 	if (!mapping) {  in arm_iommu_detach_device()
2228 	iommu_detach_device(mapping->domain, dev);  in arm_iommu_detach_device()
2229 	kref_put(&mapping->kref, release_iommu_mapping);  in arm_iommu_detach_device()
2245 	struct dma_iommu_mapping *mapping;  in arm_setup_iommu_dma_ops()  local
2250 	mapping = arm_iommu_create_mapping(dev->bus, dma_base, size);  in arm_setup_iommu_dma_ops()
2251 	if (IS_ERR(mapping)) {  in arm_setup_iommu_dma_ops()
2257 	if (__arm_iommu_attach_device(dev, mapping)) {  in arm_setup_iommu_dma_ops()
2260 		arm_iommu_release_mapping(mapping);  in arm_setup_iommu_dma_ops()
2269 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_teardown_iommu_dma_ops()  local
2271 	if (!mapping)  in arm_teardown_iommu_dma_ops()
2275 	arm_iommu_release_mapping(mapping);  in arm_teardown_iommu_dma_ops()