show msg where point is behind camera
parent
16743bacd8
commit
d8c1f58eea
|
@ -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);
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue