/* -*- C++ -*-

 * lemon/fib_heap.h - Part of LEMON, a generic C++ optimization library

 *

 * Copyright (C) 2005 Egervary Jeno Kombinatorikus Optimalizalasi Kutatocsoport

 * (Egervary Research Group on Combinatorial Optimization, EGRES).

 *

 * Permission to use, modify and distribute this software is granted

 * provided that this copyright notice appears in all copies. For

 * precise terms see the accompanying LICENSE file.

 *

 * This software is provided "AS IS" with no warranty of any kind,

 * express or implied, and with no claim as to its suitability for any

 * purpose.

 *

 */

#ifndef LEMON_FIB_HEAP_H

#define LEMON_FIB_HEAP_H

///\file

///\ingroup auxdat

///\brief Fibonacci Heap implementation.

#include <vector>

#include <functional>

#include <cmath>

namespace lemon {

  /// \addtogroup auxdat

  /// @{

  /// Fibonacci Heap.

  ///This class implements the \e Fibonacci \e heap data structure. A \e heap

  ///is a data structure for storing items with specified values called \e

  ///priorities in such a way that finding the item with minimum priority is

  ///efficient. \c Compare specifies the ordering of the priorities. In a heap

  ///one can change the priority of an item, add or erase an item, etc.

  ///

  ///The methods \ref increase and \ref erase are not efficient in a Fibonacci

  ///heap. In case of many calls to these operations, it is better to use a

  ///\e binary \e heap.

  ///

  ///\param Item Type of the items to be stored.  

  ///\param Prio Type of the priority of the items.

  ///\param ItemIntMap A read and writable Item int map, used internally

  ///to handle the cross references.

  ///\param Compare A class for the ordering of the priorities. The

  ///default is \c std::less<Prio>.

  ///

  ///\sa BinHeap

  ///\sa Dijkstra

  ///\author Jacint Szabo 

#ifdef DOXYGEN

  template <typename Item, 

	    typename Prio, 

	    typename ItemIntMap, 

	    typename Compare>

#else

  template <typename Item, 

	    typename Prio, 

	    typename ItemIntMap, 

	    typename Compare = std::less<Prio> >

#endif

  class FibHeap {

  public:     

    typedef Prio PrioType;

  private:

    class store;

    std::vector<store> container;

    int minimum;

    ItemIntMap &iimap;

    Compare comp;

    int num_items;

  public:

    ///Status of the nodes

    enum state_enum {

      ///The node is in the heap

      IN_HEAP = 0,

      ///The node has never been in the heap

      PRE_HEAP = -1,

      ///The node was in the heap but it got out of it

      POST_HEAP = -2

    };

    /// \brief The constructor

    ///

    /// \c _iimap should be given to the constructor, since it is

    ///   used internally to handle the cross references.

    explicit FibHeap(ItemIntMap &_iimap) 

      : minimum(0), iimap(_iimap), num_items() {} 

    /// \brief The constructor

    ///

    /// \c _iimap should be given to the constructor, since it is used

    /// internally to handle the cross references. \c _comp is an

    /// object for ordering of the priorities. 

    FibHeap(ItemIntMap &_iimap, const Compare &_comp) : minimum(0), 

		  iimap(_iimap), comp(_comp), num_items() {}

    /// \brief The number of items stored in the heap.

    ///

    /// Returns the number of items stored in the heap.

    int size() const { return num_items; }

    /// \brief Checks if the heap stores no items.

    ///

    ///   Returns \c true if and only if the heap stores no items.

    bool empty() const { return num_items==0; }

    /// \brief Make empty this heap.

    /// 

    /// Make empty this heap.

    void clear() {

      if (num_items != 0) {

	for (int i = 0; i < (int)container.size(); ++i) {

	  iimap[container[i].name] = -2;

	}

      }

      container.clear(); minimum = 0; num_items = 0;

    }

    /// \brief \c item gets to the heap with priority \c value independently 

    /// if \c item was already there.

    ///

    /// This method calls \ref push(\c item, \c value) if \c item is not

    /// stored in the heap and it calls \ref decrease(\c item, \c value) or

    /// \ref increase(\c item, \c value) otherwise.

    void set (Item const item, PrioType const value); 

    /// \brief Adds \c item to the heap with priority \c value. 

    ///    

    /// Adds \c item to the heap with priority \c value. 

    /// \pre \c item must not be stored in the heap. 

    void push (Item const item, PrioType const value);

    /// \brief Returns the item with minimum priority relative to \c Compare.

    ///

    /// This method returns the item with minimum priority relative to \c

    /// Compare.  

    /// \pre The heap must be nonempty.  

    Item top() const { return container[minimum].name; }

    /// \brief Returns the minimum priority relative to \c Compare.

    ///

    /// It returns the minimum priority relative to \c Compare.

    /// \pre The heap must be nonempty.

    PrioType prio() const { return container[minimum].prio; }

    /// \brief Returns the priority of \c item.

    ///

    /// This function returns the priority of \c item.

    /// \pre \c item must be in the heap.

    PrioType& operator[](const Item& item) { 

      return container[iimap[item]].prio; 

    }

    /// \brief Returns the priority of \c item.

    ///

    /// It returns the priority of \c item.

    /// \pre \c item must be in the heap.

    const PrioType& operator[](const Item& item) const { 

      return container[iimap[item]].prio; 

    }

    /// \brief Deletes the item with minimum priority relative to \c Compare.

    ///

    /// This method deletes the item with minimum priority relative to \c

    /// Compare from the heap.  

    /// \pre The heap must be non-empty.  

    void pop();

    /// \brief Deletes \c item from the heap.

    ///

    /// This method deletes \c item from the heap, if \c item was already

    /// stored in the heap. It is quite inefficient in Fibonacci heaps.

    void erase (const Item& item); 

    /// \brief Decreases the priority of \c item to \c value.

    ///

    /// This method decreases the priority of \c item to \c value.

    /// \pre \c item must be stored in the heap with priority at least \c

    ///   value relative to \c Compare.

    void decrease (Item item, PrioType const value); 

    /// \brief Increases the priority of \c item to \c value.

    ///

    /// This method sets the priority of \c item to \c value. Though

    /// there is no precondition on the priority of \c item, this

    /// method should be used only if it is indeed necessary to increase

    /// (relative to \c Compare) the priority of \c item, because this

    /// method is inefficient.

    void increase (Item item, PrioType const value) {

      erase(item);

      push(item, value);

    }

    /// \brief Returns if \c item is in, has already been in, or has never 

    /// been in the heap.

    ///

    /// This method returns PRE_HEAP if \c item has never been in the

    /// heap, IN_HEAP if it is in the heap at the moment, and POST_HEAP

    /// otherwise. In the latter case it is possible that \c item will

    /// get back to the heap again.

    state_enum state(const Item &item) const {

      int i=iimap[item];

      if( i>=0 ) {

	if ( container[i].in ) i=0;

	else i=-2; 

      }

      return state_enum(i);

    }    

  private:

    void balance();

    void makeroot(int c);

    void cut(int a, int b);

    void cascade(int a);

    void fuse(int a, int b);

    void unlace(int a);

    class store {

      friend class FibHeap;

      Item name;

      int parent;

      int left_neighbor;

      int right_neighbor;

      int child;

      int degree;  

      bool marked;

      bool in;

      PrioType prio;

      store() : parent(-1), child(-1), degree(), marked(false), in(true) {} 

    };

  };    

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

    //  IMPLEMENTATIONS

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

  template <typename Item, typename Prio, typename ItemIntMap, 

    typename Compare>

  void FibHeap<Item, Prio, ItemIntMap, Compare>::set 

  (Item const item, PrioType const value) 

  {

    int i=iimap[item];

    if ( i >= 0 && container[i].in ) {

      if ( comp(value, container[i].prio) ) decrease(item, value); 

      if ( comp(container[i].prio, value) ) increase(item, value); 

    } else push(item, value);

  }

  template <typename Item, typename Prio, typename ItemIntMap, 

    typename Compare>

  void FibHeap<Item, Prio, ItemIntMap, Compare>::push 

  (Item const item, PrioType const value) {

      int i=iimap[item];      

      if ( i < 0 ) {

	int s=container.size();

	iimap.set( item, s );	

	store st;

	st.name=item;

	container.push_back(st);

	i=s;

      } else {

	container[i].parent=container[i].child=-1;

	container[i].degree=0;

	container[i].in=true;

	container[i].marked=false;

      }

      if ( num_items ) {

	container[container[minimum].right_neighbor].left_neighbor=i;

	container[i].right_neighbor=container[minimum].right_neighbor;

	container[minimum].right_neighbor=i;

	container[i].left_neighbor=minimum;

	if ( comp( value, container[minimum].prio) ) minimum=i; 

      } else {

	container[i].right_neighbor=container[i].left_neighbor=i;

	minimum=i;	

      }

      container[i].prio=value;

      ++num_items;

    }

  template <typename Item, typename Prio, typename ItemIntMap, 

    typename Compare>

  void FibHeap<Item, Prio, ItemIntMap, Compare>::pop() {

      /*The first case is that there are only one root.*/

      if ( container[minimum].left_neighbor==minimum ) {

	container[minimum].in=false;

	if ( container[minimum].degree!=0 ) { 

	  makeroot(container[minimum].child);

	  minimum=container[minimum].child;

	  balance();

	}

      } else {

	int right=container[minimum].right_neighbor;

	unlace(minimum);

	container[minimum].in=false;

	if ( container[minimum].degree > 0 ) {

	  int left=container[minimum].left_neighbor;

	  int child=container[minimum].child;

	  int last_child=container[child].left_neighbor;

	  makeroot(child);

	  container[left].right_neighbor=child;

	  container[child].left_neighbor=left;

	  container[right].left_neighbor=last_child;

	  container[last_child].right_neighbor=right;

	}

	minimum=right;

	balance();

      } // the case where there are more roots

      --num_items;   

    }

  template <typename Item, typename Prio, typename ItemIntMap, 

    typename Compare>

  void FibHeap<Item, Prio, ItemIntMap, Compare>::erase 

  (const Item& item) {

      int i=iimap[item];

      if ( i >= 0 && container[i].in ) { 	

	if ( container[i].parent!=-1 ) {

	  int p=container[i].parent;

	  cut(i,p);	    

	  cascade(p);

	}

	minimum=i;     //As if its prio would be -infinity

	pop();

      }

  }

  template <typename Item, typename Prio, typename ItemIntMap, 

    typename Compare>

  void FibHeap<Item, Prio, ItemIntMap, Compare>::decrease 

  (Item item, PrioType const value) {

      int i=iimap[item];

      container[i].prio=value;

      int p=container[i].parent;

      if ( p!=-1 && comp(value, container[p].prio) ) {

	cut(i,p);	    

	cascade(p);

      }      

      if ( comp(value, container[minimum].prio) ) minimum=i; 

  }

  template <typename Item, typename Prio, typename ItemIntMap, 

    typename Compare>

  void FibHeap<Item, Prio, ItemIntMap, Compare>::balance() {      

    int maxdeg=int( std::floor( 2.08*log(double(container.size()))))+1;

    std::vector<int> A(maxdeg,-1); 

    /*

     *Recall that now minimum does not point to the minimum prio element.

     *We set minimum to this during balance().

     */

    int anchor=container[minimum].left_neighbor; 

    int next=minimum; 

    bool end=false; 

       do {

	int active=next;

	if ( anchor==active ) end=true;

	int d=container[active].degree;

	next=container[active].right_neighbor;

	while (A[d]!=-1) {	  

	  if( comp(container[active].prio, container[A[d]].prio) ) {

	    fuse(active,A[d]); 

	  } else { 

	    fuse(A[d],active);

	    active=A[d];

	  } 

	  A[d]=-1;

	  ++d;

	}	

	A[d]=active;

       } while ( !end );

       while ( container[minimum].parent >=0 ) minimum=container[minimum].parent;

       int s=minimum;

       int m=minimum;

       do {  

	 if ( comp(container[s].prio, container[minimum].prio) ) minimum=s;

	 s=container[s].right_neighbor;

       } while ( s != m );

    }

  template <typename Item, typename Prio, typename ItemIntMap, 

    typename Compare>

  void FibHeap<Item, Prio, ItemIntMap, Compare>::makeroot 

  (int c) {

      int s=c;

      do {  

	container[s].parent=-1;

	s=container[s].right_neighbor;

      } while ( s != c );

    }

  template <typename Item, typename Prio, typename ItemIntMap, 

    typename Compare>

  void FibHeap<Item, Prio, ItemIntMap, Compare>::cut 

  (int a, int b) {    

    /*

     *Replacing a from the children of b.

     */

    --container[b].degree;

    if ( container[b].degree !=0 ) {

      int child=container[b].child;

      if ( child==a ) 

	container[b].child=container[child].right_neighbor;

      unlace(a);

    }

    /*Lacing a to the roots.*/

    int right=container[minimum].right_neighbor;

    container[minimum].right_neighbor=a;

    container[a].left_neighbor=minimum;

    container[a].right_neighbor=right;

    container[right].left_neighbor=a;

    container[a].parent=-1;

    container[a].marked=false;

  }

  template <typename Item, typename Prio, typename ItemIntMap, 

    typename Compare>

  void FibHeap<Item, Prio, ItemIntMap, Compare>::cascade 

  (int a) 

    {

      if ( container[a].parent!=-1 ) {

	int p=container[a].parent;

	if ( container[a].marked==false ) container[a].marked=true;

	else {

	  cut(a,p);

	  cascade(p);

	}

      }

    }

  template <typename Item, typename Prio, typename ItemIntMap, 

    typename Compare>

  void FibHeap<Item, Prio, ItemIntMap, Compare>::fuse 

  (int a, int b) {

      unlace(b);

      /*Lacing b under a.*/

      container[b].parent=a;

      if (container[a].degree==0) {

	container[b].left_neighbor=b;

	container[b].right_neighbor=b;

	container[a].child=b;	

      } else {

	int child=container[a].child;

	int last_child=container[child].left_neighbor;

	container[child].left_neighbor=b;

	container[b].right_neighbor=child;

	container[last_child].right_neighbor=b;

	container[b].left_neighbor=last_child;

      }

      ++container[a].degree;

      container[b].marked=false;

    }

  /*

   *It is invoked only if a has siblings.

   */

  template <typename Item, typename Prio, typename ItemIntMap, 

    typename Compare>

  void FibHeap<Item, Prio, ItemIntMap, Compare>::unlace 

  (int a) {      

      int leftn=container[a].left_neighbor;

      int rightn=container[a].right_neighbor;

      container[leftn].right_neighbor=rightn;

      container[rightn].left_neighbor=leftn;

  }

  ///@}

} //namespace lemon

#endif //LEMON_FIB_HEAP_H