// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright 2017, Michael Neuling, IBM Corp.
 * Original: Breno Leitao <brenohl@br.ibm.com> &
 *           Gustavo Bueno Romero <gromero@br.ibm.com>
 * Edited: Michael Neuling
 *
 * Force VMX unavailable during a transaction and see if it corrupts
 * the checkpointed VMX register state after the abort.
 */

#include <inttypes.h>
#include <htmintrin.h>
#include <string.h>
#include <stdlib.h>
#include <stdio.h>
#include <pthread.h>
#include <sys/mman.h>
#include <unistd.h>

#include "tm.h"
#include "utils.h"

int passed;

void *worker(void *unused)
{
        __int128 vmx0;
        uint64_t texasr;

        asm goto (
                "li       3, 1;"  /* Stick non-zero value in VMX0 */
                "std      3, 0(%[vmx0_ptr]);"
                "lvx      0, 0, %[vmx0_ptr];"

                /* Wait here a bit so we get scheduled out 255 times */
                "lis      3, 0x3fff;"
                "1: ;"
                "addi     3, 3, -1;"
                "cmpdi    3, 0;"
                "bne      1b;"

                /* Kernel will hopefully turn VMX off now */

                "tbegin. ;"
                "beq      failure;"

                /* Cause VMX unavail. Any VMX instruction */
                "vaddcuw  0,0,0;"

                "tend. ;"
                "b        %l[success];"

                /* Check VMX0 sanity after abort */
                "failure: ;"
                "lvx       1,  0, %[vmx0_ptr];"
                "vcmpequb. 2,  0, 1;"
                "bc        4, 24, %l[value_mismatch];"
                "b        %l[value_match];"
                :
                : [vmx0_ptr] "r"(&vmx0)
                : "r3"
                : success, value_match, value_mismatch
                );

        /* HTM aborted and VMX0 is corrupted */
value_mismatch:
        texasr = __builtin_get_texasr();

        printf("\n\n==============\n\n");
        printf("Failure with error: %lx\n",   _TEXASR_FAILURE_CODE(texasr));
        printf("Summary error     : %lx\n",   _TEXASR_FAILURE_SUMMARY(texasr));
        printf("TFIAR exact       : %lx\n\n", _TEXASR_TFIAR_EXACT(texasr));

        passed = 0;
        return NULL;

        /* HTM aborted but VMX0 is correct */
value_match:
//      printf("!");
        return NULL;

success:
//      printf(".");
        return NULL;
}

int tm_vmx_unavail_test()
{
        int threads;
        pthread_t *thread;

        SKIP_IF(!have_htm());
        SKIP_IF(htm_is_synthetic());

        passed = 1;

        threads = sysconf(_SC_NPROCESSORS_ONLN) * 4;
        thread = malloc(sizeof(pthread_t)*threads);
        if (!thread)
                return EXIT_FAILURE;

        for (uint64_t i = 0; i < threads; i++)
                pthread_create(&thread[i], NULL, &worker, NULL);

        for (uint64_t i = 0; i < threads; i++)
                pthread_join(thread[i], NULL);

        free(thread);

        return passed ? EXIT_SUCCESS : EXIT_FAILURE;
}


int main(int argc, char **argv)
{
        return test_harness(tm_vmx_unavail_test, "tm_vmx_unavail_test");
}