map virtual address to physical address in kernel

Change-Id: Id18e604facd517598a18968af3dff927026ad894
Reviewed-on: http://gfw160.austin.ibm.com:8080/gerrit/272
Tested-by: Jenkins Server
Reviewed-by: A. Patrick Williams III <iawillia@us.ibm.com>
Reviewed-by: Daniel M. Crowell <dcrowell@us.ibm.com>

1 files changed, 22 insertions, 0 deletions

diff --git a/src/kernel/block.C b/src/kernel/block.C
index 19d2962f8..9a38ba3b0 100644
--- a/src/kernel/block.C
+++ b/src/kernel/block.C
@@ -23,6 +23,7 @@
 #include <limits.h>
 #include <assert.h>
 #include <string.h>
+#include <errno.h>
 
 #include <sys/msg.h>
 
@@ -184,3 +185,24 @@ void Block::addPTE(void* i_vaddr)
                       (l_pte->isWritable() ? VmmManager::NORMAL_ACCESS :
                        VmmManager::READ_O_ACCESS)));
 }
+
+uint64_t Block::findPhysicalAddress(uint64_t i_vaddr) const
+{
+    uint64_t paddr = -EFAULT;
+
+    if(!isContained(i_vaddr))
+    {
+        return (iv_nextBlock ?
+                iv_nextBlock->findPhysicalAddress(i_vaddr) : paddr);
+    }
+
+    ShadowPTE* pte = getPTE(i_vaddr);
+
+    if (pte->isPresent() && pte->getPage() != 0)
+    {
+        paddr = pte->getPageAddr();
+        paddr += i_vaddr % PAGESIZE;
+    }
+
+    return paddr;
+}