#include <iclFixedMatrix.h>
#include <iclStackTimer.h>
using namespace icl;

#define N 1000000



void part_based_bench(){
  FixedMatrix<float,4,4> a( 0,1,2,3,
                            4,5,6,7,
                            8,9,10,11,
                            12,13,14,15);
  FixedMatrix<float,4,4> b(0.0);
  
  {
    BENCHMARK_THIS_FUNCTION;
    for(int i=0;i<N;++i){
      a.part<0,0,4,1>() = b.part<1,0,1,4>(); 
    }
  }
}

void row_col_based_bench(){
  FixedMatrix<float,4,4> a( 0,1,2,3,
                            4,5,6,7,
                            8,9,10,11,
                            12,13,14,15);
  FixedMatrix<float,4,4> b(0.0);
  
  {
    BENCHMARK_THIS_FUNCTION;
    for(int i=0;i<N;++i){
      a.row(0) = b.col(1);
    }
  }
}

void raw_based_bench(){
  FixedMatrix<float,4,4> a( 0,1,2,3,
                            4,5,6,7,
                            8,9,10,11,
                            12,13,14,15);
  FixedMatrix<float,4,4> b(0.0);
  
  {
    BENCHMARK_THIS_FUNCTION;
    for(int i=0;i<N;++i){
      for(int j=0;j<4;++j){
        a.begin()[j] = b.begin()[1+4*j];
      }
    }
  }
}


int main(){
  FixedMatrix<float,4,4> a( -1,1,2,3,
                            4,5,6,7,
                            8,9,10,11,
                            12,13,14,15);
  
  FixedMatrix<float,3,3> b = a.part<1,1,3,3>();
  
  FixedMatrix<int,10,10> c(0.0);
  c.part<0,2,1,4>() = a.row(0);
  

  DEBUG_LOG("1");
  part_based_bench();

  DEBUG_LOG("2");
  raw_based_bench();

  DEBUG_LOG("3");
  row_col_based_bench();
  
  
  
  DEBUG_LOG("b is: \n" << b << "\n");
  DEBUG_LOG("c is: \n" << c << "\n");
  
  
}