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

Fixed Remaining problems with GUI

release/4.3a0
Frank Dellaert 2012-06-14 03:14:53 +00:00
parent dd0574ebeb
commit 436afafa03
2 changed files with 4 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
gtsam/nonlinear/Values.cpp
View File

@ -165,10 +165,8 @@ namespace gtsam {
/* ************************************************************************* */
FastList<Key> Values::keys() const {
FastList<Key> result;
for(const_iterator key_value = begin(); key_value != end(); ++key_value) {
for(const_iterator key_value = begin(); key_value != end(); ++key_value)
result.push_back(key_value->key);
cout << result.back() << endl;
}
return result;
}

6
matlab/VisualISAMPlot.m
View File

@ -10,9 +10,9 @@ cla(h);
hold on;
%% Plot points
pointKeys = result.allPoints().keys();
for j=0:N-1 % NOTE: uses indexing directly from a C++ vector, so zero-indexed
jj = pointKeys.at(j);
for k=1:length(data.J{M})
j = data.J{M}{k};
jj = symbol('l', j);
point_j = result.point(jj);
plot3(point_j.x, point_j.y, point_j.z,'marker','o');
P = isam.marginalCovariance(jj);