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

Re-did with move semantics. Dangerously imperative.

release/4.3a0
dellaert 2014-10-06 12:13:52 +02:00
parent f887ca47b9
commit c748fdb404
1 changed files with 3 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
gtsam_unstable/nonlinear/BADFactor.h
View File

@ -53,12 +53,11 @@ public:
typedef std::map<Key, Matrix> MapType; typedef std::map<Key, Matrix> MapType;
MapType terms; MapType terms;
Augmented<T> augmented = expression_.augmented(x); Augmented<T> augmented = expression_.augmented(x);
// copy terms to H, which is pre-allocated to correct size // move terms to H, which is pre-allocated to correct size
// TODO apply move semantics
size_t j = 0; size_t j = 0;
MapType::const_iterator it = augmented.jacobians().begin(); MapType::iterator it = augmented.jacobians().begin();
for (; it != augmented.jacobians().end(); ++it) for (; it != augmented.jacobians().end(); ++it)
(*H)[j++] = it->second; it->second.swap((*H)[j++]);
return measurement_.localCoordinates(augmented.value()); return measurement_.localCoordinates(augmented.value());
} else { } else {
const T& value = expression_.value(x); const T& value = expression_.value(x);