// -*- C++ -*-

#ifndef HUGO_DIJKSTRA_H

#define HUGO_DIJKSTRA_H

///\ingroup galgs

///\file

///\brief Dijkstra algorithm.

#include <hugo/bin_heap.h>

#include <hugo/invalid.h>

namespace hugo {

/// \addtogroup galgs

/// @{

  ///%Dijkstra algorithm class.

  ///This class provides an efficient implementation of %Dijkstra algorithm.

  ///The edge lengths are passed to the algorithm using a

  ///\ref ReadMapSkeleton "readable map",

  ///so it is easy to change it to any kind of length.

  ///

  ///The type of the length is determined by the \c ValueType of the length map.

  ///

  ///It is also possible to change the underlying priority heap.

  ///

  ///\param GR The graph type the algorithm runs on.

  ///\param LM This read-only

  ///EdgeMap

  ///determines the

  ///lengths of the edges. It is read once for each edge, so the map

  ///may involve in relatively time consuming process to compute the edge

  ///length if it is necessary. The default map type is

  ///\ref GraphSkeleton::EdgeMap "Graph::EdgeMap<int>"

  ///\param Heap The heap type used by the %Dijkstra

  ///algorithm. The default

  ///is using \ref BinHeap "binary heap".

  ///

  ///\author Jacint Szabo

  ///\todo We need a typedef-names should be standardized.

#ifdef DOXYGEN

  template <typename GR,

	    typename LM,

	    typename Heap>

#else

  template <typename GR,

	    typename LM=typename GR::template EdgeMap<int>,

	    template <class,class,class,class> class Heap = BinHeap >

#endif

  class Dijkstra{

  public:

    ///The type of the underlying graph.

    typedef GR Graph;

    typedef typename Graph::Node Node;

    typedef typename Graph::NodeIt NodeIt;

    typedef typename Graph::Edge Edge;

    typedef typename Graph::OutEdgeIt OutEdgeIt;

    ///The type of the length of the edges.

    typedef typename LM::ValueType ValueType;

    ///The the type of the map that stores the edge lengths.

    typedef LM LengthMap;

    ///\brief The the type of the map that stores the last

    ///edges of the shortest paths.

    typedef typename Graph::template NodeMap<Edge> PredMap;

    ///\brief The the type of the map that stores the last but one

    ///nodes of the shortest paths.

    typedef typename Graph::template NodeMap<Node> PredNodeMap;

    ///The the type of the map that stores the dists of the nodes.

    typedef typename Graph::template NodeMap<ValueType> DistMap;

  private:

    const Graph *G;

    const LM *length;

    //    bool local_length;

    PredMap *predecessor;

    bool local_predecessor;

    PredNodeMap *pred_node;

    bool local_pred_node;

    DistMap *distance;

    bool local_distance;

    ///Initialize maps

    ///\todo Error if \c G or are \c NULL. What about \c length

    ///\todo Better memory allocation (instead of new).

    void init_maps() 

    {

//       if(!length) {

// 	local_length = true;

// 	length = new LM(G);

//       }

      if(!predecessor) {

	local_predecessor = true;

	predecessor = new PredMap(*G);

      }

      if(!pred_node) {

	local_pred_node = true;

	pred_node = new PredNodeMap(*G);

      }

      if(!distance) {

	local_distance = true;

	distance = new DistMap(*G);

      }

    }

  public :

    Dijkstra(const Graph& _G, const LM& _length) :

      G(&_G), length(&_length),

      predecessor(NULL), pred_node(NULL), distance(NULL),

      local_predecessor(false), local_pred_node(false), local_distance(false)

    { }

    ~Dijkstra() 

    {

      //      if(local_length) delete length;

      if(local_predecessor) delete predecessor;

      if(local_pred_node) delete pred_node;

      if(local_distance) delete distance;

    }

    ///Sets the graph the algorithm will run on.

    ///Sets the graph the algorithm will run on.

    ///\return <tt> (*this) </tt>

    Dijkstra &setGraph(const Graph &_G) 

    {

      G = &_G;

      return *this;

    }

    ///Sets the length map.

    ///Sets the length map.

    ///\return <tt> (*this) </tt>

    Dijkstra &setLengthMap(const LM &m) 

    {

//       if(local_length) {

// 	delete length;

// 	local_length=false;

//       }

      length = &m;

      return *this;

    }

    ///Sets the map storing the predecessor edges.

    ///Sets the map storing the predecessor edges.

    ///If you don't use this function before calling \ref run(),

    ///it will allocate one. The destuctor deallocates this

    ///automatically allocated map, of course.

    ///\return <tt> (*this) </tt>

    Dijkstra &setPredMap(PredMap &m) 

    {

      if(local_predecessor) {

	delete predecessor;

	local_predecessor=false;

      }

      predecessor = &m;

      return *this;

    }

    ///Sets the map storing the predecessor nodes.

    ///Sets the map storing the predecessor nodes.

    ///If you don't use this function before calling \ref run(),

    ///it will allocate one. The destuctor deallocates this

    ///automatically allocated map, of course.

    ///\return <tt> (*this) </tt>

    Dijkstra &setPredNodeMap(PredNodeMap &m) 

    {

      if(local_pred_node) {

	delete pred_node;

	local_pred_node=false;

      }

      pred_node = &m;

      return *this;

    }

    ///Sets the map storing the distances calculated by the algorithm.

    ///Sets the map storing the distances calculated by the algorithm.

    ///If you don't use this function before calling \ref run(),

    ///it will allocate one. The destuctor deallocates this

    ///automatically allocated map, of course.

    ///\return <tt> (*this) </tt>

    Dijkstra &setDistMap(DistMap &m) 

    {

      if(local_distance) {

	delete distance;

	local_distance=false;

      }

      distance = &m;

      return *this;

    }

    void run(Node s);

    ///The distance of a node from the root.

    ///Returns the distance of a node from the root.

    ///\pre \ref run() must be called before using this function.

    ///\warning If node \c v in unreachable from the root the return value

    ///of this funcion is undefined.

    ValueType dist(Node v) const { return (*distance)[v]; }

    ///Returns the 'previous edge' of the shortest path tree.

    ///For a node \c v it returns the 'previous edge' of the shortest path tree,

    ///i.e. it returns the last edge from a shortest path from the root to \c

    ///v. It is \ref INVALID

    ///if \c v is unreachable from the root or if \c v=s. The

    ///shortest path tree used here is equal to the shortest path tree used in

    ///\ref predNode(Node v).  \pre \ref run() must be called before using

    ///this function.

    Edge pred(Node v) const { return (*predecessor)[v]; }

    ///Returns the 'previous node' of the shortest path tree.

    ///For a node \c v it returns the 'previous node' of the shortest path tree,

    ///i.e. it returns the last but one node from a shortest path from the

    ///root to \c /v. It is INVALID if \c v is unreachable from the root or if

    ///\c v=s. The shortest path tree used here is equal to the shortest path

    ///tree used in \ref pred(Node v).  \pre \ref run() must be called before

    ///using this function.

    Node predNode(Node v) const { return (*pred_node)[v]; }

    ///Returns a reference to the NodeMap of distances.

    ///Returns a reference to the NodeMap of distances. \pre \ref run() must

    ///be called before using this function.

    const DistMap &distMap() const { return *distance;}

    ///Returns a reference to the shortest path tree map.

    ///Returns a reference to the NodeMap of the edges of the

    ///shortest path tree.

    ///\pre \ref run() must be called before using this function.

    const PredMap &predMap() const { return *predecessor;}

    ///Returns a reference to the map of nodes of shortest paths.

    ///Returns a reference to the NodeMap of the last but one nodes of the

    ///shortest path tree.

    ///\pre \ref run() must be called before using this function.

    const PredNodeMap &predNodeMap() const { return *pred_node;}

    ///Checks if a node is reachable from the root.

    ///Returns \c true if \c v is reachable from the root.

    ///\warning the root node is reported to be unreached!

    ///\todo Is this what we want?

    ///\pre \ref run() must be called before using this function.

    ///

    bool reached(Node v) { return G->valid((*predecessor)[v]); }

  };

  // **********************************************************************

  //  IMPLEMENTATIONS

  // **********************************************************************

  ///Runs %Dijkstra algorithm from node the root.

  ///This method runs the %Dijkstra algorithm from a root node \c s

  ///in order to

  ///compute the

  ///shortest path to each node. The algorithm computes

  ///- The shortest path tree.

  ///- The distance of each node from the root.

  template <typename GR, typename LM,

	    template<class,class,class,class> class Heap >

  void Dijkstra<GR,LM,Heap>::run(Node s) {

    init_maps();

    for ( NodeIt u(*G) ; G->valid(u) ; G->next(u) ) {

      predecessor->set(u,INVALID);

      pred_node->set(u,INVALID);

    }

    typename GR::template NodeMap<int> heap_map(*G,-1);

    typedef Heap<Node, ValueType, typename GR::template NodeMap<int>,

      std::less<ValueType> > 

      HeapType;

    HeapType heap(heap_map);

    heap.push(s,0); 

      while ( !heap.empty() ) {

	Node v=heap.top(); 

	ValueType oldvalue=heap[v];

	heap.pop();

	distance->set(v, oldvalue);

	for(OutEdgeIt e(*G,v); G->valid(e); G->next(e)) {

	  Node w=G->bNode(e); 

	  switch(heap.state(w)) {

	  case HeapType::PRE_HEAP:

	    heap.push(w,oldvalue+(*length)[e]); 

	    predecessor->set(w,e);

	    pred_node->set(w,v);

	    break;

	  case HeapType::IN_HEAP:

	    if ( oldvalue+(*length)[e] < heap[w] ) {

	      heap.decrease(w, oldvalue+(*length)[e]); 

	      predecessor->set(w,e);

	      pred_node->set(w,v);

	    }

	    break;

	  case HeapType::POST_HEAP:

	    break;

	  }

	}

      }

  }

/// @}

} //END OF NAMESPACE HUGO

#endif