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

Comments, renaming

release/4.3a0
dellaert 2014-12-12 07:45:09 +01:00
parent 8cc813f03e
commit fa7071bdd8
1 changed files with 6 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
gtsam_unstable/slam/tests/testTOAFactor.cpp
View File

@ -61,8 +61,10 @@ public:
/// @{
/**
* Add an Expression factor directly
* Which implements |h(x)-z|^2_R
* Directly add ExpressionFactor that implements |h(x)-z|^2_R
* @param h expression that implements measurement function
* @param z measurement
* @param R model
*/
template<typename T>
void addExpressionFactor(const Expression<T>& h, const T& z,
@ -201,8 +203,8 @@ TEST( TOAFactor, RealExperiment1 ) {
ExpressionFactorGraph graph;
for (size_t i = 0; i < 4; i++) {
for (size_t j = 0; j < 15; j++) {
Double_ predictTOA_ij(&Event::toa, unknownEvents[j], microphones[i]);
graph.addExpressionFactor(predictTOA_ij, data[j][i], model);
Double_ h_ij(&Event::toa, unknownEvents[j], microphones[i]);
graph.addExpressionFactor(h_ij, data[j][i], model);
}
}