X-Git-Url: https://git.saurik.com/apple/xnu.git/blobdiff_plain/e5568f75972dfc723778653c11cb6b4dc825716a..4a3eedf9ecc9bbe3f3a5c6ce5e53ad199d639d32:/osfmk/ppc/Firmware.s

diff --git a/osfmk/ppc/Firmware.s b/osfmk/ppc/Firmware.s
index cbdb30cff..d5f687f34 100644
--- a/osfmk/ppc/Firmware.s
+++ b/osfmk/ppc/Firmware.s
@@ -1,23 +1,29 @@
 /*
- * Copyright (c) 2000 Apple Computer, Inc. All rights reserved.
+ * Copyright (c) 2000-2005 Apple Computer, Inc. All rights reserved.
  *
- * @APPLE_LICENSE_HEADER_START@
+ * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
  * 
- * The contents of this file constitute Original Code as defined in and
- * are subject to the Apple Public Source License Version 1.1 (the
- * "License").  You may not use this file except in compliance with the
- * License.  Please obtain a copy of the License at
- * http://www.apple.com/publicsource and read it before using this file.
+ * 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
+ * compliance with the License. The rights granted to you under the License
+ * may not be used to create, or enable the creation or redistribution of,
+ * 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.
  * 
- * This Original Code and all software distributed under the License are
- * distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY KIND, EITHER
+ * 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,
  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
- * FITNESS FOR A PARTICULAR PURPOSE OR NON-INFRINGEMENT.  Please see the
- * License for the specific language governing rights and limitations
- * under the License.
+ * 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_LICENSE_HEADER_END@
+ * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
  */
 /*
  * @OSF_FREE_COPYRIGHT@
@@ -36,7 +42,6 @@
 
 */
 
-#include <cpus.h>
 #include <ppc/asm.h>
 #include <ppc/proc_reg.h>
 #include <ppc/spec_reg.h>
@@ -333,6 +338,7 @@ LEXT(xLoadIBATsLL)
 
 /*
  *			This is the glue to call the CutTrace firmware call
+ *			dbgTrace(id, p1, p2, p3, p4)
  */
  			
 			.align	5
@@ -340,8 +346,13 @@ LEXT(xLoadIBATsLL)
 
 LEXT(dbgTrace)
 			
+			mr		r2,r3
+			mr		r3,r4
 			lis		r0,HIGH_ADDR(CutTrace)			/* Top half of CreateFakeIO firmware call number */
+			mr		r4,r5
+			mr		r5,r6
 			ori		r0,r0,LOW_ADDR(CutTrace)		/* Bottom half */
+			mr		r6,r7
 			sc										/* Do it to it */
 			blr										/* Bye bye, Birdie... */
 
@@ -2174,9 +2185,11 @@ LEXT(stSpecrs)
 			ori		r2,r2,lo16(MASK(MSR_FP))		; Get the FP enable 
 			ori		r4,r4,lo16(MASK(MSR_EE))		; Get the EE bit
 
+ 			mfsprg	r9,2							; Get feature flags 
+			mtcrf	0x02,r9							; move pf64Bit cr6
 
-			mfmsr	r0					; Save the MSR
-			andc	r0,r0,r2			; Turn of VEC and FP
+			mfmsr	r0								; Save the MSR
+			andc	r0,r0,r2						; Turn off VEC and FP
 			andc	r4,r0,r4			; And EE
 			mtmsr	r4
 			isync
@@ -2185,6 +2198,8 @@ LEXT(stSpecrs)
 			stw		r12,4(r3)
 			rlwinm	r12,r12,16,16,31
 
+			bt++	pf64Bitb,stsSF1					; skip if 64-bit (only they take the hint)
+
 			mfdbatu	r4,0
 			mfdbatl	r5,0
 			mfdbatu	r6,1
@@ -2305,6 +2320,44 @@ nnmax:		stw		r4,(48*4)(r3)
 
 			blr
 
+stsSF1:		mfsprg	r4,0
+			mfsprg	r5,1
+			mfsprg	r6,2
+			mfsprg	r7,3
+			std		r4,(18*4)(r3)
+			std		r5,(20*4)(r3)
+			std		r6,(22*4)(r3)
+			std		r7,(24*4)(r3)
+			
+			mfsdr1	r4
+			std		r4,(26*4)(r3)
+
+			mfspr	r4,hid0
+			std		r4,(28*4)(r3)
+			mfspr	r4,hid1
+			std		r4,(30*4)(r3)
+			mfspr	r4,hid4
+			std		r4,(32*4)(r3)
+			mfspr	r4,hid5
+			std		r4,(34*4)(r3)
+
+
+stsSF2:		li		r5,0
+			la		r4,(80*4)(r3)
+			
+stsslbm:	slbmfee	r6,r5
+			slbmfev	r7,r5
+			std		r6,0(r4)
+			std		r7,8(r4)
+			addi	r5,r5,1
+			cmplwi	r5,64
+			addi	r4,r4,16
+			blt		stsslbm
+			
+			mtmsr	r0
+			isync
+
+			blr
 
 ;
 ;			fwEmMck - this forces the hardware to emulate machine checks