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

Fixed compile error

release/4.3a0
dellaert 2016-02-12 13:14:44 -08:00
parent 8dd42c8ce5
commit 3a7c8542b0
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
matlab.h
View File

@ -103,7 +103,7 @@ Matrix extractPoint3(const Values& values) {
Matrix result(points.size(), 3);
size_t j = 0;
BOOST_FOREACH(const Values::ConstFiltered<Point3>::KeyValuePair& key_value, points)
result.row(j++) = key_value.value.vector();
result.row(j++) = key_value.value;
return result;
}
@ -131,7 +131,7 @@ Matrix extractPose3(const Values& values) {
result.row(j).segment(0, 3) << key_value.value.rotation().matrix().row(0);
result.row(j).segment(3, 3) << key_value.value.rotation().matrix().row(1);
result.row(j).segment(6, 3) << key_value.value.rotation().matrix().row(2);
result.row(j).tail(3) = key_value.value.translation().vector();
result.row(j).tail(3) = key_value.value.translation();
j++;
}
return result;