Merge pull request #402 from soby-mathew/sm/psci_cpu_off

PSCI: Update state only if CPU_OFF is not denied by SPD

services/std_svc/psci/psci_off.c

@@ -62,7 +62,7 @@ static void psci_set_power_off_state(psci_power_state_t *state_info)
  ******************************************************************************/
 int psci_do_cpu_off(unsigned int end_pwrlvl)
 {
-	int rc, idx = plat_my_core_pos();
+	int rc = PSCI_E_SUCCESS, idx = plat_my_core_pos();
 	psci_power_state_t state_info;
 
 	/*
@@ -121,22 +121,26 @@ exit:
 				      idx);
 
 	/*
-	 * Set the affinity info state to OFF. This writes directly to main
-	 * memory as caches are disabled, so cache maintenance is required
-	 * to ensure that later cached reads of aff_info_state return
-	 * AFF_STATE_OFF.
+	 * Check if all actions needed to safely power down this cpu have
+	 * successfully completed.
+	 */
+	if (rc == PSCI_E_SUCCESS) {
+		/*
+		 * Set the affinity info state to OFF. This writes directly to
+		 * main memory as caches are disabled, so cache maintenance is
+		 * required to ensure that later cached reads of aff_info_state
+		 * return AFF_STATE_OFF.
 		 */
 		flush_cpu_data(psci_svc_cpu_data.aff_info_state);
 		psci_set_aff_info_state(AFF_STATE_OFF);
 		inv_cpu_data(psci_svc_cpu_data.aff_info_state);
 
 		/*
-	 * Check if all actions needed to safely power down this cpu have
-	 * successfully completed. Enter a wfi loop which will allow the
-	 * power controller to physically power down this cpu.
+		 * Enter a wfi loop which will allow the power controller to
+		 * physically power down this cpu.
 		 */
-	if (rc == PSCI_E_SUCCESS)
 		psci_power_down_wfi();
+	}
 
 	return rc;
 }