@@ -16,6 +16,7 @@
#include <linux/init.h>
#include <linux/smp.h>
#include <linux/of.h>
+#include <uapi/linux/psci.h>
#include <asm/psci.h>
#include <asm/smp_plat.h>
@@ -66,6 +67,25 @@ void __ref psci_cpu_die(unsigned int cpu)
/* We should never return */
panic("psci: cpu %d failed to shutdown\n", cpu);
}
+
+int __ref psci_cpu_kill(unsigned int cpu)
+{
+ int err;
+
+ if (!psci_ops.affinity_info)
+ return 1;
+
+ err = psci_ops.affinity_info(cpu_logical_map(cpu), 0);
+
+ if (err != PSCI_AFFINITY_INFO_RET_OFF) {
+ pr_err("psci: Cannot kill CPU:%d, psci ret val: %d\n",
+ cpu, err);
+ /* Make platform_cpu_kill() fail. */
+ return 0;
+ }
+ return 1;
+}
+
#endif
bool __init psci_smp_available(void)
@@ -78,5 +98,6 @@ struct smp_operations __initdata psci_smp_ops = {
.smp_boot_secondary = psci_boot_secondary,
#ifdef CONFIG_HOTPLUG_CPU
.cpu_die = psci_cpu_die,
+ .cpu_kill = psci_cpu_kill,
#endif
};
@@ -58,4 +58,9 @@
((ver & PSCI_VER_MAJOR_MASK) >> PSCI_VER_MAJOR_SHIFT)
#define PSCI_VER_MINOR(ver) (ver & PSCI_VER_MINOR_MASK)
+/* Return values from the PSCI_ID_AFFINITY_INFO Function. */
+#define PSCI_AFFINITY_INFO_RET_ON 0
+#define PSCI_AFFINITY_INFO_RET_OFF 1
+#define PSCI_AFFINITY_INFO_RET_ON_PENDING 2
+
#endif /* _UAPI_LINUX_PSCI_H */