Hcode: hcode changes for STOP exit in SMF enabled HV mode

Commit addresses STOP exit issue in HV mode with SMF enabled
from hcode perspective. Self-save restore binary is fixed to
so that on STOP exit core enters linux in HV mode with
SMFCTRL[E] bit SET.

Change-Id: I8f1c9ab5181786a39efd53453e02e16295a87b36
Reviewed-on: http://rchgit01.rchland.ibm.com/gerrit1/87552
Tested-by: Jenkins Server <pfd-jenkins+hostboot@us.ibm.com>
Tested-by: FSP CI Jenkins <fsp-CI-jenkins+hostboot@us.ibm.com>
Reviewed-by: YUE DU <daviddu@us.ibm.com>
Reviewed-by: Gregory S Still <stillgs@us.ibm.com>
Reviewed-by: Jennifer A Stofer <stofer@us.ibm.com>

5 files changed, 195 insertions, 101 deletions

diff --git a/import/chips/p9/procedures/ppe_closed/cme/stop_cme/p9_cme_stop_exit.c b/import/chips/p9/procedures/ppe_closed/cme/stop_cme/p9_cme_stop_exit.c
index e16f4fc8..aa11dc6a 100644
--- a/import/chips/p9/procedures/ppe_closed/cme/stop_cme/p9_cme_stop_exit.c
+++ b/import/chips/p9/procedures/ppe_closed/cme/stop_cme/p9_cme_stop_exit.c
@@ -5,7 +5,7 @@
 /*                                                                        */
 /* OpenPOWER HCODE Project                                                */
 /*                                                                        */
-/* COPYRIGHT 2015,2019                                                    */
+/* COPYRIGHT 2015,2020                                                    */
 /* [+] International Business Machines Corp.                              */
 /*                                                                        */
 /*                                                                        */
@@ -1162,6 +1162,8 @@ p9_cme_stop_self_execute(uint32_t core, uint32_t i_saveRestore )
 {
     uint32_t core_mask;
     data64_t scom_data;
+    data64_t stop_exit_privilege;
+    stop_exit_privilege.value = 0;
     cmeHeader_t* pCmeImgHdr = (cmeHeader_t*)(CME_SRAM_HEADER_ADDR);
     scom_data.value = pCmeImgHdr->g_cme_cpmr_PhyAddr & BITS64(13, 30); //HRMOR[13:42]
 
@@ -1254,11 +1256,8 @@ p9_cme_stop_self_execute(uint32_t core, uint32_t i_saveRestore )
     PK_TRACE_INF("SMF core wakes up, write URMOR with HOMER address" );
     scom_data.words.upper =  scom_data.words.upper & ~BIT32(15);
 
-    if( SPR_SELF_SAVE == i_saveRestore )
-    {
-        scom_data.value = pCmeImgHdr->g_cme_unsec_cpmr_PhyAddr & BITS64(13, 30); //Unsecure HOMER
-        PKTRACE("SMF core self save, write un-secure HOMER address");
-    }
+    scom_data.value = pCmeImgHdr->g_cme_unsec_cpmr_PhyAddr & BITS64(13, 30); //Unsecure HOMER
+    PKTRACE("SMF core self save, write un-secure HOMER address");
 
     CME_PUTSCOM(HRMOR, core, scom_data.value);
 
@@ -1305,33 +1304,37 @@ p9_cme_stop_self_execute(uint32_t core, uint32_t i_saveRestore )
             {
                 //Writing thread scratch register to
                 //Signal Self Save Restore code for save operation.
-                scom_data.words.upper     =   0;
-                scom_data.words.lower     =   1;
+                stop_exit_privilege.words.upper     =   0;
+                stop_exit_privilege.words.lower     =   1;
             }
             else
             {
                 //Writing thread scratch register to
                 // 1. Init Runtime wakeup mode for core.
-                // 2. Signal Self Save Restore code for restore operation.
+                // 2. HV Exit with SMF enable or Disable
+                // 3. Signal Self Save Restore code for restore operation.
+
 
                 if (scom_data.words.upper & BIT32(3))
                 {
-                    scom_data.value = BIT64(59);
+                    stop_exit_privilege.value = BIT64(59);
                 }
-                else
+
+                if (scom_data.words.upper &  BIT32(4))
                 {
-                    scom_data.value = 0;
+                    stop_exit_privilege.value |= BIT64(58);
                 }
+
             }
 
             if( CME_MASK_C0 & core_mask )
             {
-                CME_PUTSCOM(SCRATCH0, CME_MASK_C0, scom_data.value);
+                CME_PUTSCOM(SCRATCH0, CME_MASK_C0, stop_exit_privilege.value);
             }
 
             if( CME_MASK_C1 & core_mask )
             {
-                CME_PUTSCOM(SCRATCH1, CME_MASK_C1, scom_data.value);
+                CME_PUTSCOM(SCRATCH1, CME_MASK_C1, stop_exit_privilege.value);
             }
         }
     }
diff --git a/import/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.S b/import/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.S
index 1a74447a..53ba77da 100755
--- a/import/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.S
+++ b/import/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.S
@@ -156,6 +156,8 @@
                 .set SMFCTRL_ENABLE_BIT,            0
                 .set MSR_SECURITY_BIT,              41
                 .set SCRATCH_RUNTIME_MODE_BIT,      59
+                .set HV_EXIT_WITH_SMF_ENABLE_BIT,   58  #0 : HV exit with SMFCTRL[E] bit SET to 0b01
+                                                        #1 : HV exit with SMFCTRL[E] bit SET to 0b00
 
                 .set OTHER_THREADS_STOPPED,         0x07
                 .set CORE_THREAD_STATE_REG_ID,      0x01E0
@@ -178,6 +180,8 @@
                 .set RFID,                          0x2400004c
                 .set TRAP_LE,                       0x0800e07f
                 .set MFMSR_R21,                     0xa600a07e
+                .set OFFSET_SMF_EN_SLAVE_THREADS,   0x04
+                .set SECURE_ADDR_BIT,               0x0f
 
 
                 .set SPR_SAVE_SCRATCH_REG,          r0
@@ -759,25 +763,54 @@ mtsrr1      TEMP_REG2
 mfspr       TEMP_REG2,      HSRR1
 insrdi      TEMP_REG2,      TEMP_REG1,  1,  MSR_SECURITY_BIT
 mtspr       HSRR1,          TEMP_REG2
-mfspr       SMF_VAL_REG,    SMFCTRL
-insrdi      SMF_VAL_REG,    TEMP_REG1,  1,  SMFCTRL_ENABLE_BIT
 insrdi      MSR_INIT_REG,   TEMP_REG1,  1,  MSR_SECURITY_BIT
 
-addi        TEMP_REG1,      RMOR_INIT_REG,  HRMOR_RESTORE_OFFSET
+extrdi.     TEMP_REG2,      THREAD_SCRATCH_VAL_REG,  1,  HV_EXIT_WITH_SMF_ENABLE_BIT
+beq         wakeup_hv_smf_enable_mode
+
+wakeup_hv_smf_disable_mode:
+insrdi      SMF_VAL_REG,    TEMP_REG1,  1,  SMFCTRL_ENABLE_BIT
+mtspr       SMFCTRL,        SMF_VAL_REG #SMFCTRL[E] is cleared
+
+#In this case HOMER is expected in regular unsecure region.
+li          TEMP_REG2,      HRMOR_RESTORE_OFFSET
+cmplwi      THREAD_ID_REG,  0
+bne         update_usrrx
+addi        TEMP_REG2,      TEMP_REG2, SKIP_HRMOR_UPDATE_OFFSET  # branch where slave threads STOPs
+b update_usrrx
+
+wakeup_hv_smf_enable_mode:
+mfspr       TEMP_REG2,  URMOR  #Check if  Un-Secure HOMER location
+extrdi.     TEMP_REG1, TEMP_REG2, 1, SECURE_ADDR_BIT
+cmplwi      TEMP_REG1,  0
+beq         ipl_stop_exit
+
+runtime_stop_exit:
+mfspr       TEMP_REG2,  HRMOR  #Get Un-Secure HOMER location
+ori         TEMP_REG2,  TEMP_REG2,  0x200 #Exit Routine Offset
+mtspr       HRMOR,      TEMP_REG2
+b hrmor_restore_hv
+
+#In an SMF enabled system, for compatbility reasons, during IPL HOMER is built in regular memory
+#and gets moved to secure memory later during HOMER rebuild pahse. However, in istep 16 cores exits STOP
+#in UV mode. Code below support HV exit just in case it is useful.
+
+ipl_stop_exit:
+li           TEMP_REG2, HRMOR_RESTORE_OFFSET
+
+hrmor_restore_hv:
+
 cmplwi      THREAD_ID_REG,  0
 beq         update_usrrx
-addi        TEMP_REG1,      TEMP_REG1, SKIP_HRMOR_UPDATE_OFFSET # restore HRMOR only if thread0
+addi        TEMP_REG2,      TEMP_REG2, OFFSET_SMF_EN_SLAVE_THREADS  # branch where slave threads STOPs
 
 update_usrrx:
-mtspr       USRR0,          TEMP_REG1
-mtspr       USRR1,          MSR_INIT_REG
-cmpwi       THREAD_ID_REG,  0
-bne         exit_to_thread_stop
+mtspr       USRR0,     TEMP_REG2
+mtspr       USRR1,     MSR_INIT_REG
+mtspr       SRR1,      MSR_INIT_REG
 
 #------------------------------ Trampoline Sequence Start -------------------------------
 
-mtspr       SMFCTRL,        SMF_VAL_REG  #SMFCTRL[E] = 0b0 for HV exit and 0b1 for UV exit
-
 exit_to_thread_stop:
 isync
 .long urfid
@@ -810,6 +843,7 @@ mtspr       USRR1,          MSR_INIT_REG
 .long       urfid
 .long       ATTN
 
+
 # THREAD_LAUNCHER_SIZE_OFFSET must be >= (4 * number of instructions between
 # here and thread_launcher_start)
 
diff --git a/import/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.s b/import/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.s
index cba7fa81..b3102903 100644
--- a/import/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.s
+++ b/import/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.s
@@ -22,10 +22,10 @@
 # permissions and limitations under the License.
 #
 # IBM_PROLOG_END_TAG
-# 1 "/esw/san2/premjha2/ekbTest/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.S"
+# 1 "/esw/san2/premjha2/ekbTest/p9_ekb/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.S"
 # 1 "<built-in>"
 # 1 "<command-line>"
-# 1 "/esw/san2/premjha2/ekbTest/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.S"
+# 1 "/esw/san2/premjha2/ekbTest/p9_ekb/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.S"
 
                 .set r0, 0
                 .set r1, 1
@@ -160,6 +160,8 @@
                 .set SMFCTRL_ENABLE_BIT, 0
                 .set MSR_SECURITY_BIT, 41
                 .set SCRATCH_RUNTIME_MODE_BIT, 59
+                .set HV_EXIT_WITH_SMF_ENABLE_BIT, 58 #0 : HV exit with SMFCTRL[E] bit SET to 0b01
+                                                        #1 : HV exit with SMFCTRL[E] bit SET to 0b00
 
                 .set OTHER_THREADS_STOPPED, 0x07
                 .set CORE_THREAD_STATE_REG_ID, 0x01E0
@@ -182,6 +184,8 @@
                 .set RFID, 0x2400004c
                 .set TRAP_LE, 0x0800e07f
                 .set MFMSR_R21, 0xa600a07e
+                .set OFFSET_SMF_EN_SLAVE_THREADS, 0x04
+                .set SECURE_ADDR_BIT, 0x0f
 
 
                 .set SPR_SAVE_SCRATCH_REG, r0
@@ -763,25 +767,54 @@ mtsrr1 TEMP_REG2
 mfspr TEMP_REG2, HSRR1
 insrdi TEMP_REG2, TEMP_REG1, 1, MSR_SECURITY_BIT
 mtspr HSRR1, TEMP_REG2
-mfspr SMF_VAL_REG, SMFCTRL
-insrdi SMF_VAL_REG, TEMP_REG1, 1, SMFCTRL_ENABLE_BIT
 insrdi MSR_INIT_REG, TEMP_REG1, 1, MSR_SECURITY_BIT
 
-addi TEMP_REG1, RMOR_INIT_REG, HRMOR_RESTORE_OFFSET
+extrdi. TEMP_REG2, THREAD_SCRATCH_VAL_REG, 1, HV_EXIT_WITH_SMF_ENABLE_BIT
+beq wakeup_hv_smf_enable_mode
+
+wakeup_hv_smf_disable_mode:
+insrdi SMF_VAL_REG, TEMP_REG1, 1, SMFCTRL_ENABLE_BIT
+mtspr SMFCTRL, SMF_VAL_REG #SMFCTRL[E] is cleared
+
+#In this case HOMER is expected in regular unsecure region.
+li TEMP_REG2, HRMOR_RESTORE_OFFSET
+cmplwi THREAD_ID_REG, 0
+bne update_usrrx
+addi TEMP_REG2, TEMP_REG2, SKIP_HRMOR_UPDATE_OFFSET # branch where slave threads STOPs
+b update_usrrx
+
+wakeup_hv_smf_enable_mode:
+mfspr TEMP_REG2, URMOR #Check if Un-Secure HOMER location
+extrdi. TEMP_REG1, TEMP_REG2, 1, SECURE_ADDR_BIT
+cmplwi TEMP_REG1, 0
+beq ipl_stop_exit
+
+runtime_stop_exit:
+mfspr TEMP_REG2, HRMOR #Get Un-Secure HOMER location
+ori TEMP_REG2, TEMP_REG2, 0x200 #Exit Routine Offset
+mtspr HRMOR, TEMP_REG2
+b hrmor_restore_hv
+
+#In an SMF enabled system, for compatbility reasons, during IPL HOMER is built in regular memory
+#and gets moved to secure memory later during HOMER rebuild pahse. However, in istep 16 cores exits STOP
+#in UV mode. Code below support HV exit just in case it is useful.
+
+ipl_stop_exit:
+li TEMP_REG2, HRMOR_RESTORE_OFFSET
+
+hrmor_restore_hv:
+
 cmplwi THREAD_ID_REG, 0
 beq update_usrrx
-addi TEMP_REG1, TEMP_REG1, SKIP_HRMOR_UPDATE_OFFSET # restore HRMOR only if thread0
+addi TEMP_REG2, TEMP_REG2, OFFSET_SMF_EN_SLAVE_THREADS # branch where slave threads STOPs
 
 update_usrrx:
-mtspr USRR0, TEMP_REG1
+mtspr USRR0, TEMP_REG2
 mtspr USRR1, MSR_INIT_REG
-cmpwi THREAD_ID_REG, 0
-bne exit_to_thread_stop
+mtspr SRR1, MSR_INIT_REG
 
 #------------------------------ Trampoline Sequence Start -------------------------------
 
-mtspr SMFCTRL, SMF_VAL_REG #SMFCTRL[E] = 0b0 for HV exit and 0b1 for UV exit
-
 exit_to_thread_stop:
 isync
 .long urfid
@@ -814,6 +847,7 @@ mtspr USRR1, MSR_INIT_REG
 .long urfid
 .long ATTN
 
+
 # THREAD_LAUNCHER_SIZE_OFFSET must be >= (4 * number of instructions between
 # here and thread_launcher_start)
 
diff --git a/import/chips/p9/procedures/utils/stopreg/selfRest.list b/import/chips/p9/procedures/utils/stopreg/selfRest.list
index 447385a1..0fca0a45 100644
--- a/import/chips/p9/procedures/utils/stopreg/selfRest.list
+++ b/import/chips/p9/procedures/utils/stopreg/selfRest.list
@@ -1,5 +1,5 @@
 
-/esw/san2/premjha2/ekbTest/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o:     file format elf64-powerpc
+/esw/san2/premjha2/ekbTest/p9_ekb/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o:     file format elf64-powerpc
 
 
 Disassembly of section .selfRestore:
@@ -190,7 +190,7 @@ Disassembly of section .selfRestore:
     209c:	3a 20 00 01 	li      r17,1
     20a0:	7e 48 88 38 	and     r8,r18,r17
     20a4:	2c 08 00 00 	cmpwi   r8,0
-    20a8:	40 82 00 e4 	bne     218c <find_self_save>
+    20a8:	40 82 01 18 	bne     21c0 <find_self_save>
 
 00000000000020ac <thread_restore_base>:
     20ac:	39 00 01 e0 	li      r8,480
@@ -214,9 +214,9 @@ Disassembly of section .selfRestore:
     20dc:	39 00 ff fe 	li      r8,-2
     20e0:	7e b5 40 39 	and.    r21,r21,r8
     20e4:	28 17 00 00 	cmplwi  r23,0
-    20e8:	41 82 00 64 	beq     214c <initiate_hv_compatibility_mode>
+    20e8:	41 82 00 98 	beq     2180 <initiate_hv_compatibility_mode>
     20ec:	7a 51 e7 e3 	rldicl. r17,r18,60,63
-    20f0:	41 82 00 7c 	beq     216c <initiate_urmor_restore>
+    20f0:	41 82 00 b0 	beq     21a0 <initiate_urmor_restore>
 
 00000000000020f4 <initiate_runtime_hv_wakeup>:
     20f4:	39 00 00 00 	li      r8,0
@@ -226,62 +226,85 @@ Disassembly of section .selfRestore:
     2104:	7e 3b 4a a6 	mfspr   r17,315
     2108:	79 11 b2 6c 	rldimi  r17,r8,22,41
     210c:	7e 3b 4b a6 	mtspr   315,r17
-    2110:	7e 1f 7a a6 	mfspr   r16,511
-    2114:	79 10 f8 0e 	rldimi  r16,r8,63,0
-    2118:	79 15 b2 6c 	rldimi  r21,r8,22,41
-    211c:	39 14 12 00 	addi    r8,r20,4608
-    2120:	28 06 00 00 	cmplwi  r6,0
-    2124:	41 82 00 08 	beq     212c <update_usrrx>
-    2128:	39 08 00 04 	addi    r8,r8,4
-
-000000000000212c <update_usrrx>:
-    212c:	7d 1a 7b a6 	mtspr   506,r8
-    2130:	7e bb 7b a6 	mtspr   507,r21
-    2134:	2c 06 00 00 	cmpwi   r6,0
-    2138:	40 82 00 08 	bne     2140 <exit_to_thread_stop>
-    213c:	7e 1f 7b a6 	mtspr   511,r16
-
-0000000000002140 <exit_to_thread_stop>:
-    2140:	4c 00 01 2c 	isync
-    2144:	4c 00 02 64 	.long 0x4c000264
-    2148:	00 00 02 00 	attn
-
-000000000000214c <initiate_hv_compatibility_mode>:
-    214c:	39 14 12 00 	addi    r8,r20,4608
-    2150:	28 06 00 00 	cmplwi  r6,0
-    2154:	41 82 00 08 	beq     215c <update_srrx>
-    2158:	39 08 00 04 	addi    r8,r8,4
-
-000000000000215c <update_srrx>:
-    215c:	7d 1a 03 a6 	mtsrr0  r8
-    2160:	7e bb 03 a6 	mtsrr1  r21
-    2164:	4c 00 00 24 	rfid
-    2168:	00 00 02 00 	attn
-
-000000000000216c <initiate_urmor_restore>:
-    216c:	39 14 12 80 	addi    r8,r20,4736
-    2170:	28 06 00 00 	cmplwi  r6,0
-    2174:	41 82 00 08 	beq     217c <update_uv_exit>
-    2178:	39 08 00 08 	addi    r8,r8,8
-
-000000000000217c <update_uv_exit>:
-    217c:	7d 1a 7b a6 	mtspr   506,r8
-    2180:	7e bb 7b a6 	mtspr   507,r21
-    2184:	4c 00 02 64 	.long 0x4c000264
-    2188:	00 00 02 00 	attn
-
-000000000000218c <find_self_save>:
-    218c:	3b ed 00 08 	addi    r31,r13,8
-    2190:	7d c8 03 a6 	mtlr    r14
-    2194:	4e 80 00 21 	blrl
-    2198:	2c 06 00 00 	cmpwi   r6,0
-    219c:	40 82 f0 68 	bne     1204 <save_restore_done>
-
-00000000000021a0 <save_core_spr>:
-    21a0:	3b ec 00 28 	addi    r31,r12,40
-    21a4:	7d e8 03 a6 	mtlr    r15
-    21a8:	4e 80 00 21 	blrl
-    21ac:	4b ff f0 58 	b       1204 <save_restore_done>
+    2110:	79 15 b2 6c 	rldimi  r21,r8,22,41
+    2114:	7a 51 df e3 	rldicl. r17,r18,59,63
+    2118:	41 82 00 20 	beq     2138 <wakeup_hv_smf_enable_mode>
+
+000000000000211c <wakeup_hv_smf_disable_mode>:
+    211c:	79 10 f8 0e 	rldimi  r16,r8,63,0
+    2120:	7e 1f 7b a6 	mtspr   511,r16
+    2124:	3a 20 12 00 	li      r17,4608
+    2128:	28 06 00 00 	cmplwi  r6,0
+    212c:	40 82 00 3c 	bne     2168 <update_usrrx>
+    2130:	3a 31 00 04 	addi    r17,r17,4
+    2134:	48 00 00 34 	b       2168 <update_usrrx>
+
+0000000000002138 <wakeup_hv_smf_enable_mode>:
+    2138:	7e 39 7a a6 	mfspr   r17,505
+    213c:	7a 28 87 e1 	rldicl. r8,r17,16,63
+    2140:	28 08 00 00 	cmplwi  r8,0
+    2144:	41 82 00 14 	beq     2158 <ipl_stop_exit>
+
+0000000000002148 <runtime_stop_exit>:
+    2148:	7e 39 4a a6 	mfspr   r17,313
+    214c:	62 31 02 00 	ori     r17,r17,512
+    2150:	7e 39 4b a6 	mtspr   313,r17
+    2154:	48 00 00 08 	b       215c <hrmor_restore_hv>
+
+0000000000002158 <ipl_stop_exit>:
+    2158:	3a 20 12 00 	li      r17,4608
+
+000000000000215c <hrmor_restore_hv>:
+    215c:	28 06 00 00 	cmplwi  r6,0
+    2160:	41 82 00 08 	beq     2168 <update_usrrx>
+    2164:	3a 31 00 04 	addi    r17,r17,4
+
+0000000000002168 <update_usrrx>:
+    2168:	7e 3a 7b a6 	mtspr   506,r17
+    216c:	7e bb 7b a6 	mtspr   507,r21
+    2170:	7e bb 03 a6 	mtsrr1  r21
+
+0000000000002174 <exit_to_thread_stop>:
+    2174:	4c 00 01 2c 	isync
+    2178:	4c 00 02 64 	.long 0x4c000264
+    217c:	00 00 02 00 	attn
+
+0000000000002180 <initiate_hv_compatibility_mode>:
+    2180:	39 14 12 00 	addi    r8,r20,4608
+    2184:	28 06 00 00 	cmplwi  r6,0
+    2188:	41 82 00 08 	beq     2190 <update_srrx>
+    218c:	39 08 00 04 	addi    r8,r8,4
+
+0000000000002190 <update_srrx>:
+    2190:	7d 1a 03 a6 	mtsrr0  r8
+    2194:	7e bb 03 a6 	mtsrr1  r21
+    2198:	4c 00 00 24 	rfid
+    219c:	00 00 02 00 	attn
+
+00000000000021a0 <initiate_urmor_restore>:
+    21a0:	39 14 12 80 	addi    r8,r20,4736
+    21a4:	28 06 00 00 	cmplwi  r6,0
+    21a8:	41 82 00 08 	beq     21b0 <update_uv_exit>
+    21ac:	39 08 00 08 	addi    r8,r8,8
+
+00000000000021b0 <update_uv_exit>:
+    21b0:	7d 1a 7b a6 	mtspr   506,r8
+    21b4:	7e bb 7b a6 	mtspr   507,r21
+    21b8:	4c 00 02 64 	.long 0x4c000264
+    21bc:	00 00 02 00 	attn
+
+00000000000021c0 <find_self_save>:
+    21c0:	3b ed 00 08 	addi    r31,r13,8
+    21c4:	7d c8 03 a6 	mtlr    r14
+    21c8:	4e 80 00 21 	blrl
+    21cc:	2c 06 00 00 	cmpwi   r6,0
+    21d0:	40 82 f0 34 	bne     1204 <save_restore_done>
+
+00000000000021d4 <save_core_spr>:
+    21d4:	3b ec 00 28 	addi    r31,r12,40
+    21d8:	7d e8 03 a6 	mtlr    r15
+    21dc:	4e 80 00 21 	blrl
+    21e0:	4b ff f0 24 	b       1204 <save_restore_done>
 	...
     2300:	38 00 02 78 	li      r0,632
     2304:	64 00 7c 00 	oris    r0,r0,31744
diff --git a/import/chips/p9/procedures/utils/stopreg/selfRest.map b/import/chips/p9/procedures/utils/stopreg/selfRest.map
index 205d6895..11eee235 100644
--- a/import/chips/p9/procedures/utils/stopreg/selfRest.map
+++ b/import/chips/p9/procedures/utils/stopreg/selfRest.map
@@ -13,16 +13,16 @@ Linker script and memory map
 
 .selfRestore    0x0000000000000000     0x2338
  *(.selfRestore)
- .selfRestore   0x0000000000000000     0x2338 /esw/san2/premjha2/ekbTest/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o
+ .selfRestore   0x0000000000000000     0x2338 /esw/san2/premjha2/ekbTest/p9_ekb/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o
                 0x0000000000000000                _start
-LOAD /esw/san2/premjha2/ekbTest/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o
-OUTPUT(/esw/san2/premjha2/ekbTest/ekb/chips/p9/procedures/utils/stopreg/selfRest.bin binary)
+LOAD /esw/san2/premjha2/ekbTest/p9_ekb/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o
+OUTPUT(/esw/san2/premjha2/ekbTest/p9_ekb/ekb/chips/p9/procedures/utils/stopreg/selfRest.bin binary)
 
 .text           0x0000000000002338        0x0
- .text          0x0000000000002338        0x0 /esw/san2/premjha2/ekbTest/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o
+ .text          0x0000000000002338        0x0 /esw/san2/premjha2/ekbTest/p9_ekb/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o
 
 .data           0x0000000000002338        0x0
- .data          0x0000000000002338        0x0 /esw/san2/premjha2/ekbTest/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o
+ .data          0x0000000000002338        0x0 /esw/san2/premjha2/ekbTest/p9_ekb/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o
 
 .bss            0x0000000000002338        0x0
- .bss           0x0000000000002338        0x0 /esw/san2/premjha2/ekbTest/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o
+ .bss           0x0000000000002338        0x0 /esw/san2/premjha2/ekbTest/p9_ekb/ekb/chips/p9/procedures/utils/stopreg/p9_core_save_restore_routines.o