misc: fastrpc: consider address offset before sending to DSP

While passing address phy address to DSP, take care of the offset
calculated from virtual address vma.

Fixes: c68cfb718c8f ("misc: fastrpc: Add support for context Invoke method")
Signed-off-by: Srinivas Kandagatla <srinivas.kandagatla@linaro.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>

diff --git a/drivers/misc/fastrpc.c b/drivers/misc/fastrpc.c
index 8e43f3d..5440735 100644 (file)
--- a/drivers/misc/fastrpc.c
+++ b/drivers/misc/fastrpc.c
@@ -679,8 +679,16 @@ static int fastrpc_get_args(u32 kernel, struct fastrpc_invoke_ctx *ctx)
                pages[i].size = roundup(len, PAGE_SIZE);
 
                if (ctx->maps[i]) {
+                       struct vm_area_struct *vma = NULL;
+
                        rpra[i].pv = (u64) ctx->args[i].ptr;
                        pages[i].addr = ctx->maps[i]->phys;
+
+                       vma = find_vma(current->mm, ctx->args[i].ptr);
+                       if (vma)
+                               pages[i].addr += ctx->args[i].ptr -
+                                                vma->vm_start;
+
                } else {
                        rlen -= ALIGN(args, FASTRPC_ALIGN) - args;
                        args = ALIGN(args, FASTRPC_ALIGN);