#include <volk/volk.h>
#include <qa_16s_add_quad_aligned16.h>
#include <volk/volk_16s_add_quad_aligned16.h>
#include <cstdlib>
#include <ctime>
//test for sse2

#ifndef LV_HAVE_SSE2

void qa_16s_add_quad_aligned16::t1() {
  printf("sse2 not available... no test performed\n");
}

#else



void qa_16s_add_quad_aligned16::t1() {
  
  volk_environment_init();
  clock_t start, end;
  double total;
  const int vlen = 3200;
  const int ITERS = 100000;
  short input0[vlen] __attribute__ ((aligned (16)));
  short input1[vlen] __attribute__ ((aligned (16)));
  short input2[vlen] __attribute__ ((aligned (16)));
  short input3[vlen] __attribute__ ((aligned (16)));
  short input4[vlen] __attribute__ ((aligned (16)));
  
  short output0[vlen] __attribute__ ((aligned (16)));
  short output1[vlen] __attribute__ ((aligned (16)));
  short output2[vlen] __attribute__ ((aligned (16)));
  short output3[vlen] __attribute__ ((aligned (16)));
  short output01[vlen] __attribute__ ((aligned (16)));
  short output11[vlen] __attribute__ ((aligned (16)));
  short output21[vlen] __attribute__ ((aligned (16)));
  short output31[vlen] __attribute__ ((aligned (16)));

  for(int i = 0; i < vlen; ++i) {
    short plus0 = ((short) (rand() - (RAND_MAX/2))) >> 2;
    short minus0 = ((short) (rand() - (RAND_MAX/2))) >> 2;
    short plus1 = ((short) (rand() - (RAND_MAX/2))) >> 2;
    short minus1 = ((short) (rand() - (RAND_MAX/2))) >> 2;
    short plus2 = ((short) (rand() - (RAND_MAX/2))) >> 2;
    short minus2 = ((short) (rand() - (RAND_MAX/2))) >> 2;
    short plus3 = ((short) (rand() - (RAND_MAX/2))) >> 2;
    short minus3 = ((short) (rand() - (RAND_MAX/2))) >> 2;
    short plus4 = ((short) (rand() - (RAND_MAX/2))) >> 2;
    short minus4 = ((short) (rand() - (RAND_MAX/2))) >> 2;
    
    input0[i] = plus0 - minus0;
    input1[i] = plus1 - minus1;
    input2[i] = plus2 - minus2;
    input3[i] = plus3 - minus3;
    input4[i] = plus4 - minus4;
    
  }
  printf("16s_add_quad_aligned\n");

  start = clock();
  for(int count = 0; count < ITERS; ++count) {
    volk_16s_add_quad_aligned16_manual(output0, output1, output2, output3, input0, input1, input2, input3, input4, vlen << 1 , "generic");
  }
  end = clock();
  total = (double)(end-start)/(double)CLOCKS_PER_SEC;
  printf("generic_time: %f\n", total);
  start = clock();
  for(int count = 0; count < ITERS; ++count) {
    volk_16s_add_quad_aligned16_manual(output01, output11, output21, output31, input0, input1, input2, input3, input4, vlen << 1 , "sse2");
  }
  end = clock();
  total = (double)(end-start)/(double)CLOCKS_PER_SEC;
  printf("sse2_time: %f\n", total);
  for(int i = 0; i < 1; ++i) {
    //printf("inputs: %d, %d\n", input0[i*2], input0[i*2 + 1]);
    //printf("generic... %d, ssse3... %d\n", output0[i], output1[i]);
  }
  
  for(int i = 0; i < vlen; ++i) {
    //printf("%d...%d\n", output0[i], output01[i]);
    CPPUNIT_ASSERT_EQUAL(output0[i], output01[i]);
    CPPUNIT_ASSERT_EQUAL(output1[i], output11[i]);
    CPPUNIT_ASSERT_EQUAL(output2[i], output21[i]);
    CPPUNIT_ASSERT_EQUAL(output3[i], output31[i]);
  }
}

#endif