// -*- c++ -*-
#ifndef LEMON_LP_SOLVER_WRAPPER_H
#define LEMON_LP_SOLVER_WRAPPER_H

///\ingroup misc
///\file
///\brief Dijkstra algorithm.

// #include <stdio.h>
#include <stdlib.h>
// #include <stdio>
//#include <stdlib>
extern "C" {
#include "glpk.h"
}

#include <iostream>
#include <vector>
#include <string>
#include <list>
#include <memory>
#include <utility>

//#include <sage_graph.h>
//#include <lemon/list_graph.h>
//#include <lemon/graph_wrapper.h>
#include <lemon/invalid.h>
//#include <bfs_dfs.h>
//#include <stp.h>
//#include <lemon/max_flow.h>
//#include <augmenting_flow.h>
//#include <iter_map.h>

using std::cout;
using std::cin;
using std::endl;

namespace lemon {

  
  /// \addtogroup misc
  /// @{

  /// \brief A partitioned vector with iterable classes.
  ///
  /// This class implements a container in which the data is stored in an 
  /// stl vector, the range is partitioned into sets and each set is 
  /// doubly linked in a list. 
  /// That is, each class is iterable by lemon iterators, and any member of 
  /// the vector can bo moved to an other class.
  template <typename T>
  class IterablePartition {
  protected:
    struct Node {
      T data;
      int prev; //invalid az -1
      int next; 
    };
    std::vector<Node> nodes;
    struct Tip {
      int first;
      int last;
    };
    std::vector<Tip> tips;
  public:
    /// The classes are indexed by integers from \c 0 to \c classNum()-1.
    int classNum() const { return tips.size(); }
    /// This lemon style iterator iterates through a class. 
    class ClassIt;
    /// Constructor. The number of classes is to be given which is fixed 
    /// over the life of the container. 
    /// The partition classes are indexed from 0 to class_num-1. 
    IterablePartition(int class_num) { 
      for (int i=0; i<class_num; ++i) {
	Tip t;
	t.first=t.last=-1;
	tips.push_back(t);
      }
    }
  protected:
    void befuz(ClassIt it, int class_id) {
      if (tips[class_id].first==-1) {
	if (tips[class_id].last==-1) {
	  nodes[it.i].prev=nodes[it.i].next=-1;
	  tips[class_id].first=tips[class_id].last=it.i;
	}
      } else {
	nodes[it.i].prev=tips[class_id].last;
	nodes[it.i].next=-1;
	nodes[tips[class_id].last].next=it.i;
	tips[class_id].last=it.i;
      }
    }
    void kifuz(ClassIt it, int class_id) {
      if (tips[class_id].first==it.i) {
	if (tips[class_id].last==it.i) {
	  tips[class_id].first=tips[class_id].last=-1;
	} else {
	  tips[class_id].first=nodes[it.i].next;
	  nodes[nodes[it.i].next].prev=-1;
	}
      } else {
	if (tips[class_id].last==it.i) {
	  tips[class_id].last=nodes[it.i].prev;
	  nodes[nodes[it.i].prev].next=-1;
	} else {
	  nodes[nodes[it.i].next].prev=nodes[it.i].prev;
	  nodes[nodes[it.i].prev].next=nodes[it.i].next;
	}
      }
    }
  public:
    /// A new element with data \c t is pushed into the vector and into class 
    /// \c class_id.
    ClassIt push_back(const T& t, int class_id) { 
      Node n;
      n.data=t;
      nodes.push_back(n);
      int i=nodes.size()-1;
      befuz(i, class_id);
      return i;
    }
    /// A member is moved to an other class.
    void set(ClassIt it, int old_class_id, int new_class_id) {
      kifuz(it.i, old_class_id);
      befuz(it.i, new_class_id);
    }
    /// Returns the data pointed by \c it.
    T& operator[](ClassIt it) { return nodes[it.i].data; }
    /// Returns the data pointed by \c it.
    const T& operator[](ClassIt it) const { return nodes[it.i].data; }
    ///.
    class ClassIt {
      friend class IterablePartition;
    protected:
      int i;
    public:
      /// Default constructor.
      ClassIt() { }
      /// This constructor constructs an iterator which points
      /// to the member of th container indexed by the integer _i.
      ClassIt(const int& _i) : i(_i) { }
      /// Invalid constructor.
      ClassIt(const Invalid&) : i(-1) { }
    };
    /// First member of class \c class_id.
    ClassIt& first(ClassIt& it, int class_id) const {
      it.i=tips[class_id].first;
      return it;
    }
    /// Next member.
    ClassIt& next(ClassIt& it) const {
      it.i=nodes[it.i].next;
      return it;
    }
    /// True iff the iterator is valid.
    bool valid(const ClassIt& it) const { return it.i!=-1; }
  };

  /*! \e
   */
  template <typename _Value>
  class LPSolverBase {
  public:
    /// \e
    typedef _Value Value;
    /// \e
    typedef IterablePartition<int>::ClassIt RowIt;
    /// \e
    typedef IterablePartition<int>::ClassIt ColIt;
  public:
    /// \e
    IterablePartition<int> row_iter_map;
    /// \e
    IterablePartition<int> col_iter_map;
    /// \e
    const int VALID_CLASS;
    /// \e
    const int INVALID_CLASS;
  public:
    /// \e
    LPSolverBase() : row_iter_map(2), 
		     col_iter_map(2), 
		     VALID_CLASS(0), INVALID_CLASS(1) { }
    /// \e
    virtual ~LPSolverBase() { }
    /// \e
    virtual void setMinimize() = 0;
    /// \e
    virtual void setMaximize() = 0;
  protected:
    /// \e
    virtual int _addRow() = 0;
    /// \e
    virtual int _addCol() = 0;
  public:
    /// \e
    RowIt addRow() {
      int i=_addRow(); 
      RowIt row_it;
      row_iter_map.first(row_it, INVALID_CLASS);
      if (row_iter_map.valid(row_it)) { //van hasznalhato hely
	row_iter_map.set(row_it, INVALID_CLASS, VALID_CLASS);
	row_iter_map[row_it]=i;
      } else { //a cucc vegere kell inzertalni mert nincs szabad hely
	row_it=row_iter_map.push_back(i, VALID_CLASS);
      }
      return row_it;
    }
    /// \e
    ColIt addCol() {
      int i=_addCol();  
      ColIt col_it;
      col_iter_map.first(col_it, INVALID_CLASS);
      if (col_iter_map.valid(col_it)) { //van hasznalhato hely
	col_iter_map.set(col_it, INVALID_CLASS, VALID_CLASS);
	col_iter_map[col_it]=i;
      } else { //a cucc vegere kell inzertalni mert nincs szabad hely
	col_it=col_iter_map.push_back(i, VALID_CLASS);
      }
      return col_it;
    }
    /// \e
    virtual void setRowCoeffs(int i, 
			      std::vector<std::pair<int, double> > coeffs) = 0;
    /// \e
    virtual void setColCoeffs(int i, 
			      std::vector<std::pair<int, double> > coeffs) = 0;
    /// \e
    template <typename Begin, typename End>
    void setRowCoeffs(RowIt row_it, Begin begin, End end) {
      std::vector<std::pair<int, double> > coeffs;
      for ( ; begin!=end; ++begin) {
	coeffs.push_back(std::
			 make_pair(col_iter_map[begin->first], begin->second));
      }
      setRowCoeffs(row_iter_map[row_it], coeffs);
    }
    /// \e
    template <typename Begin, typename End>
    void setColCoeffs(ColIt col_it, Begin begin, End end) {
      std::vector<std::pair<int, double> > coeffs;
      for ( ; begin!=end; ++begin) {
	coeffs.push_back(std::
			 make_pair(row_iter_map[begin->first], begin->second));
      }
      setColCoeffs(col_iter_map[col_it], coeffs);
    }
    /// temporally, glpk style indexing
    //virtual void setRowCoeffs(RowIt row_it, int num, 
    //		      int* indices, _Value* doubles) = 0;
    //pair<RowIt, _Value>-bol kell megadni egy std range-et
    /// \e
    //    virtual void seColCoeffs(int i, 
    //			      std::vector<std::pair<int, double> > coeffs) = 0;
    /// \e
//     template <typename Begin, typename End>
//     void setRowCoeffs(RowIt row_it, Begin begin, End end) {
//       int mem_length=1+colNum();
//       int* indices = new int[mem_length];
//       _Value* doubles = new _Value[mem_length];
//       int length=0;
//       for ( ; begin!=end; ++begin) {
// 	++length;
// 	indices[length]=col_iter_map[begin->first];
// 	doubles[length]=begin->second;
//       }
//       setRowCoeffs(row_it, length, indices, doubles);
//       delete [] indices;
//       delete [] doubles;
//     } 
    /// temporally, glpk style indexing
    //virtual void setColCoeffs(ColIt col_it, int num, 
    //			      int* indices, _Value* doubles) = 0;
    //pair<ColIt, _Value>-bol kell megadni egy std range-et
    /// \e
//     template <typename Begin, typename End>
//     void setColCoeffs(ColIt col_it, Begin begin, End end) {
//       int mem_length=1+rowNum();
//       int* indices = new int[mem_length];
//       _Value* doubles = new _Value[mem_length];
//       int length=0;
//       for ( ; begin!=end; ++begin) {
// 	++length;
// 	indices[length]=row_iter_map[begin->first];
// 	doubles[length]=begin->second;
//       }
//       setColCoeffs(col_it, length, indices, doubles);
//       delete [] indices;
//       delete [] doubles;
//     }
  protected:
    /// \e
    virtual void _eraseCol(int i) = 0;
    /// \e
    virtual void _eraseRow(int i) = 0;
  public:
    /// \e
    void eraseCol(const ColIt& col_it) {
      col_iter_map.set(col_it, VALID_CLASS, INVALID_CLASS);
      int cols[2];
      cols[1]=col_iter_map[col_it];
      _eraseCol(cols[1]);
      col_iter_map[col_it]=0; //glpk specifikus, de kell ez??
      ColIt it;
      for (col_iter_map.first(it, VALID_CLASS); 
	   col_iter_map.valid(it); col_iter_map.next(it)) {
	if (col_iter_map[it]>cols[1]) --col_iter_map[it];
      }
    }
    /// \e
    void eraseRow(const RowIt& row_it) {
      row_iter_map.set(row_it, VALID_CLASS, INVALID_CLASS);
      int rows[2];
      rows[1]=row_iter_map[row_it];
      _eraseRow(rows[1]);
      row_iter_map[row_it]=0; //glpk specifikus, de kell ez??
      RowIt it;
      for (row_iter_map.first(it, VALID_CLASS); 
	   row_iter_map.valid(it); row_iter_map.next(it)) {
	if (row_iter_map[it]>rows[1]) --row_iter_map[it];
      }
    }
    /// \e
    virtual void setColBounds(const ColIt& col_it, int bound_type, 
			      _Value lo, _Value up) =0; 
    /// \e
    virtual _Value getObjCoef(const ColIt& col_it) = 0;
    /// \e
    virtual void setRowBounds(const RowIt& row_it, int bound_type, 
			      _Value lo, _Value up) = 0;
    /// \e
    virtual void setObjCoef(const ColIt& col_it, _Value obj_coef) = 0;
    /// \e
    virtual void solveSimplex() = 0;
    /// \e
    virtual void solvePrimalSimplex() = 0;
    /// \e
    virtual void solveDualSimplex() = 0;
    /// \e
    virtual _Value getPrimal(const ColIt& col_it) = 0;
    /// \e
    virtual _Value getObjVal() = 0;
    /// \e
    virtual int rowNum() const = 0;
    /// \e
    virtual int colNum() const = 0;
    /// \e
    virtual int warmUp() = 0;
    /// \e
    virtual void printWarmUpStatus(int i) = 0;
    /// \e
    virtual int getPrimalStatus() = 0;
    /// \e
    virtual void printPrimalStatus(int i) = 0;
    /// \e
    virtual int getDualStatus() = 0;
    /// \e
    virtual void printDualStatus(int i) = 0;
    /// Returns the status of the slack variable assigned to row \c row_it.
    virtual int getRowStat(const RowIt& row_it) = 0;
    /// \e
    virtual void printRowStatus(int i) = 0;
    /// Returns the status of the variable assigned to column \c col_it.
    virtual int getColStat(const ColIt& col_it) = 0;
    /// \e
    virtual void printColStatus(int i) = 0;
  };
  

  /// \brief Wrappers for LP solvers
  /// 
  /// This class implements a lemon wrapper for glpk.
  /// Later other LP-solvers will be wrapped into lemon.
  /// The aim of this class is to give a general surface to different 
  /// solvers, i.e. it makes possible to write algorithms using LP's, 
  /// in which the solver can be changed to an other one easily.
  class LPSolverWrapper : public LPSolverBase<double> {
  public:
    typedef LPSolverBase<double> Parent;

  public:
    /// \e
    LPX* lp;

  public:
    /// \e
    LPSolverWrapper() : Parent(), 
			lp(lpx_create_prob()) {
      lpx_set_int_parm(lp, LPX_K_DUAL, 1);
    }
    /// \e
    ~LPSolverWrapper() {
      lpx_delete_prob(lp);
    }
    /// \e
    void setMinimize() { 
      lpx_set_obj_dir(lp, LPX_MIN);
    }
    /// \e
    void setMaximize() { 
      lpx_set_obj_dir(lp, LPX_MAX);
    }
  protected:
    /// \e
    int _addCol() { 
      return lpx_add_cols(lp, 1);
    }
    /// \e
    int _addRow() { 
      return lpx_add_rows(lp, 1);
    }
  public:
    using Parent::setRowCoeffs;
    /// \e
    virtual void setRowCoeffs(int i, 
			      std::vector<std::pair<int, double> > coeffs) {
      int mem_length=1+colNum();
      int* indices = new int[mem_length];
      double* doubles = new double[mem_length];
      int length=0;
      for (std::vector<std::pair<int, double> >::
	     const_iterator it=coeffs.begin(); it!=coeffs.end(); ++it) {
	++length;
	indices[length]=it->first;
	doubles[length]=it->second;
	std::cout << "  " << indices[length] << " " 
		  << doubles[length] << std::endl;
      }
      std::cout << i << " " << length << std::endl;
      lpx_set_mat_row(lp, i, length, indices, doubles);
      delete [] indices;
      delete [] doubles;
    }
    /// \e
    virtual void setColCoeffs(int i, 
			      std::vector<std::pair<int, double> > coeffs) {
      int mem_length=1+rowNum();
      int* indices = new int[mem_length];
      double* doubles = new double[mem_length];
      int length=0;
      for (std::vector<std::pair<int, double> >::
	     const_iterator it=coeffs.begin(); it!=coeffs.end(); ++it) {
	++length;
	indices[length]=it->first;
	doubles[length]=it->second;
      }
      lpx_set_mat_col(lp, i, length, indices, doubles);
      delete [] indices;
      delete [] doubles;
    }
//     /// \e
//     /// temporally, glpk style indexing
//     virtual void setRowCoeffs(RowIt row_it, int num, 
// 			      int* indices, _Value* doubles) = 0;
//     //pair<RowIt, _Value>-bol kell megadni egy std range-et
//     /// \e
//     template <typename Begin, typename End>
//     void setRowCoeffs(RowIt row_it, Begin begin, End end) {
//       int mem_length=1+colNum();
//       int* indices = new int[mem_length];
//       _Value* doubles = new _Value[mem_length];
//       int length=0;
//       for ( ; begin!=end; ++begin) {
// 	++length;
// 	indices[length]=col_iter_map[begin->first];
// 	doubles[length]=begin->second;
//       }
//       setRowCoeffs(row_it, length, indices, doubles);
//       delete [] indices;
//       delete [] doubles;
//     }
//     void setRowCoeffs(RowIt row_it, int length, 
// 		      int* indices, double* doubles) {
//       lpx_set_mat_row(lp, row_iter_map[row_it], length, indices, doubles);
//     }
//     using Parent::setColCoeffs;
//     void setColCoeffs(ColIt col_it, int length, 
// 		      int* indices, double* doubles) {
//       lpx_set_mat_col(lp, col_iter_map[col_it], length, indices, doubles);
//     }
    //     //pair<RowIt, double>-bol kell megadni egy std range-et
    //     /// \e
    //     template <typename Begin, typename End>
    //     void setColCoeffs(const ColIt& col_it, 
    // 		      Begin begin, End end) {
    //       int mem_length=1+lpx_get_num_rows(lp);
    //       int* indices = new int[mem_length];
    //       double* doubles = new double[mem_length];
    //       int length=0;
    //       for ( ; begin!=end; ++begin) {
    // 	++length;
    // 	indices[length]=row_iter_map[begin->first];
    // 	doubles[length]=begin->second;
    //       }
    //       lpx_set_mat_col(lp, col_iter_map[col_it], length, indices, doubles);
    //       delete [] indices;
    //       delete [] doubles;
    //     }
    //     //pair<ColIt, double>-bol kell megadni egy std range-et
    //     /// \e
    //     template <typename Begin, typename End>
    //     void setRowCoeffs(const RowIt& row_it, 
    // 		      Begin begin, End end) {
    //       int mem_length=1+lpx_get_num_cols(lp);
    //       int* indices = new int[mem_length];
    //       double* doubles = new double[mem_length];
    //       int length=0;
    //       for ( ; begin!=end; ++begin) {
    // 	++length;
    // 	indices[length]=col_iter_map[begin->first];
    // 	doubles[length]=begin->second;
    //       }
    //       lpx_set_mat_row(lp, row_iter_map[row_it], length, indices, doubles);
    //       delete [] indices;
    //       delete [] doubles;
    //     }
    /// \e
  protected:
    virtual void _eraseCol(int i) {
      int cols[2];
      cols[1]=i;
      lpx_del_cols(lp, 1, cols);
    }
    virtual void _eraseRow(int i) {
      int rows[2];
      rows[1]=i;
      lpx_del_rows(lp, 1, rows);
    }
  public:
    /// \e
    void setColBounds(const ColIt& col_it, int bound_type, 
		      double lo, double up) {
      lpx_set_col_bnds(lp, col_iter_map[col_it], bound_type, lo, up);
    }
    /// \e
    double getObjCoef(const ColIt& col_it) { 
      return lpx_get_obj_coef(lp, col_iter_map[col_it]);
    }
    /// \e
    void setRowBounds(const RowIt& row_it, int bound_type, 
		      double lo, double up) {
      lpx_set_row_bnds(lp, row_iter_map[row_it], bound_type, lo, up);
    }
    /// \e
    void setObjCoef(const ColIt& col_it, double obj_coef) { 
      lpx_set_obj_coef(lp, col_iter_map[col_it], obj_coef);
    }
    /// \e
    void solveSimplex() { lpx_simplex(lp); }
    /// \e
    void solvePrimalSimplex() { lpx_simplex(lp); }
    /// \e
    void solveDualSimplex() { lpx_simplex(lp); }
    /// \e
    double getPrimal(const ColIt& col_it) {
      return lpx_get_col_prim(lp, col_iter_map[col_it]);
    }
    /// \e
    double getObjVal() { return lpx_get_obj_val(lp); }
    /// \e
    int rowNum() const { return lpx_get_num_rows(lp); }
    /// \e
    int colNum() const { return lpx_get_num_cols(lp); }
    /// \e
    int warmUp() { return lpx_warm_up(lp); }
    /// \e
    void printWarmUpStatus(int i) {
      switch (i) {
      case LPX_E_OK: cout << "LPX_E_OK" << endl; break;
      case LPX_E_EMPTY: cout << "LPX_E_EMPTY" << endl; break;	
      case LPX_E_BADB: cout << "LPX_E_BADB" << endl; break;
      case LPX_E_SING: cout << "LPX_E_SING" << endl; break;
      }
    }
    /// \e
    int getPrimalStatus() { return lpx_get_prim_stat(lp); }
    /// \e
    void printPrimalStatus(int i) {
      switch (i) {
      case LPX_P_UNDEF: cout << "LPX_P_UNDEF" << endl; break;
      case LPX_P_FEAS: cout << "LPX_P_FEAS" << endl; break;	
      case LPX_P_INFEAS: cout << "LPX_P_INFEAS" << endl; break;
      case LPX_P_NOFEAS: cout << "LPX_P_NOFEAS" << endl; break;
      }
    }
    /// \e
    int getDualStatus() { return lpx_get_dual_stat(lp); }
    /// \e
    void printDualStatus(int i) {
      switch (i) {
      case LPX_D_UNDEF: cout << "LPX_D_UNDEF" << endl; break;
      case LPX_D_FEAS: cout << "LPX_D_FEAS" << endl; break;	
      case LPX_D_INFEAS: cout << "LPX_D_INFEAS" << endl; break;
      case LPX_D_NOFEAS: cout << "LPX_D_NOFEAS" << endl; break;
      }
    }
    /// Returns the status of the slack variable assigned to row \c row_it.
    int getRowStat(const RowIt& row_it) { 
      return lpx_get_row_stat(lp, row_iter_map[row_it]); 
    }
    /// \e
    void printRowStatus(int i) {
      switch (i) {
      case LPX_BS: cout << "LPX_BS" << endl; break;
      case LPX_NL: cout << "LPX_NL" << endl; break;	
      case LPX_NU: cout << "LPX_NU" << endl; break;
      case LPX_NF: cout << "LPX_NF" << endl; break;
      case LPX_NS: cout << "LPX_NS" << endl; break;
      }
    }
    /// Returns the status of the variable assigned to column \c col_it.
    int getColStat(const ColIt& col_it) { 
      return lpx_get_col_stat(lp, col_iter_map[col_it]); 
    }
    /// \e
    void printColStatus(int i) {
      switch (i) {
      case LPX_BS: cout << "LPX_BS" << endl; break;
      case LPX_NL: cout << "LPX_NL" << endl; break;	
      case LPX_NU: cout << "LPX_NU" << endl; break;
      case LPX_NF: cout << "LPX_NF" << endl; break;
      case LPX_NS: cout << "LPX_NS" << endl; break;
      }
    }
  };
  
  /// @}

} //namespace lemon

#endif //LEMON_LP_SOLVER_WRAPPER_H