Project without having to provide Boost none for derivatives.
parent
cb017fee80
commit
f8535c0bef
|
@ -87,7 +87,7 @@ namespace gtsam {
|
||||||
|
|
||||||
/// Evaluate error h(x)-z and optionally derivatives
|
/// Evaluate error h(x)-z and optionally derivatives
|
||||||
Vector evaluateError(const Pose3& pose, const Point3& point,
|
Vector evaluateError(const Pose3& pose, const Point3& point,
|
||||||
boost::optional<Matrix&> H1, boost::optional<Matrix&> H2) const {
|
boost::optional<Matrix&> H1 = boost::none, boost::optional<Matrix&> H2 = boost::none) const {
|
||||||
try {
|
try {
|
||||||
SimpleCamera camera(*K_, pose);
|
SimpleCamera camera(*K_, pose);
|
||||||
Point2 reprojectionError(camera.project(point, H1, H2) - measured_);
|
Point2 reprojectionError(camera.project(point, H1, H2) - measured_);
|
||||||
|
|
Loading…
Reference in New Issue