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

add #include <iostream>

release/4.3a0
Yong-Dian Jian 2012-10-08 01:35:00 +00:00
parent d8c1f58eea
commit 535809c1c6
1 changed files with 5 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
gtsam/slam/GeneralSFMFactor.h
View File

@ -25,6 +25,7 @@
#include <gtsam/geometry/PinholeCamera.h> #include <gtsam/geometry/PinholeCamera.h>
#include <gtsam/geometry/Point2.h> #include <gtsam/geometry/Point2.h>
#include <gtsam/geometry/Point3.h> #include <gtsam/geometry/Point3.h>
#include <iostream>
namespace gtsam { namespace gtsam {
@ -98,8 +99,8 @@ namespace gtsam {
catch( CheiralityException& e) { catch( CheiralityException& e) {
if (H1) *H1 = zeros(2, camera.dim()); if (H1) *H1 = zeros(2, camera.dim());
if (H2) *H2 = zeros(2, point.dim()); if (H2) *H2 = zeros(2, point.dim());
cout << e.what() << ": Landmark "<< DefaultKeyFormatter(this->key2()) std::cout << e.what() << ": Landmark "<< DefaultKeyFormatter(this->key2())
<< " behind Camera " << DefaultKeyFormatter(this->key1()) << endl; << " behind Camera " << DefaultKeyFormatter(this->key1()) << endl;
} }
return zero(2); return zero(2);
} }
@ -191,8 +192,8 @@ namespace gtsam {
if (H1) *H1 = zeros(2, pose3.dim()); if (H1) *H1 = zeros(2, pose3.dim());
if (H2) *H2 = zeros(2, point.dim()); if (H2) *H2 = zeros(2, point.dim());
if (H3) *H3 = zeros(2, calib.dim()); if (H3) *H3 = zeros(2, calib.dim());
cout << e.what() << ": Landmark "<< DefaultKeyFormatter(this->key2()) std::cout << e.what() << ": Landmark "<< DefaultKeyFormatter(this->key2())
<< " behind Camera " << DefaultKeyFormatter(this->key1()) << endl; << " behind Camera " << DefaultKeyFormatter(this->key1()) << endl;
} }
return zero(2); return zero(2);
} }