/* * Detect the presence of a resident Trusted OS which may cause CPU_OFF to * return DENIED (which would be fatal). */ static void __init psci_init_migrate(void) { unsigned long cpuid; int type, cpu = -1; type = psci_ops.migrate_info_type(); if (type == PSCI_0_2_TOS_MP) { pr_info("Trusted OS migration not required\n"); return; } if (type == PSCI_RET_NOT_SUPPORTED) { pr_info("MIGRATE_INFO_TYPE not supported.\n"); return; } if (type != PSCI_0_2_TOS_UP_MIGRATE && type != PSCI_0_2_TOS_UP_NO_MIGRATE) { pr_err("MIGRATE_INFO_TYPE returned unknown type (%d)\n", type); return; } cpuid = psci_migrate_info_up_cpu(); if (cpuid & ~MPIDR_HWID_BITMASK) { pr_warn("MIGRATE_INFO_UP_CPU reported invalid physical ID (0x%lx)\n", cpuid); return; } cpu = get_logical_index(cpuid); resident_cpu = cpu >= 0 ? cpu : -1; pr_info("Trusted OS resident on physical CPU 0x%lx\n", cpuid); }
/******************************************************************************* * PSCI top level handler for servicing SMCs. ******************************************************************************/ uint64_t psci_smc_handler(uint32_t smc_fid, uint64_t x1, uint64_t x2, uint64_t x3, uint64_t x4, void *cookie, void *handle, uint64_t flags) { uint64_t rc; switch (smc_fid) { case PSCI_VERSION: rc = psci_version(); break; case PSCI_CPU_OFF: rc = __psci_cpu_off(); break; case PSCI_CPU_SUSPEND_AARCH64: case PSCI_CPU_SUSPEND_AARCH32: rc = __psci_cpu_suspend(x1, x2, x3); break; case PSCI_CPU_ON_AARCH64: case PSCI_CPU_ON_AARCH32: rc = psci_cpu_on(x1, x2, x3); break; case PSCI_AFFINITY_INFO_AARCH32: case PSCI_AFFINITY_INFO_AARCH64: rc = psci_affinity_info(x1, x2); break; case PSCI_MIG_AARCH32: case PSCI_MIG_AARCH64: rc = psci_migrate(x1); break; case PSCI_MIG_INFO_TYPE: rc = psci_migrate_info_type(); break; case PSCI_MIG_INFO_UP_CPU_AARCH32: case PSCI_MIG_INFO_UP_CPU_AARCH64: rc = psci_migrate_info_up_cpu(); break; default: rc = SMC_UNK; WARN("Unimplemented PSCI Call: 0x%x \n", smc_fid); } SMC_RET1(handle, rc); }