X-Git-Url: https://git.saurik.com/apple/xnu.git/blobdiff_plain/b0d623f7f2ae71ed96e60569f61f9a9a27016e80..c6bf4f310a33a9262d455ea4d3f0630b1255e3fe:/osfmk/i386/hibernate_restore.c

diff --git a/osfmk/i386/hibernate_restore.c b/osfmk/i386/hibernate_restore.c
index c1dfd4e16..f8b0bb195 100644
--- a/osfmk/i386/hibernate_restore.c
+++ b/osfmk/i386/hibernate_restore.c
@@ -2,7 +2,7 @@
  * Copyright (c) 2008 Apple Inc. All rights reserved.
  *
  * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
- * 
+ *
  * This file contains Original Code and/or Modifications of Original Code
  * as defined in and that are subject to the Apple Public Source License
  * Version 2.0 (the 'License'). You may not use this file except in
@@ -11,10 +11,10 @@
  * unlawful or unlicensed copies of an Apple operating system, or to
  * circumvent, violate, or enable the circumvention or violation of, any
  * terms of an Apple operating system software license agreement.
- * 
+ *
  * Please obtain a copy of the License at
  * http://www.opensource.apple.com/apsl/ and read it before using this file.
- * 
+ *
  * The Original Code and all software distributed under the License are
  * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
  * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
@@ -22,53 +22,87 @@
  * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
  * Please see the License for the specific language governing rights and
  * limitations under the License.
- * 
+ *
  * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
  */
 #include <i386/pmap.h>
 #include <i386/proc_reg.h>
 #include <IOKit/IOHibernatePrivate.h>
 
-extern pd_entry_t BootstrapPTD[2048];
+#include <i386/pal_hibernate.h>
 
-#define TWO_MEG_MASK 0xFFFFFFFFFFE00000ULL
+extern pd_entry_t BootPTD[2048];
 
-#define DST_INDEX 2047UL
-
-static char *dstPtr = (char *)(DST_INDEX << PDSHIFT);
-
-// src is virtually mapped, not page aligned, 
+// 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;
 	uint64_t * d;
 	uint64_t * s;
-	uint32_t idx;
-
-	if (src == 0)
-		return;
 
-	if (dst < (uint64_t) (uintptr_t)dstPtr)
-	{
-		d = (uint64_t *) (uintptr_t)dst;
+	if (src == 0) {
+		return (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];
+
+	__nosan_memcpy(d, s, len);
+
+	return (uintptr_t)d;
+}
+#undef hibprintf
+
+void hibprintf(const char *fmt, ...);
+
+uintptr_t
+pal_hib_map(uintptr_t virt, uint64_t phys)
+{
+	uintptr_t index;
+
+	switch (virt) {
+	case DEST_COPY_AREA:
+	case SRC_COPY_AREA:
+	case COPY_PAGE_AREA:
+	case BITMAP_AREA:
+	case IMAGE_AREA:
+	case IMAGE2_AREA:
+		break;
+
+	default:
+		asm("cli;hlt;");
+		break;
+	}
+	if (phys < IMAGE2_AREA) {
+		// first 4Gb is all mapped,
+		// and do not expect source areas to cross 4Gb
+		return phys;
+	}
+	index = (virt >> I386_LPGSHIFT);
+	virt += (uintptr_t)(phys & I386_LPGMASK);
+	phys  = ((phys & ~((uint64_t)I386_LPGMASK)) | INTEL_PTE_PS  | INTEL_PTE_VALID | INTEL_PTE_WRITE);
+	if (phys == BootPTD[index]) {
+		return virt;
+	}
+	BootPTD[index] = phys;
+	invlpg(virt);
+	BootPTD[index + 1] = (phys + I386_LPGBYTES);
+	invlpg(virt + I386_LPGBYTES);
+
+	return virt;
+}
+
+void
+hibernateRestorePALState(uint32_t *arg)
+{
+	(void)arg;
+}
+
+void
+pal_hib_patchup(void)
+{
 }