Index: sys/arm64/arm64/mp_machdep.c
===================================================================
--- sys/arm64/arm64/mp_machdep.c
+++ sys/arm64/arm64/mp_machdep.c
@@ -364,7 +364,6 @@
 	if (id == 0)
 		return (1);
 
-	CPU_SET(id, &all_cpus);
 
 	pcpup = &__pcpu[id];
 	pcpu_init(pcpup, id, sizeof(struct pcpu));
@@ -383,8 +382,13 @@
 	pa = pmap_extract(kernel_pmap, (vm_offset_t)mpentry);
 
 	err = psci_cpu_on(target_cpu, pa, id);
-	if (err != PSCI_RETVAL_SUCCESS)
+	if (err != PSCI_RETVAL_SUCCESS) {
 		printf("Failed to start CPU %u\n", id);
+		pcpu_destroy(pcpup);
+		kmem_free(kernel_arena, (vm_offset_t)dpcpu[id - 1], DPCPU_SIZE);
+		dpcpu[id - 1] = NULL;
+	} else
+		CPU_SET(id, &all_cpus);
 
 	return (1);
 }