Resurgence (PY2022)
Codebase for the Husky Robotics 2021-2022 rover Resurgence
|
Kinematics object for a sequence of arm segments in a 2d plane. More...
#include <PlanarArmFK.h>
Public Member Functions | |
PlanarArmFK (const navtypes::Vectord< N > &segLens, const navtypes::Vectord< N > &jointMin, const navtypes::Vectord< N > &jointMax) | |
Construct a new kinematics object. | |
navtypes::Vectord< N > | getSegLens () const override |
Get the segment lengths for this arm. | |
bool | satisfiesConstraints (const navtypes::Vectord< N > &jointPos) const override |
Check if the given joint configuration is valid. | |
navtypes::Matrixd< 2, N > | getJacobian (const navtypes::Vectord< N > &jointPos) const override |
Get the jacobian matrix for the arm at the given joint angles. | |
Eigen::Vector2d | jointPosToEEPos (const navtypes::Vectord< N > &jointPos) const override |
Given a joint position, calculate the current EE position. | |
Public Member Functions inherited from kinematics::ForwardArmKinematics< 2, N > | |
constexpr unsigned int | getNumSegments () const |
Get the number of segments in this arm. | |
constexpr unsigned int | getNumDimensions () const |
Get the number of dimensions of the end effector space. | |
navtypes::Vectord< D > | jointVelToEEVel (const navtypes::Vectord< N > &jointPos, const navtypes::Vectord< N > &jointVel) const |
Calculate the EE velocity. | |
navtypes::Vectord< N > | eeVelToJointVel (const navtypes::Vectord< N > &jointPos, const Eigen::Vector2d &eeVel) const |
Calculates the joint velocity that yields the desired EE velocity. | |
Kinematics object for a sequence of arm segments in a 2d plane.
N | The number of joints. |
|
inline |
Construct a new kinematics object.
segLens | The length of each arm segment. |
jointMin | The minimum angle of each joint. Set to -pi for no limit. |
jointMax | The maximum angle of each joint. Set to pi for no limit. |
|
inlineoverridevirtual |
Get the jacobian matrix for the arm at the given joint angles.
jointPos | The joint angles of the arm. |
Implements kinematics::ForwardArmKinematics< 2, N >.
|
inlineoverridevirtual |
Get the segment lengths for this arm.
Implements kinematics::ForwardArmKinematics< 2, N >.
|
inlineoverridevirtual |
Given a joint position, calculate the current EE position.
jointPos | Current joint position. |
Implements kinematics::ForwardArmKinematics< 2, N >.
|
inlineoverridevirtual |
Check if the given joint configuration is valid.
jointPos | The joint positions to check. |
Implements kinematics::ForwardArmKinematics< 2, N >.