Function affordance_primitives::calculateLinearVelocity

Function Documentation

Eigen::Vector3d affordance_primitives::calculateLinearVelocity(const Eigen::Vector3d &axis, const Eigen::Vector3d &q_vector, const double pitch)

A helper function that calculates the linear velocity component of a Screw Axis.

Parameters:
  • axis – The axis of rotation

  • q_vector – The vector pointing from the ScrewAxis frame to the axis of rotation

  • pitch – The pitch of the screw axis

Returns:

A vector representing the “normalized” (which may not have norm==1) linear velocity of the screw