@@ -144,6 +144,38 @@ static int uio_dmem_genirq_irqcontrol(struct uio_info *dev_info, s32 irq_on)
return 0;
}
+static int uio_dmem_genirq_mmap(struct uio_info *info,
+ struct vm_area_struct *vma) {
+ struct uio_dmem_genirq_platdata *priv = info->priv;
+ struct uio_mem *uiomem;
+ int dmem_region = priv->dmem_region_start;
+ int mi = vma->vm_pgoff;
+
+ if (priv->uioinfo->mem[mi].memtype != UIO_MEM_PHYS)
+ return -EINVAL;
+
+ if (mi < MAX_UIO_MAPS) {
+ uiomem = &priv->uioinfo->mem[mi];
+ if (!uiomem->size)
+ return -EINVAL;
+
+ if (mi < dmem_region) { /* phyiscal address */
+ vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
+ return remap_pfn_range(vma,
+ vma->vm_start,
+ uiomem->addr >> PAGE_SHIFT,
+ vma->vm_end - vma->vm_start,
+ vma->vm_page_prot);
+ } else { /* DMA address */
+ vma->vm_pgoff = 0;
+ return dma_mmap_coherent(&priv->pdev->dev, vma,
+ priv->dmem_region_vaddr[mi],
+ uiomem->addr, uiomem->size);
+ }
+ }
+ return -EINVAL;
+}
+
static int uio_dmem_genirq_probe(struct platform_device *pdev)
{
struct uio_dmem_genirq_pdata *pdata = pdev->dev.platform_data;
@@ -263,6 +295,7 @@ static int uio_dmem_genirq_probe(struct platform_device *pdev)
uioinfo->irqcontrol = uio_dmem_genirq_irqcontrol;
uioinfo->open = uio_dmem_genirq_open;
uioinfo->release = uio_dmem_genirq_release;
+ uioinfo->mmap = uio_dmem_genirq_mmap;
uioinfo->priv = priv;
/* Enable Runtime PM for this device:
Dynamic regions allocated with dma_alloc_coherent() should use dma_mmap_coherent() to perform memory mapping. Other regions are simply ioremapped, the same way as in the uio subsystem base implementation. Signed-off-by: Damian Hobson-Garcia <dhobsong@igel.co.jp> --- drivers/uio/uio_dmem_genirq.c | 33 +++++++++++++++++++++++++++++++++ 1 files changed, 33 insertions(+), 0 deletions(-)