Class sym::PolynomialCameraCal#

template<typename ScalarType> class PolynomialCameraCal#

Autogenerated C++ implementation of symforce.cam.polynomial_camera_cal.PolynomialCameraCal.

Polynomial camera model in the style of OpenCV

Distortion is a multiplicative factor applied to the image plane coordinates in the camera frame. Mapping between distorted image plane coordinates and image coordinates is done using a standard linear model.

The distortion function is a 6th order even polynomial that is a function of the radius of the image plane coordinates::

r = (p_img[0] ** 2 + p_img[1] ** 2) ** 0.5
distorted_weight = 1 + c0 * r^2 + c1 * r^4 + c2 * r^6
uv = p_img * distorted_weight

Public Types

using Scalar = ScalarType #

using Self = PolynomialCameraCal<Scalar>#

using DataVec = Eigen::Matrix<Scalar, 8, 1>#

Public Functions

inline PolynomialCameraCal(const Eigen::Matrix<Scalar, 2, 1> &focal_length, const Eigen::Matrix<Scalar, 2, 1> &principal_point, const Scalar critical_undistorted_radius, const Eigen::Matrix<Scalar, 3, 1> &distortion_coeffs)#

inline explicit PolynomialCameraCal(const DataVec &data, bool normalize = true)#

Construct from data vec

Parameters:: normalize – Project to the manifold on construction. This ensures numerical stability as this constructor is called after each codegen operation. Constructing from a normalized vector may be faster, e.g. with FromStorage.

inline const DataVec &Data() const#

inline void ToStorage(Scalar *const vec) const#

Eigen::Matrix<Scalar, 2, 1> FocalLength() const#: Return the focal length.

Eigen::Matrix<Scalar, 2, 1> PrincipalPoint() const#: Return the principal point.

Eigen::Matrix<Scalar, 2, 1> PixelFromCameraPoint(const Eigen::Matrix<Scalar, 3, 1> &point, const Scalar epsilon, Scalar *const is_valid = nullptr) const#

Project a 3D point in the camera frame into 2D pixel coordinates.

Returns: pixel: (x, y) coordinate in pixels if valid is_valid: 1 if the operation is within bounds else 0

Eigen::Matrix<Scalar, 2, 1> PixelFromCameraPointWithJacobians(const Eigen::Matrix<Scalar, 3, 1> &point, const Scalar epsilon, Scalar *const is_valid = nullptr, Eigen::Matrix<Scalar, 2, 7> *const pixel_D_cal = nullptr, Eigen::Matrix<Scalar, 2, 3> *const pixel_D_point = nullptr) const#

Project a 3D point in the camera frame into 2D pixel coordinates.

Returns: pixel: (x, y) coordinate in pixels if valid is_valid: 1 if the operation is within bounds else 0 pixel_D_cal: Derivative of pixel with respect to intrinsic calibration parameters pixel_D_point: Derivative of pixel with respect to point

inline bool IsApprox(const Self &b, const Scalar tol) const#

template<typename ToScalar> inline PolynomialCameraCal<ToScalar> Cast() const#

inline bool operator==(const PolynomialCameraCal &rhs) const#

Public Static Functions

static inline constexpr int32_t StorageDim()#

static inline PolynomialCameraCal FromStorage(const Scalar *const vec)#