// 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");
}