53 for (std::size_t i = 0; i <
joint_map_.size(); ++i)
63 for (std::size_t i = 0; i <
joint_map_.size(); ++i)
72 Eigen::VectorXd x_none(1);
73 Eigen::MatrixXd dphi_dx_none(1, 1);
74 Update(x_none, u, phi, dphi_dx_none, dphi_du);
92 for (
int i = 0; i <
parameters_.JointMap.rows(); ++i)
const Eigen::VectorXd & get_joint_ref() const
int TaskSpaceDim() override
Eigen::VectorXd joint_ref_
! Subset selection matrix
std::vector< int > joint_map_
! Number of controlled joints
Eigen::Ref< Eigen::VectorXd > VectorXdRef
std::shared_ptr< Scene > ScenePtr
int num_controlled_joints_
void AssignScene(ScenePtr scene) override
ControlRegularizationInitializer parameters_
const Eigen::Ref< const Eigen::VectorXd > & VectorXdRefConst
Eigen::Ref< Hessian > HessianRef
const std::vector< int > & get_joint_map() const
Eigen::Ref< Eigen::MatrixXd > MatrixXdRef
REGISTER_TASKMAP_TYPE("ControlRegularization", exotica::ControlRegularization)
void Update(Eigen::VectorXdRefConst q, Eigen::VectorXdRef phi) override