14 #include <Eigen/Dense> 16 #include "pinocchio/fwd.hpp" 17 #include "pinocchio/spatial/se3.hpp" 35 : hip_from_waist(Eigen::Vector3d::Zero()),
36 knee_from_hip(Eigen::Vector3d::Zero()),
37 ankle_from_knee(Eigen::Vector3d::Zero()),
38 ankle_from_foot(Eigen::Vector3d::Zero()) {}
41 const Eigen::Vector3d &_knee_from_hip,
42 const Eigen::Vector3d &_ankle_from_knee,
43 const Eigen::Vector3d &_ankle_from_foot)
44 : hip_from_waist(_hip_from_waist),
45 knee_from_hip(_knee_from_hip),
46 ankle_from_knee(_ankle_from_knee),
47 ankle_from_foot(_ankle_from_foot) {}
50 out <<
"LegIGSettings:\n" 52 <<
" knee_from_hip: " << obj.
knee_from_hip.transpose() <<
"\n" 77 Eigen::Vector3d hip_, ankle_, hip_from_ankle_;
79 double q2_, q3_, q4_, q5_, q6_, q7_;
80 double sign_hip_from_ankle_z;
82 Eigen::Matrix3d Rint_, Rext_, R_;
88 void reset_internals();
91 LegJoints solve(
const pinocchio::SE3 &base,
92 const pinocchio::SE3 &endEffector);
Eigen::Vector3d ankle_from_knee
Definition: leg_ig.hpp:31
friend bool operator==(const LegIGSettings &lhs, const LegIGSettings &rhs)
Definition: leg_ig.hpp:59
Eigen::Vector3d knee_from_hip
Definition: leg_ig.hpp:30
friend std::ostream & operator<<(std::ostream &out, const LegIGSettings &obj)
Definition: leg_ig.hpp:49
Eigen::Vector3d ankle_from_foot
Definition: leg_ig.hpp:32
Eigen::Vector3d hip_from_waist
Definition: leg_ig.hpp:29
Definition: leg_ig.hpp:27
LegIGSettings()
Definition: leg_ig.hpp:34
const LegIGSettings & get_settings()
Definition: leg_ig.hpp:89
Eigen::Matrix< double, 6, 1 > LegJoints
Definition: leg_ig.hpp:22
LegIGSettings(const Eigen::Vector3d &_hip_from_waist, const Eigen::Vector3d &_knee_from_hip, const Eigen::Vector3d &_ankle_from_knee, const Eigen::Vector3d &_ankle_from_foot)
Definition: leg_ig.hpp:40
Definition: arm_ig.hpp:18
Definition: leg_ig.hpp:72