162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0+ 262306a36Sopenharmony_ci 362306a36Sopenharmony_ci#include <errno.h> 462306a36Sopenharmony_ci#include <setjmp.h> 562306a36Sopenharmony_ci#include <signal.h> 662306a36Sopenharmony_ci#include <sys/types.h> 762306a36Sopenharmony_ci#include <sys/wait.h> 862306a36Sopenharmony_ci 962306a36Sopenharmony_ci#include "dexcr.h" 1062306a36Sopenharmony_ci#include "reg.h" 1162306a36Sopenharmony_ci#include "utils.h" 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_cistatic jmp_buf generic_signal_jump_buf; 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_cistatic void generic_signal_handler(int signum, siginfo_t *info, void *context) 1662306a36Sopenharmony_ci{ 1762306a36Sopenharmony_ci longjmp(generic_signal_jump_buf, 0); 1862306a36Sopenharmony_ci} 1962306a36Sopenharmony_ci 2062306a36Sopenharmony_cibool dexcr_exists(void) 2162306a36Sopenharmony_ci{ 2262306a36Sopenharmony_ci struct sigaction old; 2362306a36Sopenharmony_ci volatile bool exists; 2462306a36Sopenharmony_ci 2562306a36Sopenharmony_ci old = push_signal_handler(SIGILL, generic_signal_handler); 2662306a36Sopenharmony_ci if (setjmp(generic_signal_jump_buf)) 2762306a36Sopenharmony_ci goto out; 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_ci /* 3062306a36Sopenharmony_ci * If the SPR is not recognised by the hardware it triggers 3162306a36Sopenharmony_ci * a hypervisor emulation interrupt. If the kernel does not 3262306a36Sopenharmony_ci * recognise/try to emulate it, we receive a SIGILL signal. 3362306a36Sopenharmony_ci * 3462306a36Sopenharmony_ci * If we do not receive a signal, assume we have the SPR or the 3562306a36Sopenharmony_ci * kernel is trying to emulate it correctly. 3662306a36Sopenharmony_ci */ 3762306a36Sopenharmony_ci exists = false; 3862306a36Sopenharmony_ci mfspr(SPRN_DEXCR_RO); 3962306a36Sopenharmony_ci exists = true; 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_ciout: 4262306a36Sopenharmony_ci pop_signal_handler(SIGILL, old); 4362306a36Sopenharmony_ci return exists; 4462306a36Sopenharmony_ci} 4562306a36Sopenharmony_ci 4662306a36Sopenharmony_ci/* 4762306a36Sopenharmony_ci * Just test if a bad hashchk triggers a signal, without checking 4862306a36Sopenharmony_ci * for support or if the NPHIE aspect is enabled. 4962306a36Sopenharmony_ci */ 5062306a36Sopenharmony_cibool hashchk_triggers(void) 5162306a36Sopenharmony_ci{ 5262306a36Sopenharmony_ci struct sigaction old; 5362306a36Sopenharmony_ci volatile bool triggers; 5462306a36Sopenharmony_ci 5562306a36Sopenharmony_ci old = push_signal_handler(SIGILL, generic_signal_handler); 5662306a36Sopenharmony_ci if (setjmp(generic_signal_jump_buf)) 5762306a36Sopenharmony_ci goto out; 5862306a36Sopenharmony_ci 5962306a36Sopenharmony_ci triggers = true; 6062306a36Sopenharmony_ci do_bad_hashchk(); 6162306a36Sopenharmony_ci triggers = false; 6262306a36Sopenharmony_ci 6362306a36Sopenharmony_ciout: 6462306a36Sopenharmony_ci pop_signal_handler(SIGILL, old); 6562306a36Sopenharmony_ci return triggers; 6662306a36Sopenharmony_ci} 6762306a36Sopenharmony_ci 6862306a36Sopenharmony_ciunsigned int get_dexcr(enum dexcr_source source) 6962306a36Sopenharmony_ci{ 7062306a36Sopenharmony_ci switch (source) { 7162306a36Sopenharmony_ci case DEXCR: 7262306a36Sopenharmony_ci return mfspr(SPRN_DEXCR_RO); 7362306a36Sopenharmony_ci case HDEXCR: 7462306a36Sopenharmony_ci return mfspr(SPRN_HDEXCR_RO); 7562306a36Sopenharmony_ci case EFFECTIVE: 7662306a36Sopenharmony_ci return mfspr(SPRN_DEXCR_RO) | mfspr(SPRN_HDEXCR_RO); 7762306a36Sopenharmony_ci default: 7862306a36Sopenharmony_ci FAIL_IF_EXIT_MSG(true, "bad enum dexcr_source"); 7962306a36Sopenharmony_ci } 8062306a36Sopenharmony_ci} 8162306a36Sopenharmony_ci 8262306a36Sopenharmony_civoid await_child_success(pid_t pid) 8362306a36Sopenharmony_ci{ 8462306a36Sopenharmony_ci int wstatus; 8562306a36Sopenharmony_ci 8662306a36Sopenharmony_ci FAIL_IF_EXIT_MSG(pid == -1, "fork failed"); 8762306a36Sopenharmony_ci FAIL_IF_EXIT_MSG(waitpid(pid, &wstatus, 0) == -1, "wait failed"); 8862306a36Sopenharmony_ci FAIL_IF_EXIT_MSG(!WIFEXITED(wstatus), "child did not exit cleanly"); 8962306a36Sopenharmony_ci FAIL_IF_EXIT_MSG(WEXITSTATUS(wstatus) != 0, "child exit error"); 9062306a36Sopenharmony_ci} 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci/* 9362306a36Sopenharmony_ci * Perform a hashst instruction. The following components determine the result 9462306a36Sopenharmony_ci * 9562306a36Sopenharmony_ci * 1. The LR value (any register technically) 9662306a36Sopenharmony_ci * 2. The SP value (also any register, but it must be a valid address) 9762306a36Sopenharmony_ci * 3. A secret key managed by the kernel 9862306a36Sopenharmony_ci * 9962306a36Sopenharmony_ci * The result is stored to the address held in SP. 10062306a36Sopenharmony_ci */ 10162306a36Sopenharmony_civoid hashst(unsigned long lr, void *sp) 10262306a36Sopenharmony_ci{ 10362306a36Sopenharmony_ci asm volatile ("addi 31, %0, 0;" /* set r31 (pretend LR) to lr */ 10462306a36Sopenharmony_ci "addi 30, %1, 8;" /* set r30 (pretend SP) to sp + 8 */ 10562306a36Sopenharmony_ci PPC_RAW_HASHST(31, -8, 30) /* compute hash into stack location */ 10662306a36Sopenharmony_ci : : "r" (lr), "r" (sp) : "r31", "r30", "memory"); 10762306a36Sopenharmony_ci} 10862306a36Sopenharmony_ci 10962306a36Sopenharmony_ci/* 11062306a36Sopenharmony_ci * Perform a hashchk instruction. A hash is computed as per hashst(), 11162306a36Sopenharmony_ci * however the result is not stored to memory. Instead the existing 11262306a36Sopenharmony_ci * value is read and compared against the computed hash. 11362306a36Sopenharmony_ci * 11462306a36Sopenharmony_ci * If they match, execution continues. 11562306a36Sopenharmony_ci * If they differ, an interrupt triggers. 11662306a36Sopenharmony_ci */ 11762306a36Sopenharmony_civoid hashchk(unsigned long lr, void *sp) 11862306a36Sopenharmony_ci{ 11962306a36Sopenharmony_ci asm volatile ("addi 31, %0, 0;" /* set r31 (pretend LR) to lr */ 12062306a36Sopenharmony_ci "addi 30, %1, 8;" /* set r30 (pretend SP) to sp + 8 */ 12162306a36Sopenharmony_ci PPC_RAW_HASHCHK(31, -8, 30) /* check hash at stack location */ 12262306a36Sopenharmony_ci : : "r" (lr), "r" (sp) : "r31", "r30", "memory"); 12362306a36Sopenharmony_ci} 12462306a36Sopenharmony_ci 12562306a36Sopenharmony_civoid do_bad_hashchk(void) 12662306a36Sopenharmony_ci{ 12762306a36Sopenharmony_ci unsigned long hash = 0; 12862306a36Sopenharmony_ci 12962306a36Sopenharmony_ci hashst(0, &hash); 13062306a36Sopenharmony_ci hash += 1; 13162306a36Sopenharmony_ci hashchk(0, &hash); 13262306a36Sopenharmony_ci} 133