|
internal status of the controller, containing intermediate variables, mutable targets More...
#include <armarx/control/common/control_law/SafetyTaskspaceImpedanceController.h>
Classes | |
struct | jointRangeBufferZoneData |
joint limit avoidance initialization parameters More... | |
struct | selfCollisionData |
internal status of the controller, containing intermediate variables, mutable targets
Definition at line 58 of file SafetyTaskspaceImpedanceController.h.
int activeCollPairsNum |
Definition at line 310 of file SafetyTaskspaceImpedanceController.h.
simox::control::environment::DistanceResult activeDistPair |
Definition at line 223 of file SafetyTaskspaceImpedanceController.h.
int collisionPairsNum |
collision pair info
Definition at line 309 of file SafetyTaskspaceImpedanceController.h.
double collisionPairTime |
time status
Definition at line 301 of file SafetyTaskspaceImpedanceController.h.
double collisionTorqueTime |
Definition at line 303 of file SafetyTaskspaceImpedanceController.h.
Eigen::Vector6f currentForceTorque |
force torque
Definition at line 66 of file SafetyTaskspaceImpedanceController.h.
Eigen::Matrix4f currentPose |
Definition at line 77 of file SafetyTaskspaceImpedanceController.h.
Eigen::Vector6f currentTwist |
Definition at line 78 of file SafetyTaskspaceImpedanceController.h.
float dampingJointLim |
Definition at line 288 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf desiredJointTorques |
targets
Definition at line 61 of file SafetyTaskspaceImpedanceController.h.
float desiredNullSpace |
Definition at line 111 of file SafetyTaskspaceImpedanceController.h.
Eigen::Matrix4f desiredPose |
Definition at line 79 of file SafetyTaskspaceImpedanceController.h.
Eigen::Vector3f dirErrorImp |
Definition at line 86 of file SafetyTaskspaceImpedanceController.h.
std::vector<selfCollisionData> evalData |
Definition at line 224 of file SafetyTaskspaceImpedanceController.h.
int evalDataIndex |
Definition at line 225 of file SafetyTaskspaceImpedanceController.h.
Eigen::Vector6f forceImpedance |
task space variables
Definition at line 69 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXd getActuatedJointValues |
Definition at line 321 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf impedanceJointTorque |
intermediate torque results
Definition at line 92 of file SafetyTaskspaceImpedanceController.h.
float impForceRatio |
Definition at line 106 of file SafetyTaskspaceImpedanceController.h.
float impTorqueRatio |
Definition at line 105 of file SafetyTaskspaceImpedanceController.h.
Eigen::MatrixXf inertia |
Definition at line 296 of file SafetyTaskspaceImpedanceController.h.
Eigen::MatrixXf inertiaInverse |
Definition at line 297 of file SafetyTaskspaceImpedanceController.h.
Eigen::MatrixXf jacobi |
others
Definition at line 294 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf jointDampingTorque |
Definition at line 63 of file SafetyTaskspaceImpedanceController.h.
float jointInertia |
Definition at line 285 of file SafetyTaskspaceImpedanceController.h.
std::vector<jointRangeBufferZoneData> jointLimitData |
Definition at line 281 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf jointLimitJointTorque |
Definition at line 95 of file SafetyTaskspaceImpedanceController.h.
double jointLimitNullspaceTime |
Definition at line 306 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf jointLimitTorqueFiltered |
Definition at line 98 of file SafetyTaskspaceImpedanceController.h.
double jointLimitTorqueTime |
Definition at line 304 of file SafetyTaskspaceImpedanceController.h.
Eigen::MatrixXf jointLimNullSpace |
Definition at line 110 of file SafetyTaskspaceImpedanceController.h.
Eigen::MatrixXf jointLimNullSpaceFiltered |
Definition at line 114 of file SafetyTaskspaceImpedanceController.h.
float jointVel |
joint limit avoidance intermediate results
Definition at line 284 of file SafetyTaskspaceImpedanceController.h.
Eigen::MatrixXf jtpinv |
Definition at line 295 of file SafetyTaskspaceImpedanceController.h.
float k1 |
self-collision avoidance null space intermediate results
Definition at line 228 of file SafetyTaskspaceImpedanceController.h.
float k1Hi |
Definition at line 291 of file SafetyTaskspaceImpedanceController.h.
float k1Lo |
Definition at line 290 of file SafetyTaskspaceImpedanceController.h.
float k2 |
Definition at line 228 of file SafetyTaskspaceImpedanceController.h.
float k2Hi |
Definition at line 291 of file SafetyTaskspaceImpedanceController.h.
float k2Lo |
Definition at line 290 of file SafetyTaskspaceImpedanceController.h.
float k3 |
Definition at line 228 of file SafetyTaskspaceImpedanceController.h.
float k3Hi |
Definition at line 291 of file SafetyTaskspaceImpedanceController.h.
float k3Lo |
Definition at line 290 of file SafetyTaskspaceImpedanceController.h.
float k4 |
Definition at line 228 of file SafetyTaskspaceImpedanceController.h.
float k4Hi |
Definition at line 291 of file SafetyTaskspaceImpedanceController.h.
float k4Lo |
Definition at line 290 of file SafetyTaskspaceImpedanceController.h.
Eigen::Vector6f kdForceImpedance |
Definition at line 70 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf kdImpedanceTorque |
Definition at line 93 of file SafetyTaskspaceImpedanceController.h.
float localStiffnessJointLim |
Definition at line 287 of file SafetyTaskspaceImpedanceController.h.
simox::control::Pose localTransformation |
Definition at line 121 of file SafetyTaskspaceImpedanceController.h.
double neck1JointValued |
Definition at line 318 of file SafetyTaskspaceImpedanceController.h.
float neck1JointValuef |
Definition at line 315 of file SafetyTaskspaceImpedanceController.h.
double neck2JointValued |
Definition at line 319 of file SafetyTaskspaceImpedanceController.h.
float neck2JointValuef |
Definition at line 316 of file SafetyTaskspaceImpedanceController.h.
const simox::control::robot::NodeInterface* node |
self-collision avoidance intermediate results
Definition at line 120 of file SafetyTaskspaceImpedanceController.h.
unsigned int node1Index |
Definition at line 124 of file SafetyTaskspaceImpedanceController.h.
bool node1OnArm |
Definition at line 122 of file SafetyTaskspaceImpedanceController.h.
unsigned int node2Index |
Definition at line 125 of file SafetyTaskspaceImpedanceController.h.
bool node2OnArm |
Definition at line 123 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf normalizedJacT |
Definition at line 229 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf nullspaceTorque |
Definition at line 62 of file SafetyTaskspaceImpedanceController.h.
Eigen::Matrix3f poseDiffMatImp |
intermediate impedance results
Definition at line 82 of file SafetyTaskspaceImpedanceController.h.
Eigen::Vector6f poseErrorImp |
Definition at line 83 of file SafetyTaskspaceImpedanceController.h.
double preFilterTime |
Definition at line 302 of file SafetyTaskspaceImpedanceController.h.
Eigen::Vector6f projForceImpedance |
Definition at line 88 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf projImpedanceJointTorque |
intermediate projected torques via null space matrices
Definition at line 101 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf projJointLimJointTorque |
Definition at line 103 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf projSelfCollJointTorque |
Definition at line 102 of file SafetyTaskspaceImpedanceController.h.
float projTotalForceImpedance |
Definition at line 89 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf qpos |
current status
Definition at line 73 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf qvel |
Definition at line 74 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf qvelFiltered |
Definition at line 75 of file SafetyTaskspaceImpedanceController.h.
bool rtSafe |
Definition at line 298 of file SafetyTaskspaceImpedanceController.h.
std::vector<selfCollisionData> selfCollDataVec |
Definition at line 222 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf selfCollisionJointTorque |
Definition at line 94 of file SafetyTaskspaceImpedanceController.h.
Eigen::Vector4f selfCollisionNullSpaceWeights |
self-collision avoidance initialization parameters
Definition at line 117 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXf selfCollisionTorqueFiltered |
Definition at line 97 of file SafetyTaskspaceImpedanceController.h.
Eigen::MatrixXf selfCollNullSpace |
intermediate null space matrices (self-collision and joint limit avoidance)
Definition at line 109 of file SafetyTaskspaceImpedanceController.h.
Eigen::MatrixXf selfCollNullSpaceFiltered |
Definition at line 113 of file SafetyTaskspaceImpedanceController.h.
double selfCollNullspaceTime |
Definition at line 305 of file SafetyTaskspaceImpedanceController.h.
Eigen::VectorXd setActuatedJointValues |
Definition at line 320 of file SafetyTaskspaceImpedanceController.h.
Eigen::MatrixXf tempNullSpaceMatrix |
Definition at line 230 of file SafetyTaskspaceImpedanceController.h.
double torsoJointValued |
Definition at line 317 of file SafetyTaskspaceImpedanceController.h.
float torsoJointValuef |
other actuated joint debug info
Definition at line 314 of file SafetyTaskspaceImpedanceController.h.
float totalForceImpedance |
Definition at line 87 of file SafetyTaskspaceImpedanceController.h.
float trackingError |
Definition at line 84 of file SafetyTaskspaceImpedanceController.h.