1#ifndef ROBOTOC_COST_FUNCTION_DATA_HPP_
2#define ROBOTOC_COST_FUNCTION_DATA_HPP_
147 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
Dynamics and kinematics model of robots. Wraps pinocchio::Model and pinocchio::Data....
Definition: robot.hpp:32
Definition: constraint_component_base.hpp:17
pinocchio::SE3 SE3
Using pinocchio::SE3 without its namespace.
Definition: se3.hpp:15
Composed of data used to compute the cost function and its derivatives.
Definition: cost_function_data.hpp:17
Eigen::MatrixXd J_66
Jacobian used in TaskSpace6DCost. Be allocated only when CostFunction has TaskSpace6DCost....
Definition: cost_function_data.hpp:139
Eigen::VectorXd x3d_ref
Vector used for set the reference position of the end-effector in TaskSpace3DCost....
Definition: cost_function_data.hpp:76
Eigen::MatrixXd J_3d
Jacobian used in TaskSpace3DCost and TaskSpace6DCost. Be allocated only when CostFunction has TaskSpa...
Definition: cost_function_data.hpp:133
CostFunctionData(const Robot &robot)
Constructor.
Eigen::VectorXd diff_6d
Vector used for computing the difference of the position and rotation of the end-effector in TaskSpac...
Definition: cost_function_data.hpp:92
CostFunctionData & operator=(const CostFunctionData &)=default
Default copy operator.
SE3 x6d_ref_inv
Vector used for computing the inverse of the reference SE3 of the end-effector in TaskSpace6DCost.
Definition: cost_function_data.hpp:104
CostFunctionData(const CostFunctionData &)=default
Default copy constructor.
CostFunctionData()
Default constructor.
~CostFunctionData()=default
Default destructor.
SE3 diff_x6d
Vector used for computing the difference of the SE3 of the end-effector in TaskSpace6DCost....
Definition: cost_function_data.hpp:111
Eigen::MatrixXd J_qdiff
Jacobian of the difference of the configurations used in JointSpaceCost. Be allocated only when Robot...
Definition: cost_function_data.hpp:119
Eigen::VectorXd q_ref
Vector used for computing the time-varying reference configuration in ConfigurationCost....
Definition: cost_function_data.hpp:68
CostFunctionData(CostFunctionData &&) noexcept=default
Default move constructor.
Eigen::MatrixXd JJ_6d
Jacobian used in TaskSpace6DCost. Be allocated only when CostFunction has TaskSpace6DCost....
Definition: cost_function_data.hpp:145
Eigen::VectorXd qdiff
Vector used for computing the difference of the configurations in JointSpaceCost. Be allocated only w...
Definition: cost_function_data.hpp:61
SE3 x6d_ref
Vector used for computing the reference SE3 of the end-effector in TaskSpace6DCost.
Definition: cost_function_data.hpp:98
Eigen::MatrixXd J_6d
Jacobian used in TaskSpace3DCost and TaskSpace6DCost. Be allocated only when CostFunction has TaskSpa...
Definition: cost_function_data.hpp:126
Eigen::VectorXd diff_3d
Vector used for computing the difference of the position of the end-effector in TaskSpace3DCost....
Definition: cost_function_data.hpp:84