Skip to content
New issue

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

The mathematical detail in BSpline::curveQuadraticIntegralDiag() #17

Open
chengfzy opened this issue Sep 14, 2020 · 0 comments
Open

The mathematical detail in BSpline::curveQuadraticIntegralDiag() #17

chengfzy opened this issue Sep 14, 2020 · 0 comments

Comments

@chengfzy
Copy link

chengfzy commented Sep 14, 2020

It's the same issue from ethz-asl/kalibr#383

Hello, everyone. I'm studying the code of kalibr and trying to figure out the algorithm details for IMU-Camera calibration. kalibr uses the BSpline to represent the trajectory of IMU(or camera), and in the BSpline initialization, the below methods are called.

  1. void BSplinePose::initPoseSplineSparse(const Eigen::VectorXd & times, const Eigen::Matrix<double,6,Eigen::Dynamic> & poses, int numSegments, double lambda), see code in line
  2. Then call void BSpline::initSplineSparse(const Eigen::VectorXd & times, const Eigen::MatrixXd & interpolationPoints, int numSegments, double lambda), see code in line

I'm trying to understand the mathematics detail in BSpline::initSplineSparse(). Currently, I have understand several things,

  1. The method void BSpline::initSplineSparse() is the sparse version of `void BSpline::initSpline3()', see code in line
  2. The initialization method will build a equation Ax = B
  3. The first part of the equation is C(t) = U(t) * M * V, which means the BSpline value evaluated at time t will be C(t).
  4. The second part of the equation assumes the quadratic integral is zero during each segment.
    // make this conditional on the order of the spline:
    if (splineOrder_ == 2)
        A += curveQuadraticIntegralDiag(W, 1);
    else
        A += curveQuadraticIntegralDiag(W, 2);

However, I couldn't understand the mathematical details in method Eigen::MatrixXd BSpline::curveQuadraticIntegralDiag(const Eigen::VectorXd& Wdiag, int derivativeOrder)(see code in line). Is anyone know the details? or some paper could be referenced?

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

No branches or pull requests

1 participant