kpeter@805: /* -*- C++ -*-
kpeter@805:  *
kpeter@805:  * This file is a part of LEMON, a generic C++ optimization library
kpeter@805:  *
kpeter@805:  * Copyright (C) 2003-2008
kpeter@805:  * Egervary Jeno Kombinatorikus Optimalizalasi Kutatocsoport
kpeter@805:  * (Egervary Research Group on Combinatorial Optimization, EGRES).
kpeter@805:  *
kpeter@805:  * Permission to use, modify and distribute this software is granted
kpeter@805:  * provided that this copyright notice appears in all copies. For
kpeter@805:  * precise terms see the accompanying LICENSE file.
kpeter@805:  *
kpeter@805:  * This software is provided "AS IS" with no warranty of any kind,
kpeter@805:  * express or implied, and with no claim as to its suitability for any
kpeter@805:  * purpose.
kpeter@805:  *
kpeter@805:  */
kpeter@805: 
kpeter@811: #ifndef LEMON_HOWARD_H
kpeter@811: #define LEMON_HOWARD_H
kpeter@805: 
kpeter@815: /// \ingroup min_mean_cycle
kpeter@805: ///
kpeter@805: /// \file
kpeter@805: /// \brief Howard's algorithm for finding a minimum mean cycle.
kpeter@805: 
kpeter@805: #include <vector>
kpeter@810: #include <limits>
kpeter@805: #include <lemon/core.h>
kpeter@805: #include <lemon/path.h>
kpeter@805: #include <lemon/tolerance.h>
kpeter@805: #include <lemon/connectivity.h>
kpeter@805: 
kpeter@805: namespace lemon {
kpeter@805: 
kpeter@811:   /// \brief Default traits class of Howard class.
kpeter@808:   ///
kpeter@811:   /// Default traits class of Howard class.
kpeter@808:   /// \tparam GR The type of the digraph.
kpeter@808:   /// \tparam LEN The type of the length map.
kpeter@808:   /// It must conform to the \ref concepts::ReadMap "ReadMap" concept.
kpeter@808: #ifdef DOXYGEN
kpeter@808:   template <typename GR, typename LEN>
kpeter@808: #else
kpeter@808:   template <typename GR, typename LEN,
kpeter@808:     bool integer = std::numeric_limits<typename LEN::Value>::is_integer>
kpeter@808: #endif
kpeter@811:   struct HowardDefaultTraits
kpeter@808:   {
kpeter@808:     /// The type of the digraph
kpeter@808:     typedef GR Digraph;
kpeter@808:     /// The type of the length map
kpeter@808:     typedef LEN LengthMap;
kpeter@808:     /// The type of the arc lengths
kpeter@808:     typedef typename LengthMap::Value Value;
kpeter@808: 
kpeter@808:     /// \brief The large value type used for internal computations
kpeter@808:     ///
kpeter@808:     /// The large value type used for internal computations.
kpeter@808:     /// It is \c long \c long if the \c Value type is integer,
kpeter@808:     /// otherwise it is \c double.
kpeter@808:     /// \c Value must be convertible to \c LargeValue.
kpeter@808:     typedef double LargeValue;
kpeter@808: 
kpeter@808:     /// The tolerance type used for internal computations
kpeter@808:     typedef lemon::Tolerance<LargeValue> Tolerance;
kpeter@808: 
kpeter@808:     /// \brief The path type of the found cycles
kpeter@808:     ///
kpeter@808:     /// The path type of the found cycles.
kpeter@808:     /// It must conform to the \ref lemon::concepts::Path "Path" concept
kpeter@808:     /// and it must have an \c addBack() function.
kpeter@808:     typedef lemon::Path<Digraph> Path;
kpeter@808:   };
kpeter@808: 
kpeter@808:   // Default traits class for integer value types
kpeter@808:   template <typename GR, typename LEN>
kpeter@811:   struct HowardDefaultTraits<GR, LEN, true>
kpeter@808:   {
kpeter@808:     typedef GR Digraph;
kpeter@808:     typedef LEN LengthMap;
kpeter@808:     typedef typename LengthMap::Value Value;
kpeter@808: #ifdef LEMON_HAVE_LONG_LONG
kpeter@808:     typedef long long LargeValue;
kpeter@808: #else
kpeter@808:     typedef long LargeValue;
kpeter@808: #endif
kpeter@808:     typedef lemon::Tolerance<LargeValue> Tolerance;
kpeter@808:     typedef lemon::Path<Digraph> Path;
kpeter@808:   };
kpeter@808: 
kpeter@808: 
kpeter@815:   /// \addtogroup min_mean_cycle
kpeter@805:   /// @{
kpeter@805: 
kpeter@805:   /// \brief Implementation of Howard's algorithm for finding a minimum
kpeter@805:   /// mean cycle.
kpeter@805:   ///
kpeter@811:   /// This class implements Howard's policy iteration algorithm for finding
kpeter@818:   /// a directed cycle of minimum mean length (cost) in a digraph
kpeter@818:   /// \ref amo93networkflows, \ref dasdan98minmeancycle.
kpeter@815:   /// This class provides the most efficient algorithm for the
kpeter@815:   /// minimum mean cycle problem, though the best known theoretical
kpeter@815:   /// bound on its running time is exponential.
kpeter@805:   ///
kpeter@805:   /// \tparam GR The type of the digraph the algorithm runs on.
kpeter@805:   /// \tparam LEN The type of the length map. The default
kpeter@805:   /// map type is \ref concepts::Digraph::ArcMap "GR::ArcMap<int>".
kpeter@891:   /// \tparam TR The traits class that defines various types used by the
kpeter@891:   /// algorithm. By default, it is \ref HowardDefaultTraits
kpeter@891:   /// "HowardDefaultTraits<GR, LEN>".
kpeter@891:   /// In most cases, this parameter should not be set directly,
kpeter@891:   /// consider to use the named template parameters instead.
kpeter@805: #ifdef DOXYGEN
kpeter@808:   template <typename GR, typename LEN, typename TR>
kpeter@805: #else
kpeter@805:   template < typename GR,
kpeter@808:              typename LEN = typename GR::template ArcMap<int>,
kpeter@811:              typename TR = HowardDefaultTraits<GR, LEN> >
kpeter@805: #endif
kpeter@811:   class Howard
kpeter@805:   {
kpeter@805:   public:
kpeter@805:   
kpeter@808:     /// The type of the digraph
kpeter@808:     typedef typename TR::Digraph Digraph;
kpeter@805:     /// The type of the length map
kpeter@808:     typedef typename TR::LengthMap LengthMap;
kpeter@805:     /// The type of the arc lengths
kpeter@808:     typedef typename TR::Value Value;
kpeter@808: 
kpeter@808:     /// \brief The large value type
kpeter@808:     ///
kpeter@808:     /// The large value type used for internal computations.
kpeter@891:     /// By default, it is \c long \c long if the \c Value type is integer,
kpeter@808:     /// otherwise it is \c double.
kpeter@808:     typedef typename TR::LargeValue LargeValue;
kpeter@808: 
kpeter@808:     /// The tolerance type
kpeter@808:     typedef typename TR::Tolerance Tolerance;
kpeter@808: 
kpeter@808:     /// \brief The path type of the found cycles
kpeter@808:     ///
kpeter@808:     /// The path type of the found cycles.
kpeter@811:     /// Using the \ref HowardDefaultTraits "default traits class",
kpeter@808:     /// it is \ref lemon::Path "Path<Digraph>".
kpeter@808:     typedef typename TR::Path Path;
kpeter@808: 
kpeter@811:     /// The \ref HowardDefaultTraits "traits class" of the algorithm
kpeter@808:     typedef TR Traits;
kpeter@805: 
kpeter@805:   private:
kpeter@805: 
kpeter@805:     TEMPLATE_DIGRAPH_TYPEDEFS(Digraph);
kpeter@805:   
kpeter@805:     // The digraph the algorithm runs on
kpeter@805:     const Digraph &_gr;
kpeter@805:     // The length of the arcs
kpeter@805:     const LengthMap &_length;
kpeter@805: 
kpeter@807:     // Data for the found cycles
kpeter@807:     bool _curr_found, _best_found;
kpeter@808:     LargeValue _curr_length, _best_length;
kpeter@807:     int _curr_size, _best_size;
kpeter@807:     Node _curr_node, _best_node;
kpeter@807: 
kpeter@805:     Path *_cycle_path;
kpeter@807:     bool _local_path;
kpeter@805: 
kpeter@807:     // Internal data used by the algorithm
kpeter@807:     typename Digraph::template NodeMap<Arc> _policy;
kpeter@807:     typename Digraph::template NodeMap<bool> _reached;
kpeter@807:     typename Digraph::template NodeMap<int> _level;
kpeter@808:     typename Digraph::template NodeMap<LargeValue> _dist;
kpeter@805: 
kpeter@807:     // Data for storing the strongly connected components
kpeter@807:     int _comp_num;
kpeter@805:     typename Digraph::template NodeMap<int> _comp;
kpeter@807:     std::vector<std::vector<Node> > _comp_nodes;
kpeter@807:     std::vector<Node>* _nodes;
kpeter@807:     typename Digraph::template NodeMap<std::vector<Arc> > _in_arcs;
kpeter@807:     
kpeter@807:     // Queue used for BFS search
kpeter@807:     std::vector<Node> _queue;
kpeter@807:     int _qfront, _qback;
kpeter@808: 
kpeter@808:     Tolerance _tolerance;
kpeter@808:   
kpeter@814:     // Infinite constant
kpeter@814:     const LargeValue INF;
kpeter@814: 
kpeter@808:   public:
kpeter@808:   
kpeter@808:     /// \name Named Template Parameters
kpeter@808:     /// @{
kpeter@808: 
kpeter@808:     template <typename T>
kpeter@808:     struct SetLargeValueTraits : public Traits {
kpeter@808:       typedef T LargeValue;
kpeter@808:       typedef lemon::Tolerance<T> Tolerance;
kpeter@808:     };
kpeter@808: 
kpeter@808:     /// \brief \ref named-templ-param "Named parameter" for setting
kpeter@808:     /// \c LargeValue type.
kpeter@808:     ///
kpeter@808:     /// \ref named-templ-param "Named parameter" for setting \c LargeValue
kpeter@808:     /// type. It is used for internal computations in the algorithm.
kpeter@808:     template <typename T>
kpeter@808:     struct SetLargeValue
kpeter@811:       : public Howard<GR, LEN, SetLargeValueTraits<T> > {
kpeter@811:       typedef Howard<GR, LEN, SetLargeValueTraits<T> > Create;
kpeter@808:     };
kpeter@808: 
kpeter@808:     template <typename T>
kpeter@808:     struct SetPathTraits : public Traits {
kpeter@808:       typedef T Path;
kpeter@808:     };
kpeter@808: 
kpeter@808:     /// \brief \ref named-templ-param "Named parameter" for setting
kpeter@808:     /// \c %Path type.
kpeter@808:     ///
kpeter@808:     /// \ref named-templ-param "Named parameter" for setting the \c %Path
kpeter@808:     /// type of the found cycles.
kpeter@808:     /// It must conform to the \ref lemon::concepts::Path "Path" concept
kpeter@808:     /// and it must have an \c addBack() function.
kpeter@808:     template <typename T>
kpeter@808:     struct SetPath
kpeter@811:       : public Howard<GR, LEN, SetPathTraits<T> > {
kpeter@811:       typedef Howard<GR, LEN, SetPathTraits<T> > Create;
kpeter@808:     };
kpeter@807:     
kpeter@808:     /// @}
kpeter@805: 
kpeter@941:   protected:
kpeter@941: 
kpeter@941:     Howard() {}
kpeter@941: 
kpeter@805:   public:
kpeter@805: 
kpeter@805:     /// \brief Constructor.
kpeter@805:     ///
kpeter@805:     /// The constructor of the class.
kpeter@805:     ///
kpeter@805:     /// \param digraph The digraph the algorithm runs on.
kpeter@805:     /// \param length The lengths (costs) of the arcs.
kpeter@811:     Howard( const Digraph &digraph,
kpeter@811:             const LengthMap &length ) :
kpeter@814:       _gr(digraph), _length(length), _best_found(false),
kpeter@814:       _best_length(0), _best_size(1), _cycle_path(NULL), _local_path(false),
kpeter@807:       _policy(digraph), _reached(digraph), _level(digraph), _dist(digraph),
kpeter@814:       _comp(digraph), _in_arcs(digraph),
kpeter@814:       INF(std::numeric_limits<LargeValue>::has_infinity ?
kpeter@814:           std::numeric_limits<LargeValue>::infinity() :
kpeter@814:           std::numeric_limits<LargeValue>::max())
kpeter@805:     {}
kpeter@805: 
kpeter@805:     /// Destructor.
kpeter@811:     ~Howard() {
kpeter@805:       if (_local_path) delete _cycle_path;
kpeter@805:     }
kpeter@805: 
kpeter@805:     /// \brief Set the path structure for storing the found cycle.
kpeter@805:     ///
kpeter@805:     /// This function sets an external path structure for storing the
kpeter@805:     /// found cycle.
kpeter@805:     ///
kpeter@805:     /// If you don't call this function before calling \ref run() or
kpeter@806:     /// \ref findMinMean(), it will allocate a local \ref Path "path"
kpeter@805:     /// structure. The destuctor deallocates this automatically
kpeter@805:     /// allocated object, of course.
kpeter@805:     ///
kpeter@805:     /// \note The algorithm calls only the \ref lemon::Path::addBack()
kpeter@805:     /// "addBack()" function of the given path structure.
kpeter@805:     ///
kpeter@805:     /// \return <tt>(*this)</tt>
kpeter@811:     Howard& cycle(Path &path) {
kpeter@805:       if (_local_path) {
kpeter@805:         delete _cycle_path;
kpeter@805:         _local_path = false;
kpeter@805:       }
kpeter@805:       _cycle_path = &path;
kpeter@805:       return *this;
kpeter@805:     }
kpeter@805: 
kpeter@816:     /// \brief Set the tolerance used by the algorithm.
kpeter@816:     ///
kpeter@816:     /// This function sets the tolerance object used by the algorithm.
kpeter@816:     ///
kpeter@816:     /// \return <tt>(*this)</tt>
kpeter@816:     Howard& tolerance(const Tolerance& tolerance) {
kpeter@816:       _tolerance = tolerance;
kpeter@816:       return *this;
kpeter@816:     }
kpeter@816: 
kpeter@816:     /// \brief Return a const reference to the tolerance.
kpeter@816:     ///
kpeter@816:     /// This function returns a const reference to the tolerance object
kpeter@816:     /// used by the algorithm.
kpeter@816:     const Tolerance& tolerance() const {
kpeter@816:       return _tolerance;
kpeter@816:     }
kpeter@816: 
kpeter@805:     /// \name Execution control
kpeter@805:     /// The simplest way to execute the algorithm is to call the \ref run()
kpeter@805:     /// function.\n
kpeter@806:     /// If you only need the minimum mean length, you may call
kpeter@806:     /// \ref findMinMean().
kpeter@805: 
kpeter@805:     /// @{
kpeter@805: 
kpeter@805:     /// \brief Run the algorithm.
kpeter@805:     ///
kpeter@805:     /// This function runs the algorithm.
kpeter@806:     /// It can be called more than once (e.g. if the underlying digraph
kpeter@806:     /// and/or the arc lengths have been modified).
kpeter@805:     ///
kpeter@805:     /// \return \c true if a directed cycle exists in the digraph.
kpeter@805:     ///
kpeter@806:     /// \note <tt>mmc.run()</tt> is just a shortcut of the following code.
kpeter@805:     /// \code
kpeter@806:     ///   return mmc.findMinMean() && mmc.findCycle();
kpeter@805:     /// \endcode
kpeter@805:     bool run() {
kpeter@805:       return findMinMean() && findCycle();
kpeter@805:     }
kpeter@805: 
kpeter@806:     /// \brief Find the minimum cycle mean.
kpeter@805:     ///
kpeter@806:     /// This function finds the minimum mean length of the directed
kpeter@806:     /// cycles in the digraph.
kpeter@805:     ///
kpeter@806:     /// \return \c true if a directed cycle exists in the digraph.
kpeter@806:     bool findMinMean() {
kpeter@807:       // Initialize and find strongly connected components
kpeter@807:       init();
kpeter@807:       findComponents();
kpeter@807:       
kpeter@806:       // Find the minimum cycle mean in the components
kpeter@805:       for (int comp = 0; comp < _comp_num; ++comp) {
kpeter@807:         // Find the minimum mean cycle in the current component
kpeter@807:         if (!buildPolicyGraph(comp)) continue;
kpeter@805:         while (true) {
kpeter@807:           findPolicyCycle();
kpeter@805:           if (!computeNodeDistances()) break;
kpeter@805:         }
kpeter@807:         // Update the best cycle (global minimum mean cycle)
kpeter@814:         if ( _curr_found && (!_best_found ||
kpeter@807:              _curr_length * _best_size < _best_length * _curr_size) ) {
kpeter@807:           _best_found = true;
kpeter@807:           _best_length = _curr_length;
kpeter@807:           _best_size = _curr_size;
kpeter@807:           _best_node = _curr_node;
kpeter@807:         }
kpeter@805:       }
kpeter@807:       return _best_found;
kpeter@805:     }
kpeter@805: 
kpeter@805:     /// \brief Find a minimum mean directed cycle.
kpeter@805:     ///
kpeter@805:     /// This function finds a directed cycle of minimum mean length
kpeter@805:     /// in the digraph using the data computed by findMinMean().
kpeter@805:     ///
kpeter@805:     /// \return \c true if a directed cycle exists in the digraph.
kpeter@805:     ///
kpeter@806:     /// \pre \ref findMinMean() must be called before using this function.
kpeter@805:     bool findCycle() {
kpeter@807:       if (!_best_found) return false;
kpeter@807:       _cycle_path->addBack(_policy[_best_node]);
kpeter@807:       for ( Node v = _best_node;
kpeter@807:             (v = _gr.target(_policy[v])) != _best_node; ) {
kpeter@805:         _cycle_path->addBack(_policy[v]);
kpeter@805:       }
kpeter@805:       return true;
kpeter@805:     }
kpeter@805: 
kpeter@805:     /// @}
kpeter@805: 
kpeter@805:     /// \name Query Functions
kpeter@806:     /// The results of the algorithm can be obtained using these
kpeter@805:     /// functions.\n
kpeter@805:     /// The algorithm should be executed before using them.
kpeter@805: 
kpeter@805:     /// @{
kpeter@805: 
kpeter@805:     /// \brief Return the total length of the found cycle.
kpeter@805:     ///
kpeter@805:     /// This function returns the total length of the found cycle.
kpeter@805:     ///
kpeter@807:     /// \pre \ref run() or \ref findMinMean() must be called before
kpeter@805:     /// using this function.
kpeter@914:     Value cycleLength() const {
kpeter@914:       return static_cast<Value>(_best_length);
kpeter@805:     }
kpeter@805: 
kpeter@805:     /// \brief Return the number of arcs on the found cycle.
kpeter@805:     ///
kpeter@805:     /// This function returns the number of arcs on the found cycle.
kpeter@805:     ///
kpeter@807:     /// \pre \ref run() or \ref findMinMean() must be called before
kpeter@805:     /// using this function.
kpeter@805:     int cycleArcNum() const {
kpeter@807:       return _best_size;
kpeter@805:     }
kpeter@805: 
kpeter@805:     /// \brief Return the mean length of the found cycle.
kpeter@805:     ///
kpeter@805:     /// This function returns the mean length of the found cycle.
kpeter@805:     ///
kpeter@807:     /// \note <tt>alg.cycleMean()</tt> is just a shortcut of the
kpeter@805:     /// following code.
kpeter@805:     /// \code
kpeter@807:     ///   return static_cast<double>(alg.cycleLength()) / alg.cycleArcNum();
kpeter@805:     /// \endcode
kpeter@805:     ///
kpeter@805:     /// \pre \ref run() or \ref findMinMean() must be called before
kpeter@805:     /// using this function.
kpeter@805:     double cycleMean() const {
kpeter@807:       return static_cast<double>(_best_length) / _best_size;
kpeter@805:     }
kpeter@805: 
kpeter@805:     /// \brief Return the found cycle.
kpeter@805:     ///
kpeter@805:     /// This function returns a const reference to the path structure
kpeter@805:     /// storing the found cycle.
kpeter@805:     ///
kpeter@805:     /// \pre \ref run() or \ref findCycle() must be called before using
kpeter@805:     /// this function.
kpeter@805:     const Path& cycle() const {
kpeter@805:       return *_cycle_path;
kpeter@805:     }
kpeter@805: 
kpeter@805:     ///@}
kpeter@805: 
kpeter@805:   private:
kpeter@805: 
kpeter@807:     // Initialize
kpeter@807:     void init() {
kpeter@807:       if (!_cycle_path) {
kpeter@807:         _local_path = true;
kpeter@807:         _cycle_path = new Path;
kpeter@805:       }
kpeter@807:       _queue.resize(countNodes(_gr));
kpeter@807:       _best_found = false;
kpeter@807:       _best_length = 0;
kpeter@807:       _best_size = 1;
kpeter@807:       _cycle_path->clear();
kpeter@807:     }
kpeter@807:     
kpeter@807:     // Find strongly connected components and initialize _comp_nodes
kpeter@807:     // and _in_arcs
kpeter@807:     void findComponents() {
kpeter@807:       _comp_num = stronglyConnectedComponents(_gr, _comp);
kpeter@807:       _comp_nodes.resize(_comp_num);
kpeter@807:       if (_comp_num == 1) {
kpeter@807:         _comp_nodes[0].clear();
kpeter@807:         for (NodeIt n(_gr); n != INVALID; ++n) {
kpeter@807:           _comp_nodes[0].push_back(n);
kpeter@807:           _in_arcs[n].clear();
kpeter@807:           for (InArcIt a(_gr, n); a != INVALID; ++a) {
kpeter@807:             _in_arcs[n].push_back(a);
kpeter@807:           }
kpeter@807:         }
kpeter@807:       } else {
kpeter@807:         for (int i = 0; i < _comp_num; ++i)
kpeter@807:           _comp_nodes[i].clear();
kpeter@807:         for (NodeIt n(_gr); n != INVALID; ++n) {
kpeter@807:           int k = _comp[n];
kpeter@807:           _comp_nodes[k].push_back(n);
kpeter@807:           _in_arcs[n].clear();
kpeter@807:           for (InArcIt a(_gr, n); a != INVALID; ++a) {
kpeter@807:             if (_comp[_gr.source(a)] == k) _in_arcs[n].push_back(a);
kpeter@807:           }
kpeter@807:         }
kpeter@805:       }
kpeter@807:     }
kpeter@807: 
kpeter@807:     // Build the policy graph in the given strongly connected component
kpeter@807:     // (the out-degree of every node is 1)
kpeter@807:     bool buildPolicyGraph(int comp) {
kpeter@807:       _nodes = &(_comp_nodes[comp]);
kpeter@807:       if (_nodes->size() < 1 ||
kpeter@807:           (_nodes->size() == 1 && _in_arcs[(*_nodes)[0]].size() == 0)) {
kpeter@807:         return false;
kpeter@805:       }
kpeter@807:       for (int i = 0; i < int(_nodes->size()); ++i) {
kpeter@814:         _dist[(*_nodes)[i]] = INF;
kpeter@807:       }
kpeter@807:       Node u, v;
kpeter@807:       Arc e;
kpeter@807:       for (int i = 0; i < int(_nodes->size()); ++i) {
kpeter@807:         v = (*_nodes)[i];
kpeter@807:         for (int j = 0; j < int(_in_arcs[v].size()); ++j) {
kpeter@807:           e = _in_arcs[v][j];
kpeter@807:           u = _gr.source(e);
kpeter@807:           if (_length[e] < _dist[u]) {
kpeter@807:             _dist[u] = _length[e];
kpeter@807:             _policy[u] = e;
kpeter@807:           }
kpeter@805:         }
kpeter@805:       }
kpeter@805:       return true;
kpeter@805:     }
kpeter@805: 
kpeter@807:     // Find the minimum mean cycle in the policy graph
kpeter@807:     void findPolicyCycle() {
kpeter@807:       for (int i = 0; i < int(_nodes->size()); ++i) {
kpeter@807:         _level[(*_nodes)[i]] = -1;
kpeter@807:       }
kpeter@808:       LargeValue clength;
kpeter@805:       int csize;
kpeter@805:       Node u, v;
kpeter@807:       _curr_found = false;
kpeter@807:       for (int i = 0; i < int(_nodes->size()); ++i) {
kpeter@807:         u = (*_nodes)[i];
kpeter@807:         if (_level[u] >= 0) continue;
kpeter@807:         for (; _level[u] < 0; u = _gr.target(_policy[u])) {
kpeter@807:           _level[u] = i;
kpeter@807:         }
kpeter@807:         if (_level[u] == i) {
kpeter@807:           // A cycle is found
kpeter@807:           clength = _length[_policy[u]];
kpeter@807:           csize = 1;
kpeter@807:           for (v = u; (v = _gr.target(_policy[v])) != u; ) {
kpeter@807:             clength += _length[_policy[v]];
kpeter@807:             ++csize;
kpeter@805:           }
kpeter@807:           if ( !_curr_found ||
kpeter@807:                (clength * _curr_size < _curr_length * csize) ) {
kpeter@807:             _curr_found = true;
kpeter@807:             _curr_length = clength;
kpeter@807:             _curr_size = csize;
kpeter@807:             _curr_node = u;
kpeter@805:           }
kpeter@805:         }
kpeter@805:       }
kpeter@805:     }
kpeter@805: 
kpeter@807:     // Contract the policy graph and compute node distances
kpeter@805:     bool computeNodeDistances() {
kpeter@807:       // Find the component of the main cycle and compute node distances
kpeter@807:       // using reverse BFS
kpeter@807:       for (int i = 0; i < int(_nodes->size()); ++i) {
kpeter@807:         _reached[(*_nodes)[i]] = false;
kpeter@807:       }
kpeter@807:       _qfront = _qback = 0;
kpeter@807:       _queue[0] = _curr_node;
kpeter@807:       _reached[_curr_node] = true;
kpeter@807:       _dist[_curr_node] = 0;
kpeter@805:       Node u, v;
kpeter@807:       Arc e;
kpeter@807:       while (_qfront <= _qback) {
kpeter@807:         v = _queue[_qfront++];
kpeter@807:         for (int j = 0; j < int(_in_arcs[v].size()); ++j) {
kpeter@807:           e = _in_arcs[v][j];
kpeter@805:           u = _gr.source(e);
kpeter@807:           if (_policy[u] == e && !_reached[u]) {
kpeter@807:             _reached[u] = true;
kpeter@808:             _dist[u] = _dist[v] + _length[e] * _curr_size - _curr_length;
kpeter@807:             _queue[++_qback] = u;
kpeter@805:           }
kpeter@805:         }
kpeter@805:       }
kpeter@807: 
kpeter@807:       // Connect all other nodes to this component and compute node
kpeter@807:       // distances using reverse BFS
kpeter@807:       _qfront = 0;
kpeter@807:       while (_qback < int(_nodes->size())-1) {
kpeter@807:         v = _queue[_qfront++];
kpeter@807:         for (int j = 0; j < int(_in_arcs[v].size()); ++j) {
kpeter@807:           e = _in_arcs[v][j];
kpeter@807:           u = _gr.source(e);
kpeter@807:           if (!_reached[u]) {
kpeter@807:             _reached[u] = true;
kpeter@807:             _policy[u] = e;
kpeter@808:             _dist[u] = _dist[v] + _length[e] * _curr_size - _curr_length;
kpeter@807:             _queue[++_qback] = u;
kpeter@807:           }
kpeter@807:         }
kpeter@807:       }
kpeter@807: 
kpeter@807:       // Improve node distances
kpeter@805:       bool improved = false;
kpeter@807:       for (int i = 0; i < int(_nodes->size()); ++i) {
kpeter@807:         v = (*_nodes)[i];
kpeter@807:         for (int j = 0; j < int(_in_arcs[v].size()); ++j) {
kpeter@807:           e = _in_arcs[v][j];
kpeter@807:           u = _gr.source(e);
kpeter@808:           LargeValue delta = _dist[v] + _length[e] * _curr_size - _curr_length;
kpeter@808:           if (_tolerance.less(delta, _dist[u])) {
kpeter@807:             _dist[u] = delta;
kpeter@807:             _policy[u] = e;
kpeter@807:             improved = true;
kpeter@807:           }
kpeter@805:         }
kpeter@805:       }
kpeter@805:       return improved;
kpeter@805:     }
kpeter@805: 
kpeter@811:   }; //class Howard
kpeter@805: 
kpeter@805:   ///@}
kpeter@805: 
kpeter@805: } //namespace lemon
kpeter@805: 
kpeter@811: #endif //LEMON_HOWARD_H