show msg where point is behind camera

release/4.3a0
Yong-Dian Jian 2012-10-08 01:25:18 +00:00
parent 16743bacd8
commit d8c1f58eea
1 changed files with 4 additions and 4 deletions

View File

@ -98,8 +98,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 "<< this->key2_.index() cout << e.what() << ": Landmark "<< DefaultKeyFormatter(this->key2())
// << " behind Camera " << this->key1_.index() << endl; << " behind Camera " << DefaultKeyFormatter(this->key1()) << endl;
} }
return zero(2); return zero(2);
} }
@ -191,8 +191,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 "<< this->key2_.index() cout << e.what() << ": Landmark "<< DefaultKeyFormatter(this->key2())
// << " behind Camera " << this->key1_.index() << endl; << " behind Camera " << DefaultKeyFormatter(this->key1()) << endl;
} }
return zero(2); return zero(2);
} }