#include <gtest/gtest.h>
#include <vector>

#include "TestUtility.h"

#include "Matrix.h"
#include "Function.h"
#include "Function1D.h"
#include "Function2D.h"
#include "Function3D.h"


class Function2D_Test: public ::testing::Test{
protected:
    static void SetUpFunctionTester(){

    }
    static void TearDownTestCase(){
    }
    void SetUp(){
    }
    void TearDown(){
    }
};

TEST_F(Function2D_Test, immse){
    double *dataA = new double[9]{1,2,3,4,5,6,7,8,9};
    double *dataB = new double[9]{10,20,30,40,50,40,30,20,10};
    Aurora::Matrix A = Aurora::Matrix::fromRawData(dataA,3,3);
    Aurora::Matrix B = Aurora::Matrix::fromRawData(dataB,3,3);
    double v = immse(A,B);
    EXPECT_DOUBLE_EQ(fourDecimalRound(v),698.3333)<<" immse error;";
}

TEST_F(Function2D_Test, inv){
    //默认是column major排布数据
    double *dataA=new double[9]{2, 0, 2, 2, 3, 0, 3, 3, 3};
    double *dataB=new double[9]{1, 1, 1, 1, 1, 1, 1, 1, 1};
    Aurora::Matrix A = Aurora::Matrix::fromRawData(dataA,3,3);
    Aurora::Matrix B = Aurora::Matrix::fromRawData(dataB,3,3);
    auto invA = Aurora::inv(A);
    double* result = invA.getData();
    EXPECT_DOUBLE_EQ(0.75, fourDecimalRound(result[0]));
    EXPECT_DOUBLE_EQ(0.5, fourDecimalRound(result[1]));
    EXPECT_DOUBLE_EQ(-0.5, fourDecimalRound(result[2]));
    EXPECT_DOUBLE_EQ(-0.5, fourDecimalRound(result[3]));
    EXPECT_DOUBLE_EQ(.0, fourDecimalRound(result[4]));
    EXPECT_DOUBLE_EQ(0.3333, fourDecimalRound(result[5]));
    EXPECT_DOUBLE_EQ(-0.25, fourDecimalRound(result[6]));
    EXPECT_DOUBLE_EQ(-0.5, fourDecimalRound(result[7]));
    EXPECT_DOUBLE_EQ(0.5, fourDecimalRound(result[8]));
    invA = Aurora::inv(A*B);
    result = invA.getData();
    EXPECT_DOUBLE_EQ(0.75, fourDecimalRound(result[0]));
    EXPECT_DOUBLE_EQ(0.5, fourDecimalRound(result[1]));
    EXPECT_DOUBLE_EQ(-0.5, fourDecimalRound(result[2]));
    EXPECT_DOUBLE_EQ(-0.5, fourDecimalRound(result[3]));
    EXPECT_DOUBLE_EQ(.0, fourDecimalRound(result[4]));
    EXPECT_DOUBLE_EQ(0.3333, fourDecimalRound(result[5]));
    EXPECT_DOUBLE_EQ(-0.25, fourDecimalRound(result[6]));
    EXPECT_DOUBLE_EQ(-0.5, fourDecimalRound(result[7]));
    EXPECT_DOUBLE_EQ(0.5, fourDecimalRound(result[8]));
}

TEST_F(Function2D_Test, std){
    double *dataMA=  new double [9]{1, 2, 3, 2, 2, 6, 3, 3, 6};
    auto A = Aurora::Matrix::fromRawData(dataMA,3,3);
    auto D= Aurora::std(A);
    double* resultStd = D.getData();
    EXPECT_DOUBLE_EQ(1.0, resultStd[0]);
    EXPECT_DOUBLE_EQ(2.3094, fourDecimalRound(resultStd[1]));
    EXPECT_DOUBLE_EQ(1.7321, fourDecimalRound(resultStd[2]));

}

TEST_F(Function2D_Test, fftAndComplexAndIfft){
//    double input[10]{1,1,0,2,2,0,1,1,0,2};
//    std::complex<double>* complexInput = Aurora::complex(10,input);
//    //复数化后，实部不变，虚部全为0
//    EXPECT_DOUBLE_EQ(complexInput[1].real(),1.0)<<" complex error";
//    EXPECT_DOUBLE_EQ(complexInput[1].imag(),0)<<" complex error";
//    std::complex<double>* result = Aurora::fft(10,complexInput);
//    delete [] complexInput;
//    //检验fft结果与matlab是否对应
//    EXPECT_DOUBLE_EQ(0.0729, fourDecimalRound(result[1].real()))<<" fft result value error";
//    EXPECT_DOUBLE_EQ(2.4899, fourDecimalRound(result[2].imag()))<<" fft result value error";
//    //检验fft的结果是否共轭
//    EXPECT_DOUBLE_EQ(0, result[4].imag()+result[6].imag())<<" fft result conjugate error";
//    EXPECT_DOUBLE_EQ(0, result[4].real()-result[6].real())<<" fft result conjugate error";
//    std::complex<double>* ifftResult = Aurora::ifft(10,result);
//    EXPECT_DOUBLE_EQ(fourDecimalRound(ifftResult[1].real()),1.0)<<" ifft result real value error";
//    EXPECT_DOUBLE_EQ(fourDecimalRound(ifftResult[1].imag()),0)<<" ifft result imag value error";
//    delete [] result;
//    delete [] ifftResult;
}

TEST_F(Function2D_Test, hilbert) {
    double input[10]{1,1,0,2,2,0,1,1,0,2};
    auto result = Aurora::hilbert(10,input);
    EXPECT_DOUBLE_EQ(fourDecimalRound(result[1].real()),1.0)<<" hilbert result real value error";
    EXPECT_DOUBLE_EQ(fourDecimalRound(result[1].imag()),0.3249)<<" hilbert result imag value error";
    delete [] result;
    result = Aurora::hilbert(9,input);
    EXPECT_DOUBLE_EQ(fourDecimalRound(result[1].real()),1.0)<<" hilbert result real value error";
    EXPECT_DOUBLE_EQ(fourDecimalRound(result[1].imag()),0.4253)<<" hilbert result imag value error";
}

TEST_F(Function2D_Test, interp2) {
    double* xD= new double[4]{1,2,3,4};
    Aurora::Matrix x(std::shared_ptr<double>(xD,std::default_delete<double[]>()),std::vector<int>{4});
    double* yD= new double[5]{1,4,9,16,25};
    Aurora::Matrix y(std::shared_ptr<double>(yD,std::default_delete<double[]>()),std::vector<int>{5});
    double* x1D= new double[3]{1.22,2.69,3.84};
    Aurora::Matrix x1(std::shared_ptr<double>(x1D,std::default_delete<double[]>()),std::vector<int>{3});
    double* y1D= new double[3]{4.5823,10.552,18};
    Aurora::Matrix y1(std::shared_ptr<double>(y1D,std::default_delete<double[]>()),std::vector<int>{3});
    double* vD= new double[20]{158,256,332,428,22,56,487,54,26,333,541,554,445,48,22,54,36,98,11,25};
    Aurora::Matrix v(std::shared_ptr<double>(vD,std::default_delete<double[]>()),std::vector<int>{5,4});

    Aurora::Matrix result = interp2(x,y,v,x1,y1,Aurora::InterpnMethod::Spline);
    EXPECT_DOUBLE_AE(result.getData()[0],303.5663);
    EXPECT_DOUBLE_AE(result.getData()[1],243.6711);
    EXPECT_DOUBLE_AE(result.getData()[2],-47.32);

    result = interp2(x,y,v,x1,y1,Aurora::InterpnMethod::Linear);
    EXPECT_DOUBLE_AE(result.getData()[0],302.6298);
    EXPECT_DOUBLE_AE(result.getData()[1],261.1313);
    EXPECT_DOUBLE_AE(result.getData()[2],18.6089);
}

TEST_F(Function2D_Test, interp3) {
    double* xD= new double[4]{1,2,3,4};
    Aurora::Matrix x(std::shared_ptr<double>(xD,std::default_delete<double[]>()),std::vector<int>{4});
    double* yD= new double[5]{1,4,9,16,25};
    Aurora::Matrix y(std::shared_ptr<double>(yD,std::default_delete<double[]>()),std::vector<int>{5});
    double* zD= new double[3]{22,33,56};
    Aurora::Matrix z(std::shared_ptr<double>(zD,std::default_delete<double[]>()),std::vector<int>{3});
    double* x1D= new double[3]{1.22,2.69,3.84};
    Aurora::Matrix x1(std::shared_ptr<double>(x1D,std::default_delete<double[]>()),std::vector<int>{3});
    double* y1D= new double[3]{4.5823,10.552,18};
    Aurora::Matrix y1(std::shared_ptr<double>(y1D,std::default_delete<double[]>()),std::vector<int>{3});
    double* z1D= new double[3]{22.256,40.22,48};
    Aurora::Matrix z1(std::shared_ptr<double>(z1D,std::default_delete<double[]>()),std::vector<int>{3});
    double* vD= new double[60]{158,256,332,428,22,56,487,54,26,333,541,554,445,48,22,54,36,98,11,25,
                               158,256,332,428,22,56,487,54,26,333,541,554,445,48,22,54,36,98,11,25,
                               158,256,332,428,22,56,487,54,26,333,541,554,445,48,22,54,36,98,11,25};
    Aurora::Matrix v(std::shared_ptr<double>(vD,std::default_delete<double[]>()),std::vector<int>{5,4,3});

    Aurora::Matrix result = interp3(x,y,z,v,x1,y1,z1,Aurora::InterpnMethod::Spline);
    EXPECT_DOUBLE_AE(result.getData()[0],303.5663);
    EXPECT_DOUBLE_AE(result.getData()[1],243.6711);
    EXPECT_DOUBLE_AE(result.getData()[2],-47.32);

    result = interp3(x,y,z,v,x1,y1,z1,Aurora::InterpnMethod::Linear);
    EXPECT_DOUBLE_AE(result.getData()[0],302.6298);
    EXPECT_DOUBLE_AE(result.getData()[1],261.1313);
    EXPECT_DOUBLE_AE(result.getData()[2],18.6089);
}

TEST_F(Function2D_Test, interpn) {
    double* xD= new double[4]{1,2,3,4};
    Aurora::Matrix x(std::shared_ptr<double>(xD,std::default_delete<double[]>()),std::vector<int>{4});
    double* yD= new double[5]{1,4,9,16,25};
    Aurora::Matrix y(std::shared_ptr<double>(yD,std::default_delete<double[]>()),std::vector<int>{5});
    double* zD= new double[3]{22,33,56};
    Aurora::Matrix z(std::shared_ptr<double>(zD,std::default_delete<double[]>()),std::vector<int>{3});
    double* x1D= new double[3]{1.22,2.69,3.84};
    Aurora::Matrix x1(std::shared_ptr<double>(x1D,std::default_delete<double[]>()),std::vector<int>{3});
    double* y1D= new double[3]{2.5823,3.552,3.888};
    Aurora::Matrix y1(std::shared_ptr<double>(y1D,std::default_delete<double[]>()),std::vector<int>{3});
    double* z1D= new double[3]{22.256,40.22,48};
    Aurora::Matrix z1(std::shared_ptr<double>(z1D,std::default_delete<double[]>()),std::vector<int>{3});
    double* v2D= new double[20]{158,256,332,428,22,56,487,54,26,333,541,554,445,48,22,54,36,98,11,25};
    Aurora::Matrix v2(std::shared_ptr<double>(v2D,std::default_delete<double[]>()),std::vector<int>{5,4});
    double* v3D= new double[60]{158,256,332,428,22,56,487,54,26,333,541,554,445,48,22,54,36,98,11,25,
                               158,256,332,428,22,56,487,54,26,333,541,554,445,48,22,54,36,98,11,25,
                               158,256,332,428,22,56,487,54,26,333,541,554,445,48,22,54,36,98,11,25};
    Aurora::Matrix v3(std::shared_ptr<double>(v3D,std::default_delete<double[]>()),std::vector<int>{5,4,3});

    Aurora::Matrix result = interpn(y,x,v2,x1,y1,Aurora::InterpnMethod::Spline);
    EXPECT_DOUBLE_AE(result.getData()[0],399.2742);
    EXPECT_DOUBLE_AE(result.getData()[1],387.7651);
    EXPECT_DOUBLE_AE(result.getData()[2],135.6138);

    result = interpn(y,x,v2,x1,y1,Aurora::InterpnMethod::Linear);
    EXPECT_DOUBLE_AE(result.getData()[0],352.1727);
    EXPECT_DOUBLE_AE(result.getData()[1],269.8596);
    EXPECT_DOUBLE_AE(result.getData()[2],94.7908);

    result = interpn(y,x,z,v3,x1,y1,z1,Aurora::InterpnMethod::Spline);
    EXPECT_DOUBLE_AE(result.getData()[0],399.2742);
    EXPECT_DOUBLE_AE(result.getData()[1],387.7651);
    EXPECT_DOUBLE_AE(result.getData()[2],135.6138);

    result = interpn(y,x,z,v3,x1,y1,z1,Aurora::InterpnMethod::Linear);
    EXPECT_DOUBLE_AE(result.getData()[0],352.1727);
    EXPECT_DOUBLE_AE(result.getData()[1],269.8596);
    EXPECT_DOUBLE_AE(result.getData()[2],94.7908);
}