1020 static int extend_iommu_mapping(struct dma_iommu_mapping *mapping);
1022 static inline dma_addr_t __alloc_iova(struct dma_iommu_mapping *mapping,  in __alloc_iova()  argument
1028 	size_t mapping_size = mapping->bits << PAGE_SHIFT;  in __alloc_iova()
1039 	spin_lock_irqsave(&mapping->lock, flags);  in __alloc_iova()
1040 	for (i = 0; i < mapping->nr_bitmaps; i++) {  in __alloc_iova()
1041 		start = bitmap_find_next_zero_area(mapping->bitmaps[i],  in __alloc_iova()
1042 				mapping->bits, 0, count, align);  in __alloc_iova()
1044 		if (start > mapping->bits)  in __alloc_iova()
1047 		bitmap_set(mapping->bitmaps[i], start, count);  in __alloc_iova()
1056 	if (i == mapping->nr_bitmaps) {  in __alloc_iova()
1057 		if (extend_iommu_mapping(mapping)) {  in __alloc_iova()
1058 			spin_unlock_irqrestore(&mapping->lock, flags);  in __alloc_iova()
1062 		start = bitmap_find_next_zero_area(mapping->bitmaps[i],  in __alloc_iova()
1063 				mapping->bits, 0, count, align);  in __alloc_iova()
1065 		if (start > mapping->bits) {  in __alloc_iova()
1066 			spin_unlock_irqrestore(&mapping->lock, flags);  in __alloc_iova()
1070 		bitmap_set(mapping->bitmaps[i], start, count);  in __alloc_iova()
1072 	spin_unlock_irqrestore(&mapping->lock, flags);  in __alloc_iova()
1074 	iova = mapping->base + (mapping_size * i);  in __alloc_iova()
1080 static inline void __free_iova(struct dma_iommu_mapping *mapping,  in __free_iova()  argument
1084 	size_t mapping_size = mapping->bits << PAGE_SHIFT;  in __free_iova()
1092 	bitmap_index = (u32) (addr - mapping->base) / (u32) mapping_size;  in __free_iova()
1093 	BUG_ON(addr < mapping->base || bitmap_index > mapping->extensions);  in __free_iova()
1095 	bitmap_base = mapping->base + mapping_size * bitmap_index;  in __free_iova()
1110 	spin_lock_irqsave(&mapping->lock, flags);  in __free_iova()
1111 	bitmap_clear(mapping->bitmaps[bitmap_index], start, count);  in __free_iova()
1112 	spin_unlock_irqrestore(&mapping->lock, flags);  in __free_iova()
1239 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in __iommu_create_mapping()  local
1244 	dma_addr = __alloc_iova(mapping, size);  in __iommu_create_mapping()
1259 		ret = iommu_map(mapping->domain, iova, phys, len,  in __iommu_create_mapping()
1268 	iommu_unmap(mapping->domain, dma_addr, iova-dma_addr);  in __iommu_create_mapping()
1269 	__free_iova(mapping, dma_addr, size);  in __iommu_create_mapping()
1275 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in __iommu_remove_mapping()  local
1284 	iommu_unmap(mapping->domain, iova, size);  in __iommu_remove_mapping()
1285 	__free_iova(mapping, iova, size);  in __iommu_remove_mapping()
1497 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in __map_sg_chunk()  local
1507 	iova_base = iova = __alloc_iova(mapping, size);  in __map_sg_chunk()
1521 		ret = iommu_map(mapping->domain, iova, phys, len, prot);  in __map_sg_chunk()
1531 	iommu_unmap(mapping->domain, iova_base, count * PAGE_SIZE);  in __map_sg_chunk()
1532 	__free_iova(mapping, iova_base, size);  in __map_sg_chunk()
1718 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_coherent_iommu_map_page()  local
1722 	dma_addr = __alloc_iova(mapping, len);  in arm_coherent_iommu_map_page()
1728 	ret = iommu_map(mapping->domain, dma_addr, page_to_phys(page), len, prot);  in arm_coherent_iommu_map_page()
1734 	__free_iova(mapping, dma_addr, len);  in arm_coherent_iommu_map_page()
1771 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_coherent_iommu_unmap_page()  local
1779 	iommu_unmap(mapping->domain, iova, len);  in arm_coherent_iommu_unmap_page()
1780 	__free_iova(mapping, iova, len);  in arm_coherent_iommu_unmap_page()
1796 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_unmap_page()  local
1798 	struct page *page = phys_to_page(iommu_iova_to_phys(mapping->domain, iova));  in arm_iommu_unmap_page()
1808 	iommu_unmap(mapping->domain, iova, len);  in arm_iommu_unmap_page()
1809 	__free_iova(mapping, iova, len);  in arm_iommu_unmap_page()
1815 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_sync_single_for_cpu()  local
1817 	struct page *page = phys_to_page(iommu_iova_to_phys(mapping->domain, iova));  in arm_iommu_sync_single_for_cpu()
1829 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_iommu_sync_single_for_device()  local
1831 	struct page *page = phys_to_page(iommu_iova_to_phys(mapping->domain, iova));  in arm_iommu_sync_single_for_device()
1892 	struct dma_iommu_mapping *mapping;  in arm_iommu_create_mapping()  local
1908 	mapping = kzalloc(sizeof(struct dma_iommu_mapping), GFP_KERNEL);  in arm_iommu_create_mapping()
1909 	if (!mapping)  in arm_iommu_create_mapping()
1912 	mapping->bitmap_size = bitmap_size;  in arm_iommu_create_mapping()
1913 	mapping->bitmaps = kzalloc(extensions * sizeof(unsigned long *),  in arm_iommu_create_mapping()
1915 	if (!mapping->bitmaps)  in arm_iommu_create_mapping()
1918 	mapping->bitmaps[0] = kzalloc(bitmap_size, GFP_KERNEL);  in arm_iommu_create_mapping()
1919 	if (!mapping->bitmaps[0])  in arm_iommu_create_mapping()
1922 	mapping->nr_bitmaps = 1;  in arm_iommu_create_mapping()
1923 	mapping->extensions = extensions;  in arm_iommu_create_mapping()
1924 	mapping->base = base;  in arm_iommu_create_mapping()
1925 	mapping->bits = BITS_PER_BYTE * bitmap_size;  in arm_iommu_create_mapping()
1927 	spin_lock_init(&mapping->lock);  in arm_iommu_create_mapping()
1929 	mapping->domain = iommu_domain_alloc(bus);  in arm_iommu_create_mapping()
1930 	if (!mapping->domain)  in arm_iommu_create_mapping()
1933 	kref_init(&mapping->kref);  in arm_iommu_create_mapping()
1934 	return mapping;  in arm_iommu_create_mapping()
1936 	kfree(mapping->bitmaps[0]);  in arm_iommu_create_mapping()
1938 	kfree(mapping->bitmaps);  in arm_iommu_create_mapping()
1940 	kfree(mapping);  in arm_iommu_create_mapping()
1949 	struct dma_iommu_mapping *mapping =  in release_iommu_mapping()  local
1952 	iommu_domain_free(mapping->domain);  in release_iommu_mapping()
1953 	for (i = 0; i < mapping->nr_bitmaps; i++)  in release_iommu_mapping()
1954 		kfree(mapping->bitmaps[i]);  in release_iommu_mapping()
1955 	kfree(mapping->bitmaps);  in release_iommu_mapping()
1956 	kfree(mapping);  in release_iommu_mapping()
1959 static int extend_iommu_mapping(struct dma_iommu_mapping *mapping)  in extend_iommu_mapping()  argument
1963 	if (mapping->nr_bitmaps >= mapping->extensions)  in extend_iommu_mapping()
1966 	next_bitmap = mapping->nr_bitmaps;  in extend_iommu_mapping()
1967 	mapping->bitmaps[next_bitmap] = kzalloc(mapping->bitmap_size,  in extend_iommu_mapping()
1969 	if (!mapping->bitmaps[next_bitmap])  in extend_iommu_mapping()
1972 	mapping->nr_bitmaps++;  in extend_iommu_mapping()
1977 void arm_iommu_release_mapping(struct dma_iommu_mapping *mapping)  in arm_iommu_release_mapping()  argument
1979 	if (mapping)  in arm_iommu_release_mapping()
1980 		kref_put(&mapping->kref, release_iommu_mapping);  in arm_iommu_release_mapping()
1985 				     struct dma_iommu_mapping *mapping)  in __arm_iommu_attach_device()  argument
1989 	err = iommu_attach_device(mapping->domain, dev);  in __arm_iommu_attach_device()
1993 	kref_get(&mapping->kref);  in __arm_iommu_attach_device()
1994 	to_dma_iommu_mapping(dev) = mapping;  in __arm_iommu_attach_device()
2014 			    struct dma_iommu_mapping *mapping)  in arm_iommu_attach_device()  argument
2018 	err = __arm_iommu_attach_device(dev, mapping);  in arm_iommu_attach_device()
2029 	struct dma_iommu_mapping *mapping;  in __arm_iommu_detach_device()  local
2031 	mapping = to_dma_iommu_mapping(dev);  in __arm_iommu_detach_device()
2032 	if (!mapping) {  in __arm_iommu_detach_device()
2037 	iommu_detach_device(mapping->domain, dev);  in __arm_iommu_detach_device()
2038 	kref_put(&mapping->kref, release_iommu_mapping);  in __arm_iommu_detach_device()
2066 	struct dma_iommu_mapping *mapping;  in arm_setup_iommu_dma_ops()  local
2071 	mapping = arm_iommu_create_mapping(dev->bus, dma_base, size);  in arm_setup_iommu_dma_ops()
2072 	if (IS_ERR(mapping)) {  in arm_setup_iommu_dma_ops()
2078 	if (__arm_iommu_attach_device(dev, mapping)) {  in arm_setup_iommu_dma_ops()
2081 		arm_iommu_release_mapping(mapping);  in arm_setup_iommu_dma_ops()
2090 	struct dma_iommu_mapping *mapping = to_dma_iommu_mapping(dev);  in arm_teardown_iommu_dma_ops()  local
2092 	if (!mapping)  in arm_teardown_iommu_dma_ops()
2096 	arm_iommu_release_mapping(mapping);  in arm_teardown_iommu_dma_ops()