[PATCH 5/8] misc: fastrpc: consider address offset before sending to DSP

[Srinivas Kandagatla]

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.kandaga...@linaro.org>
---
 drivers/misc/fastrpc.c | 8 ++++++++
 1 file changed, 8 insertions(+)

diff --git a/drivers/misc/fastrpc.c b/drivers/misc/fastrpc.c
index f71b5faae1dd..209f3e63f660 100644
--- 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);
-- 
2.21.0