#include "BelosEpetraAdapter.hpp"
#include "BelosEpetraUtils.h"
#include "Ifpack_IlukGraph.h"
#include "Ifpack_CrsRiluk.h"
#include "Epetra_Map.h"
#ifdef EPETRA_MPI
  #include "Epetra_MpiComm.h"
#else
  #include "Epetra_SerialComm.h"
#endif
#include "Epetra_CrsMatrix.h"
#include "Teuchos_StandardCatchMacros.hpp"
#include "Teuchos_Assert.hpp"
int main(int argc, char *argv[]) {
  
  int MyPID = 0;
#ifdef EPETRA_MPI
  
  MPI_Init(&argc,&argv);
#else
#endif
  
  typedef double                            ST;
  typedef SCT::magnitudeType                MT;
bool verbose = false;
bool success = true;
try {
bool proc_verbose = false;
  bool debug = false;
  bool leftprec = true;      
  int frequency = -1;        
  int numrhs = 1;            
  int maxiters = -1;         
  int maxsubspace = 250;     
  int recycle = 50;          
  int maxrestarts = 15;      
  std::string filename("sherman5.hb");
  std::string ortho("IMGS");
  MT tol = 1.0e-10;          
  cmdp.
setOption(
"verbose",
"quiet",&verbose,
"Print messages and results.");
  cmdp.
setOption(
"debug",
"nondebug",&debug, 
"Print debugging information from solver.");
  cmdp.
setOption(
"left-prec",
"right-prec",&leftprec,
"Left preconditioning or right.");
  cmdp.
setOption(
"frequency",&frequency,
"Solvers frequency for printing residuals (#iters).");
  cmdp.
setOption(
"filename",&filename,
"Filename for test matrix.  Acceptable file extensions: *.hb,*.mtx,*.triU,*.triS");
  cmdp.
setOption(
"tol",&tol,
"Relative residual tolerance used by GMRES solver.");
  cmdp.
setOption(
"num-rhs",&numrhs,
"Number of right-hand sides to be solved for.");
  cmdp.
setOption(
"max-iters",&maxiters,
"Maximum number of iterations per linear system (-1 = adapted to problem/block size).");
  cmdp.
setOption(
"max-subspace",&maxsubspace,
"Maximum number of blocks the solver can use for the subspace.");
  cmdp.
setOption(
"recycle",&recycle,
"Number of vectors in recycle space.");
  cmdp.
setOption(
"max-cycles",&maxrestarts,
"Maximum number of cycles allowed for GCRO-DR solver.");
  cmdp.
setOption(
"ortho-type",&ortho,
"Orthogonalization type. Must be one of DGKS, ICGS, IMGS.");
    return -1;
  }
  if (!verbose)
    frequency = -1;  
  
  
  
  RCP<Epetra_CrsMatrix> A;
  RCP<Epetra_MultiVector> B, X;
  int return_val =Belos::Util::createEpetraProblem(filename,NULL,&A,NULL,NULL,&MyPID);
  if(return_val != 0) return return_val;
  proc_verbose = verbose && (MyPID==0); 
  X->Random();
  OPT::Apply( *A, *X, *B );
  X->PutScalar( 0.0 );
  
  
  
  if (proc_verbose) std::cout << std::endl << std::endl;
  if (proc_verbose) std::cout << "Constructing ILU preconditioner" << std::endl;
  int Lfill = 2;
  if (proc_verbose) std::cout << "Using Lfill = " << Lfill << std::endl;
  int Overlap = 2;
  if (proc_verbose) std::cout << "Using Level Overlap = " << Overlap << std::endl;
  double Athresh = 0.0;
  if (proc_verbose) std::cout << "Using Absolute Threshold Value of " << Athresh << std::endl;
  double Rthresh = 1.0;
  if (proc_verbose) std::cout << "Using Relative Threshold Value of " << Rthresh << std::endl;
  
  
  ilukGraph = 
Teuchos::rcp(
new Ifpack_IlukGraph(A->Graph(), Lfill, Overlap));
  int info = ilukGraph->ConstructFilledGraph();
  ilukFactors = 
Teuchos::rcp(
new Ifpack_CrsRiluk(*ilukGraph));
  int initerr = ilukFactors->InitValues(*A);
  if (initerr != 0) std::cout << "InitValues error = " << initerr;
  info = ilukFactors->Factor();
  bool transA = false;
  double Cond_Est;
  ilukFactors->Condest(transA, Cond_Est);
  if (proc_verbose) {
    std::cout << "Condition number estimate for this preconditoner = " << Cond_Est << std::endl;
    std::cout << std::endl;
  }
  
  
  
  RCP<Belos::EpetraPrecOp> belosPrec = 
rcp( 
new Belos::EpetraPrecOp( ilukFactors ) );
  
  
  
  
  const int NumGlobalElements = B->GlobalLength();
  if (maxiters == -1)
    maxiters = NumGlobalElements - 1; 
  
  ParameterList belosList;
  belosList.set( "Num Blocks", maxsubspace );            
  belosList.set( "Maximum Iterations", maxiters );       
  belosList.set( "Maximum Restarts", maxrestarts );      
  belosList.set( "Convergence Tolerance", tol );         
  belosList.set( "Num Recycled Blocks", recycle );       
  belosList.set( "Orthogonalization", ortho );           
  if (numrhs > 1) {
    belosList.set( "Show Maximum Residual Norm Only", true );  
  }
  if (verbose) {
    if (frequency > 0)
      belosList.set( "Output Frequency", frequency );
  }
  if (debug) {
  }
  belosList.set( "Verbosity", verbosity );
  
  
  
  RCP<Belos::LinearProblem<double,MV,OP> > problem
  if (leftprec) {
    problem->setLeftPrec( belosPrec );
  }
  else {
    problem->setRightPrec( belosPrec );
  }
  bool set = problem->setProblem();
  if (set == false) {
    if (proc_verbose)
      std::cout << std::endl << "ERROR:  Belos::LinearProblem failed to set up correctly!" << std::endl;
    return -1;
  }
  
  RCP< Belos::SolverManager<double,MV,OP> > solver
  
  
  
  
  
  if (proc_verbose) {
    std::cout << std::endl << std::endl;
    std::cout << "Dimension of matrix: " << NumGlobalElements << std::endl;
    std::cout << "Number of right-hand sides: " << numrhs << std::endl;
    std::cout << "Number of restarts allowed: " << maxrestarts << std::endl;
    std::cout << "Max number of Gmres iterations per restart cycle: " << maxiters << std::endl;
    std::cout << "Relative residual tolerance: " << tol << std::endl;
    std::cout << std::endl;
  }
  
  
  
  
  
  
  bool badRes = false;
  std::vector<double> actual_resids( numrhs );
  std::vector<double> rhs_norm( numrhs );
  OPT::Apply( *A, *X, resid );
  MVT::MvAddMv( -1.0, resid, 1.0, *B, resid );
  MVT::MvNorm( resid, actual_resids );
  MVT::MvNorm( *B, rhs_norm );
  if (proc_verbose) {
    std::cout<< "---------- Actual Residuals (normalized) ----------"<<std::endl<<std::endl;
    for ( int i=0; i<numrhs; i++) {
      double actRes = actual_resids[i]/rhs_norm[i];
      std::cout<<"Problem "<<i<<" : \t"<< actRes <<std::endl;
      if (actRes > tol) badRes = true;
    }
  }
  success = false;
  if (proc_verbose)
    std::cout << std::endl << "ERROR:  Belos did not converge!" << std::endl;
} else {
  success = true;
  if (proc_verbose)
    std::cout << std::endl << "SUCCESS:  Belos converged!" << std::endl;
}
}
#ifdef EPETRA_MPI
MPI_Finalize();
#endif
return success ? EXIT_SUCCESS : EXIT_FAILURE;
}