almost done: need to:
- fix jacobian for reprojection error of the spherical camera - need to improve DLT to fully leverage range of spherical camerarelease/4.3a0
parent
ff33eb614d
commit
09853bfa13
|
|
@ -95,7 +95,7 @@ Unit3 SphericalCamera::project(const Point3& point,
|
||||||
Vector2 SphericalCamera::reprojectionError(const Point3& point, const Unit3& measured,
|
Vector2 SphericalCamera::reprojectionError(const Point3& point, const Unit3& measured,
|
||||||
OptionalJacobian<2, 6> Dpose,
|
OptionalJacobian<2, 6> Dpose,
|
||||||
OptionalJacobian<2, 3> Dpoint) const {
|
OptionalJacobian<2, 3> Dpoint) const {
|
||||||
// onmanifold version of: camera.project(point) - zi
|
// on-manifold version of: camera.project(point) - zi
|
||||||
std::cout << "SphericalCam:reprojectionError fix jacobians " << std::endl;
|
std::cout << "SphericalCam:reprojectionError fix jacobians " << std::endl;
|
||||||
return measured.localCoordinates( project2(point, Dpose, Dpoint) );
|
return measured.localCoordinates( project2(point, Dpose, Dpoint) );
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -30,21 +30,13 @@
|
||||||
namespace gtsam {
|
namespace gtsam {
|
||||||
|
|
||||||
class GTSAM_EXPORT EmptyCal {
|
class GTSAM_EXPORT EmptyCal {
|
||||||
protected:
|
|
||||||
Matrix3 K_;
|
|
||||||
public:
|
public:
|
||||||
|
EmptyCal(){}
|
||||||
///< shared pointer to calibration object
|
|
||||||
EmptyCal()
|
|
||||||
: K_(Matrix3::Identity()) {
|
|
||||||
}
|
|
||||||
/// Default destructor
|
|
||||||
virtual ~EmptyCal() = default;
|
virtual ~EmptyCal() = default;
|
||||||
using shared_ptr = boost::shared_ptr<EmptyCal>;
|
using shared_ptr = boost::shared_ptr<EmptyCal>;
|
||||||
void print(const std::string& s) const {
|
void print(const std::string& s) const {
|
||||||
std::cout << "empty calibration: " << s << std::endl;
|
std::cout << "empty calibration: " << s << std::endl;
|
||||||
}
|
}
|
||||||
Matrix3 K() const {return K_;}
|
|
||||||
};
|
};
|
||||||
|
|
||||||
//
|
//
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue