// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Ptrace test for VMX/VSX registers in the TM Suspend context
 *
 * Copyright (C) 2015 Anshuman Khandual, IBM Corporation.
 */
#include "ptrace.h"
#include "tm.h"
#include "ptrace-vsx.h"

int shm_id;
int *cptr, *pptr;

unsigned long fp_load[VEC_MAX];
unsigned long fp_load_new[VEC_MAX];
unsigned long fp_store[VEC_MAX];
unsigned long fp_load_ckpt[VEC_MAX];
unsigned long fp_load_ckpt_new[VEC_MAX];

__attribute__((used)) void load_vsx(void)
{
        loadvsx(fp_load, 0);
}

__attribute__((used)) void load_vsx_new(void)
{
        loadvsx(fp_load_new, 0);
}

__attribute__((used)) void load_vsx_ckpt(void)
{
        loadvsx(fp_load_ckpt, 0);
}

__attribute__((used)) void wait_parent(void)
{
        cptr[2] = 1;
        while (!cptr[1])
                asm volatile("" : : : "memory");
}

void tm_spd_vsx(void)
{
        unsigned long result, texasr;
        int ret;

        cptr = (int *)shmat(shm_id, NULL, 0);

trans:
        cptr[2] = 0;
        asm __volatile__(
                "bl load_vsx_ckpt;"

                "1: ;"
                "tbegin.;"
                "beq 2f;"

                "bl load_vsx_new;"
                "tsuspend.;"
                "bl load_vsx;"
                "bl wait_parent;"
                "tresume.;"

                "tend.;"
                "li 0, 0;"
                "ori %[res], 0, 0;"
                "b 3f;"

                "2: ;"
                "li 0, 1;"
                "ori %[res], 0, 0;"
                "mfspr %[texasr], %[sprn_texasr];"

                "3: ;"
                : [res] "=r" (result), [texasr] "=r" (texasr)
                : [sprn_texasr] "i"  (SPRN_TEXASR)
                : "memory", "r0", "r3", "r4",
                  "r7", "r8", "r9", "r10", "r11", "lr"
                );

        if (result) {
                if (!cptr[0])
                        goto trans;
                shmdt((void *)cptr);

                storevsx(fp_store, 0);
                ret = compare_vsx_vmx(fp_store, fp_load_ckpt_new);
                if (ret)
                        exit(1);
                exit(0);
        }
        shmdt((void *)cptr);
        exit(1);
}

int trace_tm_spd_vsx(pid_t child)
{
        unsigned long vsx[VSX_MAX];
        unsigned long vmx[VMX_MAX + 2][2];

        FAIL_IF(start_trace(child));
        FAIL_IF(show_vsx(child, vsx));
        FAIL_IF(validate_vsx(vsx, fp_load));
        FAIL_IF(show_vmx(child, vmx));
        FAIL_IF(validate_vmx(vmx, fp_load));
        FAIL_IF(show_vsx_ckpt(child, vsx));
        FAIL_IF(validate_vsx(vsx, fp_load_ckpt));
        FAIL_IF(show_vmx_ckpt(child, vmx));
        FAIL_IF(validate_vmx(vmx, fp_load_ckpt));

        memset(vsx, 0, sizeof(vsx));
        memset(vmx, 0, sizeof(vmx));

        load_vsx_vmx(fp_load_ckpt_new, vsx, vmx);

        FAIL_IF(write_vsx_ckpt(child, vsx));
        FAIL_IF(write_vmx_ckpt(child, vmx));

        pptr[0] = 1;
        pptr[1] = 1;
        FAIL_IF(stop_trace(child));

        return TEST_PASS;
}

int ptrace_tm_spd_vsx(void)
{
        pid_t pid;
        int ret, status, i;

        SKIP_IF_MSG(!have_htm(), "Don't have transactional memory");
        SKIP_IF_MSG(htm_is_synthetic(), "Transactional memory is synthetic");
        shm_id = shmget(IPC_PRIVATE, sizeof(int) * 3, 0777|IPC_CREAT);

        for (i = 0; i < 128; i++) {
                fp_load[i] = 1 + rand();
                fp_load_new[i] = 1 + 2 * rand();
                fp_load_ckpt[i] = 1 + 3 * rand();
                fp_load_ckpt_new[i] = 1 + 4 * rand();
        }

        pid = fork();
        if (pid < 0) {
                perror("fork() failed");
                return TEST_FAIL;
        }

        if (pid == 0)
                tm_spd_vsx();

        if (pid) {
                pptr = (int *)shmat(shm_id, NULL, 0);
                while (!pptr[2])
                        asm volatile("" : : : "memory");

                ret = trace_tm_spd_vsx(pid);
                if (ret) {
                        kill(pid, SIGKILL);
                        shmdt((void *)pptr);
                        shmctl(shm_id, IPC_RMID, NULL);
                        return TEST_FAIL;
                }

                shmdt((void *)pptr);
                ret = wait(&status);
                shmctl(shm_id, IPC_RMID, NULL);
                if (ret != pid) {
                        printf("Child's exit status not captured\n");
                        return TEST_FAIL;
                }

                return (WIFEXITED(status) && WEXITSTATUS(status)) ? TEST_FAIL :
                        TEST_PASS;
        }
        return TEST_PASS;
}

int main(int argc, char *argv[])
{
        return test_harness(ptrace_tm_spd_vsx, "ptrace_tm_spd_vsx");
}