12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

remove commented code

release/4.3a0
Christian Forster 2014-12-02 18:41:50 -05:00
parent c43e77cdfa
commit 6c92914db1
1 changed files with 0 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
gtsam/slam/BetweenFactor.h
View File

@ -90,13 +90,8 @@ namespace gtsam {
Vector evaluateError(const T& p1, const T& p2, Vector evaluateError(const T& p1, const T& p2,
boost::optional<Matrix&> H1 = boost::none,boost::optional<Matrix&> H2 = boost::optional<Matrix&> H1 = boost::none,boost::optional<Matrix&> H2 =
boost::none) const { boost::none) const {
T hx = p1.between(p2, H1, H2); // h(x) T hx = p1.between(p2, H1, H2); // h(x)
DefaultChart<T> chart; DefaultChart<T> chart;
//T hx = chart.local(p2, p1);
//if(H1) (*H1) = -eye(chart.getDimension(p1));
//if(H2) (*H2) = eye(chart.getDimension(p2));
// manifold equivalent of h(x)-z -> log(z,h(x)) // manifold equivalent of h(x)-z -> log(z,h(x))
return chart.local(measured_, hx); return chart.local(measured_, hx);
} }