List of all members | Public Member Functions | Public Attributes
CollisionAvoidanceController::RtStatusForSafetyStrategy Class Reference

internal status of the controller, containing intermediate variables, mutable targets More...

#include <armarx/control/common/control_law/CollisionAvoidance.h>

Public Member Functions

void reset (const Config &c, const unsigned int nDoF, const unsigned int maxCollisionPairs, VirtualRobot::RobotNodeSetPtr &rns)
 
void rtPreActivate ()
 

Public Attributes

int activeCollPairsNum
 
simox::control::environment::DistanceResult activeDistPair
 distance results More...
 
int collisionPairsNum
 collision pair info More...
 
double collisionPairTime
 time status More...
 
double collisionTorqueTime
 
float dampingJointLim
 
Eigen::VectorXf desiredJointTorques
 targets More...
 
float desiredNullSpace
 
Eigen::Vector3f dirErrorImp
 
std::vector< SelfCollisionData > evalData
 
int evalDataIndex
 
Eigen::VectorXf impedanceJointTorque
 intermediate torque results More...
 
float impForceRatio
 
float impTorqueRatio
 
Eigen::MatrixXf inertia
 others More...
 
Eigen::MatrixXf inertiaInverse
 
float jointInertia
 
std::vector< JointRangeBufferZoneData > jointLimitData
 joint limit avoidance initialization parameters More...
 
Eigen::VectorXf jointLimitJointTorque
 
double jointLimitNullspaceTime
 
Eigen::VectorXf jointLimitTorqueFiltered
 
double jointLimitTorqueTime
 
Eigen::MatrixXf jointLimNullSpace
 
Eigen::MatrixXf jointLimNullSpaceFiltered
 
float jointVel
 joint limit avoidance intermediate results More...
 
float k1
 self-collision avoidance null space intermediate results More...
 
float k1Hi
 
float k1Lo
 
float k2
 
float k2Hi
 
float k2Lo
 
float k3
 
float k3Hi
 
float k3Lo
 
float k4
 
float k4Hi
 
float k4Lo
 
Eigen::VectorXf kdImpedanceTorque
 
float localStiffnessJointLim
 
simox::control::Pose localTransformation
 
const simox::control::robot::NodeInterface * node
 self-collision avoidance intermediate results More...
 
unsigned int node1Index
 
bool node1OnArm
 
unsigned int node2Index
 
bool node2OnArm
 
Eigen::VectorXf normalizedJacT
 
double preFilterTime
 
Eigen::Vector6f projForceImpedance
 
Eigen::VectorXf projImpedanceJointTorque
 intermediate projected torques via null space matrices More...
 
Eigen::VectorXf projJointLimJointTorque
 
Eigen::VectorXf projSelfCollJointTorque
 
float projTotalForceImpedance
 
std::vector< SelfCollisionData > selfCollDataVec
 
Eigen::VectorXf selfCollisionJointTorque
 
Eigen::Vector4f selfCollisionNullSpaceWeights
 self-collision avoidance initialization parameters More...
 
Eigen::VectorXf selfCollisionTorqueFiltered
 
Eigen::MatrixXf selfCollNullSpace
 intermediate null space matrices (self-collision and joint limit avoidance) More...
 
Eigen::MatrixXf selfCollNullSpaceFiltered
 
double selfCollNullspaceTime
 
Eigen::MatrixXf tempNullSpaceMatrix
 
float totalForceImpedance
 
float trackingError
 

Detailed Description

internal status of the controller, containing intermediate variables, mutable targets

Definition at line 178 of file CollisionAvoidance.h.

Member Function Documentation

◆ reset()

void reset ( const Config &  c,
const unsigned int  nDoF,
const unsigned int  maxCollisionPairs,
VirtualRobot::RobotNodeSetPtr &  rns 
)

intermediate torque results

intermediate projected torques via null space matrices

intermediate null space matrices (self-collision and joint limit avoidance)

self-collision avoidance initialization parameters calculate weights for self-collision nullspace transition function range between z1 and z2 z1: below this distance [m] the collision direction is fully locked z2: above this distance collision direction is unrestricted

self-collision avoidance intermediate results

distance results

self-collision avoidance null space intermediate results

joint limit avoidance initialization parameters

others

time status

collision pair info

Definition at line 1391 of file CollisionAvoidance.cpp.

+ Here is the call graph for this function:

◆ rtPreActivate()

void rtPreActivate ( )
inline

Definition at line 284 of file CollisionAvoidance.h.

Member Data Documentation

◆ activeCollPairsNum

int activeCollPairsNum

Definition at line 267 of file CollisionAvoidance.h.

◆ activeDistPair

simox::control::environment::DistanceResult activeDistPair

distance results

Definition at line 228 of file CollisionAvoidance.h.

◆ collisionPairsNum

int collisionPairsNum

collision pair info

Definition at line 266 of file CollisionAvoidance.h.

◆ collisionPairTime

double collisionPairTime

time status

Definition at line 258 of file CollisionAvoidance.h.

◆ collisionTorqueTime

double collisionTorqueTime

Definition at line 260 of file CollisionAvoidance.h.

◆ dampingJointLim

float dampingJointLim

Definition at line 248 of file CollisionAvoidance.h.

◆ desiredJointTorques

Eigen::VectorXf desiredJointTorques

targets

Definition at line 182 of file CollisionAvoidance.h.

◆ desiredNullSpace

float desiredNullSpace

Definition at line 211 of file CollisionAvoidance.h.

◆ dirErrorImp

Eigen::Vector3f dirErrorImp

Definition at line 186 of file CollisionAvoidance.h.

◆ evalData

std::vector<SelfCollisionData> evalData

Definition at line 230 of file CollisionAvoidance.h.

◆ evalDataIndex

int evalDataIndex

Definition at line 231 of file CollisionAvoidance.h.

◆ impedanceJointTorque

Eigen::VectorXf impedanceJointTorque

intermediate torque results

Definition at line 192 of file CollisionAvoidance.h.

◆ impForceRatio

float impForceRatio

Definition at line 206 of file CollisionAvoidance.h.

◆ impTorqueRatio

float impTorqueRatio

Definition at line 205 of file CollisionAvoidance.h.

◆ inertia

Eigen::MatrixXf inertia

others

Definition at line 254 of file CollisionAvoidance.h.

◆ inertiaInverse

Eigen::MatrixXf inertiaInverse

Definition at line 255 of file CollisionAvoidance.h.

◆ jointInertia

float jointInertia

Definition at line 245 of file CollisionAvoidance.h.

◆ jointLimitData

std::vector<JointRangeBufferZoneData> jointLimitData

joint limit avoidance initialization parameters

Definition at line 241 of file CollisionAvoidance.h.

◆ jointLimitJointTorque

Eigen::VectorXf jointLimitJointTorque

Definition at line 195 of file CollisionAvoidance.h.

◆ jointLimitNullspaceTime

double jointLimitNullspaceTime

Definition at line 263 of file CollisionAvoidance.h.

◆ jointLimitTorqueFiltered

Eigen::VectorXf jointLimitTorqueFiltered

Definition at line 198 of file CollisionAvoidance.h.

◆ jointLimitTorqueTime

double jointLimitTorqueTime

Definition at line 261 of file CollisionAvoidance.h.

◆ jointLimNullSpace

Eigen::MatrixXf jointLimNullSpace

Definition at line 210 of file CollisionAvoidance.h.

◆ jointLimNullSpaceFiltered

Eigen::MatrixXf jointLimNullSpaceFiltered

Definition at line 214 of file CollisionAvoidance.h.

◆ jointVel

float jointVel

joint limit avoidance intermediate results

Definition at line 244 of file CollisionAvoidance.h.

◆ k1

float k1

self-collision avoidance null space intermediate results

Definition at line 234 of file CollisionAvoidance.h.

◆ k1Hi

float k1Hi

Definition at line 251 of file CollisionAvoidance.h.

◆ k1Lo

float k1Lo

Definition at line 250 of file CollisionAvoidance.h.

◆ k2

float k2

Definition at line 234 of file CollisionAvoidance.h.

◆ k2Hi

float k2Hi

Definition at line 251 of file CollisionAvoidance.h.

◆ k2Lo

float k2Lo

Definition at line 250 of file CollisionAvoidance.h.

◆ k3

float k3

Definition at line 234 of file CollisionAvoidance.h.

◆ k3Hi

float k3Hi

Definition at line 251 of file CollisionAvoidance.h.

◆ k3Lo

float k3Lo

Definition at line 250 of file CollisionAvoidance.h.

◆ k4

float k4

Definition at line 234 of file CollisionAvoidance.h.

◆ k4Hi

float k4Hi

Definition at line 251 of file CollisionAvoidance.h.

◆ k4Lo

float k4Lo

Definition at line 250 of file CollisionAvoidance.h.

◆ kdImpedanceTorque

Eigen::VectorXf kdImpedanceTorque

Definition at line 193 of file CollisionAvoidance.h.

◆ localStiffnessJointLim

float localStiffnessJointLim

Definition at line 247 of file CollisionAvoidance.h.

◆ localTransformation

simox::control::Pose localTransformation

Definition at line 221 of file CollisionAvoidance.h.

◆ node

const simox::control::robot::NodeInterface* node

self-collision avoidance intermediate results

Definition at line 220 of file CollisionAvoidance.h.

◆ node1Index

unsigned int node1Index

Definition at line 224 of file CollisionAvoidance.h.

◆ node1OnArm

bool node1OnArm

Definition at line 222 of file CollisionAvoidance.h.

◆ node2Index

unsigned int node2Index

Definition at line 225 of file CollisionAvoidance.h.

◆ node2OnArm

bool node2OnArm

Definition at line 223 of file CollisionAvoidance.h.

◆ normalizedJacT

Eigen::VectorXf normalizedJacT

Definition at line 235 of file CollisionAvoidance.h.

◆ preFilterTime

double preFilterTime

Definition at line 259 of file CollisionAvoidance.h.

◆ projForceImpedance

Eigen::Vector6f projForceImpedance

Definition at line 188 of file CollisionAvoidance.h.

◆ projImpedanceJointTorque

Eigen::VectorXf projImpedanceJointTorque

intermediate projected torques via null space matrices

Definition at line 201 of file CollisionAvoidance.h.

◆ projJointLimJointTorque

Eigen::VectorXf projJointLimJointTorque

Definition at line 203 of file CollisionAvoidance.h.

◆ projSelfCollJointTorque

Eigen::VectorXf projSelfCollJointTorque

Definition at line 202 of file CollisionAvoidance.h.

◆ projTotalForceImpedance

float projTotalForceImpedance

Definition at line 189 of file CollisionAvoidance.h.

◆ selfCollDataVec

std::vector<SelfCollisionData> selfCollDataVec

Definition at line 229 of file CollisionAvoidance.h.

◆ selfCollisionJointTorque

Eigen::VectorXf selfCollisionJointTorque

Definition at line 194 of file CollisionAvoidance.h.

◆ selfCollisionNullSpaceWeights

Eigen::Vector4f selfCollisionNullSpaceWeights

self-collision avoidance initialization parameters

Definition at line 217 of file CollisionAvoidance.h.

◆ selfCollisionTorqueFiltered

Eigen::VectorXf selfCollisionTorqueFiltered

Definition at line 197 of file CollisionAvoidance.h.

◆ selfCollNullSpace

Eigen::MatrixXf selfCollNullSpace

intermediate null space matrices (self-collision and joint limit avoidance)

Definition at line 209 of file CollisionAvoidance.h.

◆ selfCollNullSpaceFiltered

Eigen::MatrixXf selfCollNullSpaceFiltered

Definition at line 213 of file CollisionAvoidance.h.

◆ selfCollNullspaceTime

double selfCollNullspaceTime

Definition at line 262 of file CollisionAvoidance.h.

◆ tempNullSpaceMatrix

Eigen::MatrixXf tempNullSpaceMatrix

Definition at line 236 of file CollisionAvoidance.h.

◆ totalForceImpedance

float totalForceImpedance

Definition at line 187 of file CollisionAvoidance.h.

◆ trackingError

float trackingError

Definition at line 184 of file CollisionAvoidance.h.

The documentation for this class was generated from the following files: