compute_arc_length()

double MayaFlux::Kinesis::compute_arc_length

(

const Eigen::MatrixXd &

points

)

Compute arc length of curve using trapezoidal rule.

Parameters

points

Columns are sequential points along curve

Returns

Estimated arc length

Definition at line 394 of file MotionCurves.cpp.

{
    if (points.cols() < 2) {
        return 0.0;
    }
 
    double length = 0.0;
    for (Eigen::Index i = 1; i < points.cols(); ++i) {
        length += (points.col(i) - points.col(i - 1)).norm();
    }
 
    return length;
}