/* See rn_test_tools.h. */
/* Last edited on 2024-11-20 13:11:32 by stolfi */

#include <stdio.h>
#include <stdint.h>
#include <math.h>
#include <assert.h>

#include <affirm.h>

#include <rn_test_tools.h>

#define NO NULL

void rn_test_tools_do_check_eq(double x, double y, uint32_t *i, uint32_t *j, char *msg, rn_test_tools_LOCPARMS)
  { if (x != y)
      { fprintf(stderr, " **"); 
        if (i != NULL) { fprintf(stderr, " [%d]", *i); }
        if (j != NULL) { fprintf(stderr, " [%d]", *j); }
        fprintf(stderr, " %20.16e != %20.16e\n", x, y);
        programerror(msg, file, line, func);
      }
  }

void rn_test_tools_do_check_eps(double x, double y, double eps, uint32_t *i, uint32_t *j, char *msg, rn_test_tools_LOCPARMS)
  { double diff = fabs(x - y);
    if (diff > eps)
      { fprintf(stderr, " **"); 
        if (i != NULL) { fprintf(stderr, " [%d]", *i); }
        if (j != NULL) { fprintf(stderr, " [%d]", *j); }
        fprintf(stderr, " | %20.16e - %20.16e | =  %20.16e > %20.16e\n", x, y, diff, eps);
        programerror(msg, file, line, func);
      }
  }
  
void rn_test_tools_check_all_different(uint32_t n, double *a, char *msg)
  { for (uint32_t i = 0;  i < n; i++)
      { /* Check that {a[i]} is different from all previous elements: */
        for (uint32_t i1 = 0;  i1 < i; i1++)
          { demand(a[i1] != a[i], msg); }
      }
  }

void rn_test_tools_check_rot_axis(uint32_t n, double *a, uint32_t i, uint32_t j, double ang, double *r, char *msg)
  { 
    assert((i >= 0) && (i < n));
    assert((j >= 0) && (j < n) && (i != j));
    double ca = cos(ang), sa = sin(ang);
    for (uint32_t k = 0;  k < n; k++)
      { double rrk;
        if (k == i) 
          { rrk = + ca*a[k] - sa*a[j]; }
        else if (k == j)
          { rrk = + sa*a[i] + ca*a[k]; }
        else
          { rrk = a[k]; }
        rn_test_tools_check_eq(r[k], rrk, &i, &j, msg);
      }
  }