We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
inline void Project(const Rigid3D &T12, const Point2D &x1, LA::Vector2f &x2, LA::Vector2f &Jx2) const { const xp128f t = xp128f::get(x1.x(), x1.y(), 1.0f, u()); const float d12 = 1.0f / (T12.r20_r21_r22_tz() * t).vsum_all(); x2.x() = (T12.r00_r01_r02_tx() * t).vsum_all() * d12; x2.y() = (T12.r10_r11_r12_ty() * t).vsum_all() * d12; Jx2.x() = (T12.tx() - x2.x() * T12.tz()) * d12; Jx2.y() = (T12.ty() - x2.y() * T12.tz()) * d12; }
i think the jacobian should be
Jx2.x() = (T12.tx() - d12 * x2.x() * T12.tz()) * d12; Jx2.y() = (T12.ty() - d12 * x2.y() * T12.tz()) * d12;
The text was updated successfully, but these errors were encountered:
No branches or pull requests
inline void Project(const Rigid3D &T12, const Point2D &x1, LA::Vector2f &x2,
LA::Vector2f &Jx2) const {
const xp128f t = xp128f::get(x1.x(), x1.y(), 1.0f, u());
const float d12 = 1.0f / (T12.r20_r21_r22_tz() * t).vsum_all();
x2.x() = (T12.r00_r01_r02_tx() * t).vsum_all() * d12;
x2.y() = (T12.r10_r11_r12_ty() * t).vsum_all() * d12;
Jx2.x() = (T12.tx() - x2.x() * T12.tz()) * d12;
Jx2.y() = (T12.ty() - x2.y() * T12.tz()) * d12;
}
i think the jacobian should be
Jx2.x() = (T12.tx() - d12 * x2.x() * T12.tz()) * d12;
Jx2.y() = (T12.ty() - d12 * x2.y() * T12.tz()) * d12;
The text was updated successfully, but these errors were encountered: