From 92e5f0d80b0aacb10fff6aa287ee20d1a94c29d9 Mon Sep 17 00:00:00 2001
From: Joseph Mirabel <jmirabel@laas.fr>
Date: Wed, 18 May 2016 20:54:47 +0200
Subject: [PATCH] Add Node::getWeight
---
include/hpp/manipulation/graph/node.hh | 2 ++
src/graph/node.cc | 12 ++++++++++++
2 files changed, 14 insertions(+)
diff --git a/include/hpp/manipulation/graph/node.hh b/include/hpp/manipulation/graph/node.hh
index b5c6c590..9c6d2b18 100644
--- a/include/hpp/manipulation/graph/node.hh
+++ b/include/hpp/manipulation/graph/node.hh
@@ -100,6 +100,8 @@ namespace hpp {
void updateWeight (const EdgePtr_t&edge, const Weight_t& w);
+ Weight_t getWeight (const EdgePtr_t&edge);
+
/// Constraint to project onto this node.
ConstraintSetPtr_t configConstraint() const;
diff --git a/src/graph/node.cc b/src/graph/node.cc
index dfbabe64..b8fbb2d0 100644
--- a/src/graph/node.cc
+++ b/src/graph/node.cc
@@ -137,6 +137,18 @@ namespace hpp {
}
hppDout (error, "Edge not found");
}
+
+ Weight_t Node::getWeight (const EdgePtr_t& e)
+ {
+ for (Neighbors_t::const_iterator it = neighbors_.begin();
+ it != neighbors_.end(); ++it)
+ if (it->second == e) return it->first;
+ for (std::vector<EdgePtr_t>::const_iterator it = hiddenNeighbors_.begin();
+ it != hiddenNeighbors_.end(); ++it)
+ if (*it == e) return -1;
+ hppDout (error, "Edge not found");
+ return 0;
+ }
} // namespace graph
} // namespace manipulation
} // namespace hpp
--
GitLab