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