libcarla/include/system/boost/graph/king_ordering.hpp

347 lines
12 KiB
C++
Raw Permalink Normal View History

2024-10-18 13:19:59 +08:00
//=======================================================================
// Copyright 1997, 1998, 1999, 2000 University of Notre Dame.
// Copyright 2004, 2005 Trustees of Indiana University
// Authors: Andrew Lumsdaine, Lie-Quan Lee, Jeremy G. Siek,
// Doug Gregor, D. Kevin McGrath
//
// Distributed under the Boost Software License, Version 1.0. (See
// accompanying file LICENSE_1_0.txt or copy at
// http://www.boost.org/LICENSE_1_0.txt)
//=======================================================================//
#ifndef BOOST_GRAPH_KING_HPP
#define BOOST_GRAPH_KING_HPP
#include <deque>
#include <vector>
#include <algorithm>
#include <boost/config.hpp>
#include <boost/bind/bind.hpp>
#include <boost/tuple/tuple.hpp>
#include <boost/graph/detail/sparse_ordering.hpp>
#include <boost/graph/graph_utility.hpp>
/*
King Algorithm for matrix reordering
*/
namespace boost
{
namespace detail
{
template < typename OutputIterator, typename Buffer, typename Compare,
typename PseudoDegreeMap, typename VecMap, typename VertexIndexMap >
class bfs_king_visitor : public default_bfs_visitor
{
public:
bfs_king_visitor(OutputIterator* iter, Buffer* b, Compare compare,
PseudoDegreeMap deg, std::vector< int > loc, VecMap color,
VertexIndexMap vertices)
: permutation(iter)
, Qptr(b)
, degree(deg)
, comp(compare)
, Qlocation(loc)
, colors(color)
, vertex_map(vertices)
{
}
template < typename Vertex, typename Graph >
void finish_vertex(Vertex, Graph& g)
{
using namespace boost::placeholders;
typename graph_traits< Graph >::out_edge_iterator ei, ei_end;
Vertex v, w;
typedef typename std::deque< Vertex >::reverse_iterator
reverse_iterator;
reverse_iterator rend = Qptr->rend() - index_begin;
reverse_iterator rbegin = Qptr->rbegin();
// heap the vertices already there
std::make_heap(rbegin, rend, boost::bind< bool >(comp, _2, _1));
unsigned i = 0;
for (i = index_begin; i != Qptr->size(); ++i)
{
colors[get(vertex_map, (*Qptr)[i])] = 1;
Qlocation[get(vertex_map, (*Qptr)[i])] = i;
}
i = 0;
for (; rbegin != rend; rend--)
{
percolate_down< Vertex >(i);
w = (*Qptr)[index_begin + i];
for (boost::tie(ei, ei_end) = out_edges(w, g); ei != ei_end;
++ei)
{
v = target(*ei, g);
put(degree, v, get(degree, v) - 1);
if (colors[get(vertex_map, v)] == 1)
{
percolate_up< Vertex >(get(vertex_map, v), i);
}
}
colors[get(vertex_map, w)] = 0;
i++;
}
}
template < typename Vertex, typename Graph >
void examine_vertex(Vertex u, const Graph&)
{
*(*permutation)++ = u;
index_begin = Qptr->size();
}
protected:
// this function replaces pop_heap, and tracks state information
template < typename Vertex > void percolate_down(int offset)
{
int heap_last = index_begin + offset;
int heap_first = Qptr->size() - 1;
// pop_heap functionality:
// swap first, last
std::swap((*Qptr)[heap_last], (*Qptr)[heap_first]);
// swap in the location queue
std::swap(Qlocation[heap_first], Qlocation[heap_last]);
// set drifter, children
int drifter = heap_first;
int drifter_heap = Qptr->size() - drifter;
int right_child_heap = drifter_heap * 2 + 1;
int right_child = Qptr->size() - right_child_heap;
int left_child_heap = drifter_heap * 2;
int left_child = Qptr->size() - left_child_heap;
// check that we are staying in the heap
bool valid = (right_child < heap_last) ? false : true;
// pick smallest child of drifter, and keep in mind there might only
// be left child
int smallest_child = (valid
&& get(degree, (*Qptr)[left_child])
> get(degree, (*Qptr)[right_child]))
? right_child
: left_child;
while (valid && smallest_child < heap_last
&& comp((*Qptr)[drifter], (*Qptr)[smallest_child]))
{
// if smallest child smaller than drifter, swap them
std::swap((*Qptr)[smallest_child], (*Qptr)[drifter]);
std::swap(Qlocation[drifter], Qlocation[smallest_child]);
// update the values, run again, as necessary
drifter = smallest_child;
drifter_heap = Qptr->size() - drifter;
right_child_heap = drifter_heap * 2 + 1;
right_child = Qptr->size() - right_child_heap;
left_child_heap = drifter_heap * 2;
left_child = Qptr->size() - left_child_heap;
valid = (right_child < heap_last) ? false : true;
smallest_child = (valid
&& get(degree, (*Qptr)[left_child])
> get(degree, (*Qptr)[right_child]))
? right_child
: left_child;
}
}
// this is like percolate down, but we always compare against the
// parent, as there is only a single choice
template < typename Vertex > void percolate_up(int vertex, int offset)
{
int child_location = Qlocation[vertex];
int heap_child_location = Qptr->size() - child_location;
int heap_parent_location = (int)(heap_child_location / 2);
unsigned parent_location = Qptr->size() - heap_parent_location;
bool valid = (heap_parent_location != 0
&& child_location > index_begin + offset
&& parent_location < Qptr->size());
while (valid
&& comp((*Qptr)[child_location], (*Qptr)[parent_location]))
{
// swap in the heap
std::swap((*Qptr)[child_location], (*Qptr)[parent_location]);
// swap in the location queue
std::swap(
Qlocation[child_location], Qlocation[parent_location]);
child_location = parent_location;
heap_child_location = heap_parent_location;
heap_parent_location = (int)(heap_child_location / 2);
parent_location = Qptr->size() - heap_parent_location;
valid = (heap_parent_location != 0
&& child_location > index_begin + offset);
}
}
OutputIterator* permutation;
int index_begin;
Buffer* Qptr;
PseudoDegreeMap degree;
Compare comp;
std::vector< int > Qlocation;
VecMap colors;
VertexIndexMap vertex_map;
};
} // namespace detail
template < class Graph, class OutputIterator, class ColorMap, class DegreeMap,
typename VertexIndexMap >
OutputIterator king_ordering(const Graph& g,
std::deque< typename graph_traits< Graph >::vertex_descriptor >
vertex_queue,
OutputIterator permutation, ColorMap color, DegreeMap degree,
VertexIndexMap index_map)
{
typedef typename property_traits< DegreeMap >::value_type ds_type;
typedef typename property_traits< ColorMap >::value_type ColorValue;
typedef color_traits< ColorValue > Color;
typedef typename graph_traits< Graph >::vertex_descriptor Vertex;
typedef iterator_property_map< typename std::vector< ds_type >::iterator,
VertexIndexMap, ds_type, ds_type& >
PseudoDegreeMap;
typedef indirect_cmp< PseudoDegreeMap, std::less< ds_type > > Compare;
typedef typename boost::sparse::sparse_ordering_queue< Vertex > queue;
typedef typename detail::bfs_king_visitor< OutputIterator, queue, Compare,
PseudoDegreeMap, std::vector< int >, VertexIndexMap >
Visitor;
typedef
typename graph_traits< Graph >::vertices_size_type vertices_size_type;
std::vector< ds_type > pseudo_degree_vec(num_vertices(g));
PseudoDegreeMap pseudo_degree(pseudo_degree_vec.begin(), index_map);
typename graph_traits< Graph >::vertex_iterator ui, ui_end;
queue Q;
// Copy degree to pseudo_degree
// initialize the color map
for (boost::tie(ui, ui_end) = vertices(g); ui != ui_end; ++ui)
{
put(pseudo_degree, *ui, get(degree, *ui));
put(color, *ui, Color::white());
}
Compare comp(pseudo_degree);
std::vector< int > colors(num_vertices(g));
for (vertices_size_type i = 0; i < num_vertices(g); i++)
colors[i] = 0;
std::vector< int > loc(num_vertices(g));
// create the visitor
Visitor vis(&permutation, &Q, comp, pseudo_degree, loc, colors, index_map);
while (!vertex_queue.empty())
{
Vertex s = vertex_queue.front();
vertex_queue.pop_front();
// call BFS with visitor
breadth_first_visit(g, s, Q, vis, color);
}
return permutation;
}
// This is the case where only a single starting vertex is supplied.
template < class Graph, class OutputIterator, class ColorMap, class DegreeMap,
typename VertexIndexMap >
OutputIterator king_ordering(const Graph& g,
typename graph_traits< Graph >::vertex_descriptor s,
OutputIterator permutation, ColorMap color, DegreeMap degree,
VertexIndexMap index_map)
{
std::deque< typename graph_traits< Graph >::vertex_descriptor >
vertex_queue;
vertex_queue.push_front(s);
return king_ordering(
g, vertex_queue, permutation, color, degree, index_map);
}
template < class Graph, class OutputIterator, class ColorMap, class DegreeMap,
class VertexIndexMap >
OutputIterator king_ordering(const Graph& G, OutputIterator permutation,
ColorMap color, DegreeMap degree, VertexIndexMap index_map)
{
if (has_no_vertices(G))
return permutation;
typedef typename boost::graph_traits< Graph >::vertex_descriptor Vertex;
typedef typename property_traits< ColorMap >::value_type ColorValue;
typedef color_traits< ColorValue > Color;
std::deque< Vertex > vertex_queue;
// Mark everything white
BGL_FORALL_VERTICES_T(v, G, Graph) put(color, v, Color::white());
// Find one vertex from each connected component
BGL_FORALL_VERTICES_T(v, G, Graph)
{
if (get(color, v) == Color::white())
{
depth_first_visit(G, v, dfs_visitor<>(), color);
vertex_queue.push_back(v);
}
}
// Find starting nodes for all vertices
// TBD: How to do this with a directed graph?
for (typename std::deque< Vertex >::iterator i = vertex_queue.begin();
i != vertex_queue.end(); ++i)
*i = find_starting_node(G, *i, color, degree);
return king_ordering(
G, vertex_queue, permutation, color, degree, index_map);
}
template < typename Graph, typename OutputIterator, typename VertexIndexMap >
OutputIterator king_ordering(
const Graph& G, OutputIterator permutation, VertexIndexMap index_map)
{
if (has_no_vertices(G))
return permutation;
std::vector< default_color_type > colors(num_vertices(G));
return king_ordering(G, permutation,
make_iterator_property_map(&colors[0], index_map, colors[0]),
make_out_degree_map(G), index_map);
}
template < typename Graph, typename OutputIterator >
inline OutputIterator king_ordering(const Graph& G, OutputIterator permutation)
{
return king_ordering(G, permutation, get(vertex_index, G));
}
} // namespace boost
#endif // BOOST_GRAPH_KING_HPP