xnu-1699.22.73.tar.gz

[apple/xnu.git] / osfmk / i386 / hibernate_restore.c

diff --git a/osfmk/i386/hibernate_restore.c b/osfmk/i386/hibernate_restore.c
index c1dfd4e162f6f95c94e4fb947416967779c22051..bf0508a69f05b43348f6d6c6449af42acecf6c43 100644 (file)
--- a/osfmk/i386/hibernate_restore.c
+++ b/osfmk/i386/hibernate_restore.c
@@ -29,19 +29,18 @@
 #include <i386/proc_reg.h>
 #include <IOKit/IOHibernatePrivate.h>
 
+#include <i386/pal_hibernate.h>
+
 extern pd_entry_t BootstrapPTD[2048];
 
 #define TWO_MEG_MASK 0xFFFFFFFFFFE00000ULL
-
-#define DST_INDEX 2047UL
-
-static char *dstPtr = (char *)(DST_INDEX << PDSHIFT);
+#define FOUR_K_MASK 0xFFFFFFFFFFFFF000ULL
 
 // src is virtually mapped, not page aligned, 
 // dst is a physical 4k page aligned ptr, len is one 4K page
 // src & dst will not overlap
 
-void 
+uintptr_t 
 hibernate_restore_phys_page(uint64_t src, uint64_t dst, uint32_t len, uint32_t procFlags)
 {
        (void)procFlags;
@@ -50,25 +49,78 @@ hibernate_restore_phys_page(uint64_t src, uint64_t dst, uint32_t len, uint32_t p
        uint32_t idx;
 
        if (src == 0)
-               return;
+               return (uintptr_t)dst;
 
-       if (dst < (uint64_t) (uintptr_t)dstPtr)
-       {
-               d = (uint64_t *) (uintptr_t)dst;
-       }
-       else
-       {
-               /* Outside 1-1 4G map so set up the mappings for the dest page using 2MB pages */
-               BootstrapPTD[DST_INDEX] = (dst & TWO_MEG_MASK) | INTEL_PTE_PS | INTEL_PTE_VALID | INTEL_PTE_WRITE | INTEL_PTE_WRITE;
-               
-               /* Invalidate the page tables for this */
-               invlpg((uintptr_t) dstPtr);
-
-               /* Mask off the offset from the 2MB window */
-               dst &= ~TWO_MEG_MASK;
-               d = (uint64_t *) (dstPtr + dst);
-       }
+       d = (uint64_t *)pal_hib_map(DEST_COPY_AREA, dst);
        s = (uint64_t *) (uintptr_t)src;
+
        for (idx = 0; idx < (len / (uint32_t)sizeof(uint64_t)); idx++) 
                d[idx] = s[idx];
+
+       return (uintptr_t)d;
+}
+#undef hibprintf
+
+void hibprintf(const char *fmt, ...);
+
+void
+pal_hib_window_setup(ppnum_t page)
+{
+       uint64_t *pp;
+       uint64_t phys = ptoa_64(page);
+       int i;
+
+       BootstrapPTD[2047] = (phys & ~((uint64_t)I386_LPGMASK)) | INTEL_PTE_PS  | INTEL_PTE_VALID | INTEL_PTE_WRITE;
+
+       invlpg(HIB_PTES);
+
+       pp = (uint64_t *)(uintptr_t)(HIB_PTES + (phys & I386_LPGMASK));
+
+       for(i=0;i<512;i++)
+               *pp = 0;
+
+       pp[0] = phys | INTEL_PTE_VALID | INTEL_PTE_WRITE;
+       BootstrapPTD[2047] = phys | INTEL_PTE_VALID | INTEL_PTE_WRITE;
+
+       invlpg(HIB_PTES);
+}
+
+uintptr_t
+pal_hib_map(uintptr_t v, uint64_t p)
+{
+       int index;
+
+       switch(v) {
+               case DEST_COPY_AREA:
+                       index = 1;
+                       break;
+               case SRC_COPY_AREA:
+                       index = 2;
+                       break;
+               case COPY_PAGE_AREA:
+                       index = 3;
+                       break;
+               default:
+                       index = -1;
+                       asm("cli;hlt;");
+       }
+
+       uint64_t *ptes = (uint64_t *)HIB_PTES;
+
+       /* Outside 1-1 4G map so set up the mappings for the dest page using 2MB pages */
+       ptes[index] = (p & FOUR_K_MASK) | INTEL_PTE_VALID | INTEL_PTE_WRITE;
+               
+       /* Invalidate the page tables for this */
+       invlpg((uintptr_t)v);
+
+       return v;
+}
+
+void hibernateRestorePALState(uint32_t *arg)
+{
+       (void)arg;
+}
+void
+pal_hib_patchup(void)
+{
 }