|
@@ -236,18 +236,11 @@ static void tce_iommu_release(void *iommu_data)
|
|
|
}
|
|
|
|
|
|
static void tce_iommu_unuse_page(struct tce_container *container,
|
|
|
- unsigned long oldtce)
|
|
|
+ unsigned long hpa)
|
|
|
{
|
|
|
struct page *page;
|
|
|
|
|
|
- if (!(oldtce & (TCE_PCI_READ | TCE_PCI_WRITE)))
|
|
|
- return;
|
|
|
-
|
|
|
- page = pfn_to_page(oldtce >> PAGE_SHIFT);
|
|
|
-
|
|
|
- if (oldtce & TCE_PCI_WRITE)
|
|
|
- SetPageDirty(page);
|
|
|
-
|
|
|
+ page = pfn_to_page(hpa >> PAGE_SHIFT);
|
|
|
put_page(page);
|
|
|
}
|
|
|
|
|
@@ -255,14 +248,21 @@ static int tce_iommu_clear(struct tce_container *container,
|
|
|
struct iommu_table *tbl,
|
|
|
unsigned long entry, unsigned long pages)
|
|
|
{
|
|
|
- unsigned long oldtce;
|
|
|
+ unsigned long oldhpa;
|
|
|
+ long ret;
|
|
|
+ enum dma_data_direction direction;
|
|
|
|
|
|
for ( ; pages; --pages, ++entry) {
|
|
|
- oldtce = iommu_clear_tce(tbl, entry);
|
|
|
- if (!oldtce)
|
|
|
+ direction = DMA_NONE;
|
|
|
+ oldhpa = 0;
|
|
|
+ ret = iommu_tce_xchg(tbl, entry, &oldhpa, &direction);
|
|
|
+ if (ret)
|
|
|
+ continue;
|
|
|
+
|
|
|
+ if (direction == DMA_NONE)
|
|
|
continue;
|
|
|
|
|
|
- tce_iommu_unuse_page(container, oldtce);
|
|
|
+ tce_iommu_unuse_page(container, oldhpa);
|
|
|
}
|
|
|
|
|
|
return 0;
|
|
@@ -284,12 +284,13 @@ static int tce_iommu_use_page(unsigned long tce, unsigned long *hpa)
|
|
|
|
|
|
static long tce_iommu_build(struct tce_container *container,
|
|
|
struct iommu_table *tbl,
|
|
|
- unsigned long entry, unsigned long tce, unsigned long pages)
|
|
|
+ unsigned long entry, unsigned long tce, unsigned long pages,
|
|
|
+ enum dma_data_direction direction)
|
|
|
{
|
|
|
long i, ret = 0;
|
|
|
struct page *page;
|
|
|
unsigned long hpa;
|
|
|
- enum dma_data_direction direction = iommu_tce_direction(tce);
|
|
|
+ enum dma_data_direction dirtmp;
|
|
|
|
|
|
for (i = 0; i < pages; ++i) {
|
|
|
unsigned long offset = tce & IOMMU_PAGE_MASK(tbl) & ~PAGE_MASK;
|
|
@@ -305,8 +306,8 @@ static long tce_iommu_build(struct tce_container *container,
|
|
|
}
|
|
|
|
|
|
hpa |= offset;
|
|
|
- ret = iommu_tce_build(tbl, entry + i, (unsigned long) __va(hpa),
|
|
|
- direction);
|
|
|
+ dirtmp = direction;
|
|
|
+ ret = iommu_tce_xchg(tbl, entry + i, &hpa, &dirtmp);
|
|
|
if (ret) {
|
|
|
tce_iommu_unuse_page(container, hpa);
|
|
|
pr_err("iommu_tce: %s failed ioba=%lx, tce=%lx, ret=%ld\n",
|
|
@@ -314,6 +315,10 @@ static long tce_iommu_build(struct tce_container *container,
|
|
|
tce, ret);
|
|
|
break;
|
|
|
}
|
|
|
+
|
|
|
+ if (dirtmp != DMA_NONE)
|
|
|
+ tce_iommu_unuse_page(container, hpa);
|
|
|
+
|
|
|
tce += IOMMU_PAGE_SIZE(tbl);
|
|
|
}
|
|
|
|
|
@@ -378,8 +383,8 @@ static long tce_iommu_ioctl(void *iommu_data,
|
|
|
case VFIO_IOMMU_MAP_DMA: {
|
|
|
struct vfio_iommu_type1_dma_map param;
|
|
|
struct iommu_table *tbl = NULL;
|
|
|
- unsigned long tce;
|
|
|
long num;
|
|
|
+ enum dma_data_direction direction;
|
|
|
|
|
|
if (!container->enabled)
|
|
|
return -EPERM;
|
|
@@ -405,19 +410,27 @@ static long tce_iommu_ioctl(void *iommu_data,
|
|
|
return -EINVAL;
|
|
|
|
|
|
/* iova is checked by the IOMMU API */
|
|
|
- tce = param.vaddr;
|
|
|
- if (param.flags & VFIO_DMA_MAP_FLAG_READ)
|
|
|
- tce |= TCE_PCI_READ;
|
|
|
- if (param.flags & VFIO_DMA_MAP_FLAG_WRITE)
|
|
|
- tce |= TCE_PCI_WRITE;
|
|
|
+ if (param.flags & VFIO_DMA_MAP_FLAG_READ) {
|
|
|
+ if (param.flags & VFIO_DMA_MAP_FLAG_WRITE)
|
|
|
+ direction = DMA_BIDIRECTIONAL;
|
|
|
+ else
|
|
|
+ direction = DMA_TO_DEVICE;
|
|
|
+ } else {
|
|
|
+ if (param.flags & VFIO_DMA_MAP_FLAG_WRITE)
|
|
|
+ direction = DMA_FROM_DEVICE;
|
|
|
+ else
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
|
|
|
- ret = iommu_tce_put_param_check(tbl, param.iova, tce);
|
|
|
+ ret = iommu_tce_put_param_check(tbl, param.iova, param.vaddr);
|
|
|
if (ret)
|
|
|
return ret;
|
|
|
|
|
|
ret = tce_iommu_build(container, tbl,
|
|
|
param.iova >> tbl->it_page_shift,
|
|
|
- tce, param.size >> tbl->it_page_shift);
|
|
|
+ param.vaddr,
|
|
|
+ param.size >> tbl->it_page_shift,
|
|
|
+ direction);
|
|
|
|
|
|
iommu_flush_tce(tbl);
|
|
|
|