Fixed error
parent
4d117037a5
commit
6944e884c9
|
|
@ -83,7 +83,7 @@ namespace gtsam {
|
||||||
boost::optional<Matrix&> H1=boost::none, boost::optional<Matrix&> H2=boost::none) const {
|
boost::optional<Matrix&> H1=boost::none, boost::optional<Matrix&> H2=boost::none) const {
|
||||||
|
|
||||||
try {
|
try {
|
||||||
Point2 reprojError(camera.project2(point,H1,H2) - z_);
|
Point2 reprojError(camera.project2(point,H1,H2) - measured_);
|
||||||
return reprojError.vector();
|
return reprojError.vector();
|
||||||
}
|
}
|
||||||
catch( CheiralityException& e) {
|
catch( CheiralityException& e) {
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue