src/demo/min_route.cc
changeset 1342 e335eebdae5b
child 1358 a81fbbac3b4c
equal deleted inserted replaced
-1:000000000000 0:9f3f30de0868
       
     1 #include <lemon/smart_graph.h>
       
     2 #include <lemon/dijkstra.h>
       
     3 #include <lemon/maps.h>
       
     4 #include <lemon/xy.h>
       
     5 #include <lemon/graph_reader.h>
       
     6 
       
     7 #include <lemon/time_measure.h>
       
     8 
       
     9 #include <cmath>
       
    10 
       
    11 using namespace lemon;
       
    12 
       
    13 template <typename CoordMap>
       
    14 class PotentialMap {
       
    15 public:
       
    16   typedef double Value;
       
    17   typedef typename CoordMap::Key Key;
       
    18 
       
    19   PotentialMap(const CoordMap& _coord, const xy<double>& _target)
       
    20     : coord(_coord), target(_target) {}
       
    21 
       
    22   double operator[](const Key& node) const {
       
    23     return std::sqrt((coord[node].x - target.x) * (coord[node].x - target.x) + 
       
    24 		     (coord[node].y - target.y) * (coord[node].y - target.y));
       
    25   }
       
    26 private:
       
    27   xy<double> target;
       
    28   const CoordMap& coord;
       
    29 };
       
    30 
       
    31 template <typename Graph, typename LengthMap, typename PotentialMap>
       
    32 class ReducedLengthMap {
       
    33 public:
       
    34   typedef double Value;
       
    35   typedef typename LengthMap::Key Key;
       
    36 
       
    37   ReducedLengthMap(const Graph& _graph, const LengthMap& _length, 
       
    38 		   const PotentialMap& _pot) 
       
    39     : graph(_graph), length(_length), pot(_pot) {}
       
    40 
       
    41   Value operator[](const Key& edge) const {
       
    42     return length[edge] - (pot[graph.source(edge)] - pot[graph.target(edge)]);
       
    43   }
       
    44 
       
    45 private:
       
    46   const Graph& graph;
       
    47   const LengthMap& length;
       
    48   const PotentialMap& pot;
       
    49 };
       
    50 
       
    51 int main() {
       
    52   typedef SmartGraph Graph;
       
    53 
       
    54   typedef Graph::Edge Edge;
       
    55   typedef Graph::Node Node;
       
    56   typedef Graph::EdgeIt EdgeIt;
       
    57   typedef Graph::NodeIt NodeIt;
       
    58   typedef Graph::EdgeMap<double> LengthMap;
       
    59   typedef Graph::NodeMap<xy<double> > CoordMap;
       
    60 
       
    61   SmartGraph graph;
       
    62 
       
    63   GraphReader<Graph> reader(std::cin, graph);
       
    64   
       
    65   CoordMap coord(graph);
       
    66   XMap<CoordMap> xcoord = xMap(coord);
       
    67   reader.addNodeMap("coordinates_x", xcoord);
       
    68   YMap<CoordMap> ycoord = yMap(coord);
       
    69   reader.addNodeMap("coordinates_y", ycoord);
       
    70 
       
    71   LengthMap length(graph);
       
    72   reader.addEdgeMap("length", length);
       
    73 
       
    74   Node source, target;
       
    75   reader.addNode("source", source);
       
    76   reader.addNode("target", target);
       
    77 
       
    78   reader.run();
       
    79 
       
    80   {
       
    81     Timer timer;
       
    82     Dijkstra<Graph, LengthMap> dijkstra(graph, length);
       
    83     dijkstra.init();
       
    84     dijkstra.addSource(source);
       
    85     dijkstra.start(target);
       
    86 
       
    87     std::cout << dijkstra.dist(target) << std::endl;
       
    88     std::cout << timer << std::endl;
       
    89   }
       
    90 
       
    91   {
       
    92     Timer timer;
       
    93     typedef PotentialMap<CoordMap> Potential;
       
    94     Potential potential(coord, coord[target]);
       
    95 
       
    96     typedef ReducedLengthMap<Graph, LengthMap, Potential> ReducedLength;
       
    97     ReducedLength reduced(graph, length, potential);
       
    98 
       
    99     Dijkstra<Graph, ReducedLength> dijkstra(graph, reduced);
       
   100 
       
   101     dijkstra.init();
       
   102     dijkstra.addSource(source);
       
   103     dijkstra.start(target);
       
   104   
       
   105     std::cout << dijkstra.dist(target) + potential[source] << std::endl;
       
   106     std::cout << timer << std::endl;
       
   107   }
       
   108 
       
   109   return 0;
       
   110 }