#include <unsupported/Eigen/FFT>

#include <iostream>

using namespace std;
using namespace Eigen;

ArrayXXf upsample(const ArrayXXf &in, const unsigned int k) {
  ArrayXXf out = ArrayXXf::Zero(in.rows(), in.cols()*k);
  for(unsigned int i=0; i<in.cols()*k; ++i) {
    out.col(i) = in.col(i/k);
  }
  return out;
}

ArrayXXf mask(const ArrayXXf &in, const ArrayXXf &mask, const float th = 0) {
  ArrayXXf ret = Eigen::ArrayXXf::Zero(in.rows(),in.cols());
  if(in.rows()!=mask.rows() || in.cols()!=mask.cols()) {
    return ret;
  }
  for(int icol=0; icol<in.cols();++icol) {
    auto in_col = in.col(icol);
    auto mask_col = mask.col(icol);
  }
  return (mask>th).select(in, ret);
  // return (mask>th).select(ret, in);
}

int main () {

  ArrayXXf a(3,4);
  ArrayXXf b(3,4);
  
  a << 1,2,3,3,
       4,5,6,6,
       7,8,9,9,
  
  b << 0,1,0,0,
       0,0.5,0,0,
       0,1,0,0;

  cout << upsample(upsample(a, 2),2) << endl;     

  // test mask
  cout << mask(a, b, 0.6) << endl;

  // element access
  cout << a(2, 1) << endl;
  // cout << mask(a, b, 0.6).transpose();

  return 0;
}
