18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Ptrace test for VMX/VSX registers in the TM context
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright (C) 2015 Anshuman Khandual, IBM Corporation.
68c2ecf20Sopenharmony_ci */
78c2ecf20Sopenharmony_ci#include "ptrace.h"
88c2ecf20Sopenharmony_ci#include "tm.h"
98c2ecf20Sopenharmony_ci#include "ptrace-vsx.h"
108c2ecf20Sopenharmony_ci
118c2ecf20Sopenharmony_ciint shm_id;
128c2ecf20Sopenharmony_ciunsigned long *cptr, *pptr;
138c2ecf20Sopenharmony_ci
148c2ecf20Sopenharmony_ciunsigned long fp_load[VEC_MAX];
158c2ecf20Sopenharmony_ciunsigned long fp_store[VEC_MAX];
168c2ecf20Sopenharmony_ciunsigned long fp_load_ckpt[VEC_MAX];
178c2ecf20Sopenharmony_ciunsigned long fp_load_ckpt_new[VEC_MAX];
188c2ecf20Sopenharmony_ci
198c2ecf20Sopenharmony_ci__attribute__((used)) void load_vsx(void)
208c2ecf20Sopenharmony_ci{
218c2ecf20Sopenharmony_ci	loadvsx(fp_load, 0);
228c2ecf20Sopenharmony_ci}
238c2ecf20Sopenharmony_ci
248c2ecf20Sopenharmony_ci__attribute__((used)) void load_vsx_ckpt(void)
258c2ecf20Sopenharmony_ci{
268c2ecf20Sopenharmony_ci	loadvsx(fp_load_ckpt, 0);
278c2ecf20Sopenharmony_ci}
288c2ecf20Sopenharmony_ci
298c2ecf20Sopenharmony_civoid tm_vsx(void)
308c2ecf20Sopenharmony_ci{
318c2ecf20Sopenharmony_ci	unsigned long result, texasr;
328c2ecf20Sopenharmony_ci	int ret;
338c2ecf20Sopenharmony_ci
348c2ecf20Sopenharmony_ci	cptr = (unsigned long *)shmat(shm_id, NULL, 0);
358c2ecf20Sopenharmony_ci
368c2ecf20Sopenharmony_citrans:
378c2ecf20Sopenharmony_ci	cptr[1] = 0;
388c2ecf20Sopenharmony_ci	asm __volatile__(
398c2ecf20Sopenharmony_ci		"bl load_vsx_ckpt;"
408c2ecf20Sopenharmony_ci
418c2ecf20Sopenharmony_ci		"1: ;"
428c2ecf20Sopenharmony_ci		"tbegin.;"
438c2ecf20Sopenharmony_ci		"beq 2f;"
448c2ecf20Sopenharmony_ci
458c2ecf20Sopenharmony_ci		"bl load_vsx;"
468c2ecf20Sopenharmony_ci		"tsuspend.;"
478c2ecf20Sopenharmony_ci		"li 7, 1;"
488c2ecf20Sopenharmony_ci		"stw 7, 0(%[cptr1]);"
498c2ecf20Sopenharmony_ci		"tresume.;"
508c2ecf20Sopenharmony_ci		"b .;"
518c2ecf20Sopenharmony_ci
528c2ecf20Sopenharmony_ci		"tend.;"
538c2ecf20Sopenharmony_ci		"li 0, 0;"
548c2ecf20Sopenharmony_ci		"ori %[res], 0, 0;"
558c2ecf20Sopenharmony_ci		"b 3f;"
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_ci		"2: ;"
588c2ecf20Sopenharmony_ci		"li 0, 1;"
598c2ecf20Sopenharmony_ci		"ori %[res], 0, 0;"
608c2ecf20Sopenharmony_ci		"mfspr %[texasr], %[sprn_texasr];"
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_ci		"3: ;"
638c2ecf20Sopenharmony_ci		: [res] "=r" (result), [texasr] "=r" (texasr)
648c2ecf20Sopenharmony_ci		: [sprn_texasr] "i"  (SPRN_TEXASR), [cptr1] "b" (&cptr[1])
658c2ecf20Sopenharmony_ci		: "memory", "r0", "r3", "r4",
668c2ecf20Sopenharmony_ci		  "r7", "r8", "r9", "r10", "r11", "lr"
678c2ecf20Sopenharmony_ci		);
688c2ecf20Sopenharmony_ci
698c2ecf20Sopenharmony_ci	if (result) {
708c2ecf20Sopenharmony_ci		if (!cptr[0])
718c2ecf20Sopenharmony_ci			goto trans;
728c2ecf20Sopenharmony_ci
738c2ecf20Sopenharmony_ci		shmdt((void *)cptr);
748c2ecf20Sopenharmony_ci		storevsx(fp_store, 0);
758c2ecf20Sopenharmony_ci		ret = compare_vsx_vmx(fp_store, fp_load_ckpt_new);
768c2ecf20Sopenharmony_ci		if (ret)
778c2ecf20Sopenharmony_ci			exit(1);
788c2ecf20Sopenharmony_ci		exit(0);
798c2ecf20Sopenharmony_ci	}
808c2ecf20Sopenharmony_ci	shmdt((void *)cptr);
818c2ecf20Sopenharmony_ci	exit(1);
828c2ecf20Sopenharmony_ci}
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_ciint trace_tm_vsx(pid_t child)
858c2ecf20Sopenharmony_ci{
868c2ecf20Sopenharmony_ci	unsigned long vsx[VSX_MAX];
878c2ecf20Sopenharmony_ci	unsigned long vmx[VMX_MAX + 2][2];
888c2ecf20Sopenharmony_ci
898c2ecf20Sopenharmony_ci	FAIL_IF(start_trace(child));
908c2ecf20Sopenharmony_ci	FAIL_IF(show_vsx(child, vsx));
918c2ecf20Sopenharmony_ci	FAIL_IF(validate_vsx(vsx, fp_load));
928c2ecf20Sopenharmony_ci	FAIL_IF(show_vmx(child, vmx));
938c2ecf20Sopenharmony_ci	FAIL_IF(validate_vmx(vmx, fp_load));
948c2ecf20Sopenharmony_ci	FAIL_IF(show_vsx_ckpt(child, vsx));
958c2ecf20Sopenharmony_ci	FAIL_IF(validate_vsx(vsx, fp_load_ckpt));
968c2ecf20Sopenharmony_ci	FAIL_IF(show_vmx_ckpt(child, vmx));
978c2ecf20Sopenharmony_ci	FAIL_IF(validate_vmx(vmx, fp_load_ckpt));
988c2ecf20Sopenharmony_ci	memset(vsx, 0, sizeof(vsx));
998c2ecf20Sopenharmony_ci	memset(vmx, 0, sizeof(vmx));
1008c2ecf20Sopenharmony_ci
1018c2ecf20Sopenharmony_ci	load_vsx_vmx(fp_load_ckpt_new, vsx, vmx);
1028c2ecf20Sopenharmony_ci
1038c2ecf20Sopenharmony_ci	FAIL_IF(write_vsx_ckpt(child, vsx));
1048c2ecf20Sopenharmony_ci	FAIL_IF(write_vmx_ckpt(child, vmx));
1058c2ecf20Sopenharmony_ci	pptr[0] = 1;
1068c2ecf20Sopenharmony_ci	FAIL_IF(stop_trace(child));
1078c2ecf20Sopenharmony_ci	return TEST_PASS;
1088c2ecf20Sopenharmony_ci}
1098c2ecf20Sopenharmony_ci
1108c2ecf20Sopenharmony_ciint ptrace_tm_vsx(void)
1118c2ecf20Sopenharmony_ci{
1128c2ecf20Sopenharmony_ci	pid_t pid;
1138c2ecf20Sopenharmony_ci	int ret, status, i;
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_ci	SKIP_IF(!have_htm());
1168c2ecf20Sopenharmony_ci	shm_id = shmget(IPC_PRIVATE, sizeof(int) * 2, 0777|IPC_CREAT);
1178c2ecf20Sopenharmony_ci
1188c2ecf20Sopenharmony_ci	for (i = 0; i < 128; i++) {
1198c2ecf20Sopenharmony_ci		fp_load[i] = 1 + rand();
1208c2ecf20Sopenharmony_ci		fp_load_ckpt[i] = 1 + 2 * rand();
1218c2ecf20Sopenharmony_ci		fp_load_ckpt_new[i] = 1 + 3 * rand();
1228c2ecf20Sopenharmony_ci	}
1238c2ecf20Sopenharmony_ci
1248c2ecf20Sopenharmony_ci	pid = fork();
1258c2ecf20Sopenharmony_ci	if (pid < 0) {
1268c2ecf20Sopenharmony_ci		perror("fork() failed");
1278c2ecf20Sopenharmony_ci		return TEST_FAIL;
1288c2ecf20Sopenharmony_ci	}
1298c2ecf20Sopenharmony_ci
1308c2ecf20Sopenharmony_ci	if (pid == 0)
1318c2ecf20Sopenharmony_ci		tm_vsx();
1328c2ecf20Sopenharmony_ci
1338c2ecf20Sopenharmony_ci	if (pid) {
1348c2ecf20Sopenharmony_ci		pptr = (unsigned long *)shmat(shm_id, NULL, 0);
1358c2ecf20Sopenharmony_ci		while (!pptr[1])
1368c2ecf20Sopenharmony_ci			asm volatile("" : : : "memory");
1378c2ecf20Sopenharmony_ci
1388c2ecf20Sopenharmony_ci		ret = trace_tm_vsx(pid);
1398c2ecf20Sopenharmony_ci		if (ret) {
1408c2ecf20Sopenharmony_ci			kill(pid, SIGKILL);
1418c2ecf20Sopenharmony_ci			shmdt((void *)pptr);
1428c2ecf20Sopenharmony_ci			shmctl(shm_id, IPC_RMID, NULL);
1438c2ecf20Sopenharmony_ci			return TEST_FAIL;
1448c2ecf20Sopenharmony_ci		}
1458c2ecf20Sopenharmony_ci
1468c2ecf20Sopenharmony_ci		shmdt((void *)pptr);
1478c2ecf20Sopenharmony_ci		ret = wait(&status);
1488c2ecf20Sopenharmony_ci		shmctl(shm_id, IPC_RMID, NULL);
1498c2ecf20Sopenharmony_ci		if (ret != pid) {
1508c2ecf20Sopenharmony_ci			printf("Child's exit status not captured\n");
1518c2ecf20Sopenharmony_ci			return TEST_FAIL;
1528c2ecf20Sopenharmony_ci		}
1538c2ecf20Sopenharmony_ci
1548c2ecf20Sopenharmony_ci		return (WIFEXITED(status) && WEXITSTATUS(status)) ? TEST_FAIL :
1558c2ecf20Sopenharmony_ci			TEST_PASS;
1568c2ecf20Sopenharmony_ci	}
1578c2ecf20Sopenharmony_ci	return TEST_PASS;
1588c2ecf20Sopenharmony_ci}
1598c2ecf20Sopenharmony_ci
1608c2ecf20Sopenharmony_ciint main(int argc, char *argv[])
1618c2ecf20Sopenharmony_ci{
1628c2ecf20Sopenharmony_ci	return test_harness(ptrace_tm_vsx, "ptrace_tm_vsx");
1638c2ecf20Sopenharmony_ci}
164