Ravelin
|
Defines a joint that constrains motion to a plane. More...
#include <PlanarJointd.h>
Public Member Functions | |
virtual void | update_spatial_axes () |
virtual void | determine_q (VECTORN &q) |
Abstract method to determine the value of Q (joint position) from current transforms. | |
virtual boost::shared_ptr < const POSE3 > | get_induced_pose () |
Abstract method to get the local transform for this joint. More... | |
virtual unsigned | num_dof () const |
Gets the number of degrees-of-freedom for this joint. | |
virtual void | evaluate_constraints (REAL C[]) |
Evaluates the constraint equations for this joint. More... | |
virtual void | calc_constraint_jacobian (bool inboard, MATRIXN &Cq) |
Computes the constraint Jacobian for this joint with respect to the given body. More... | |
virtual void | calc_constraint_jacobian_dot (bool inboard, MATRIXN &Cq) |
Computes the time derivative of the constraint Jacobian for this joint with respect to the given body. More... | |
virtual bool | is_singular_config () const |
Gets whether this joint is in a singular configuration. More... | |
void | set_normal (const VECTOR3 &normal) |
virtual const std::vector < SVELOCITY > & | get_spatial_axes_dot () |
Abstract method to get the spatial axes derivatives for this joint. More... | |
virtual void | update_spatial_axes () |
virtual void | determine_q (VECTORN &q) |
Abstract method to determine the value of Q (joint position) from current transforms. | |
virtual boost::shared_ptr < const POSE3 > | get_induced_pose () |
Abstract method to get the local transform for this joint. More... | |
virtual unsigned | num_dof () const |
Gets the number of degrees-of-freedom for this joint. | |
virtual void | evaluate_constraints (REAL C[]) |
Evaluates the constraint equations for this joint. More... | |
virtual void | calc_constraint_jacobian (bool inboard, MATRIXN &Cq) |
Computes the constraint Jacobian for this joint with respect to the given body. More... | |
virtual void | calc_constraint_jacobian_dot (bool inboard, MATRIXN &Cq) |
Computes the time derivative of the constraint Jacobian for this joint with respect to the given body. More... | |
virtual bool | is_singular_config () const |
Gets whether this joint is in a singular configuration. More... | |
void | set_normal (const VECTOR3 &normal) |
virtual const std::vector < SVELOCITY > & | get_spatial_axes_dot () |
Abstract method to get the spatial axes derivatives for this joint. More... | |
Public Member Functions inherited from Ravelin::JOINT | |
virtual const std::vector < SVELOCITY > & | get_spatial_axes () |
void | add_force (const VECTORN &force) |
void | reset_force () |
ConstraintType | get_constraint_type () const |
void | set_constraint_type (ConstraintType type) |
Sets whether this constraint is implicit or explicit (or unknown) | |
boost::shared_ptr < ARTICULATED_BODY > | get_articulated_body () |
Gets the articulated body corresponding to this body. More... | |
void | set_articulated_body (boost::shared_ptr< ARTICULATED_BODY > abody) |
Sets the articulated body corresponding to this body. More... | |
virtual void | set_inboard_link (boost::shared_ptr< RIGIDBODY > link, bool update_pose) |
virtual void | set_outboard_link (boost::shared_ptr< RIGIDBODY > link, bool update_pose) |
void | set_location (const VECTOR3 &p, boost::shared_ptr< RIGIDBODY > inboard, boost::shared_ptr< RIGIDBODY > outboard) |
VECTOR3 | get_location (bool use_outboard=false) const |
virtual void | set_inboard_pose (boost::shared_ptr< const POSE3 > inboard_pose, bool update_joint_pose) |
virtual void | set_outboard_pose (boost::shared_ptr< POSE3 > outboard_pose, bool update_joint_pose) |
virtual void | evaluate_constraints_dot (REAL C[]) |
virtual void | set_q_tare (const VECTORN &tare) |
virtual const VECTORN & | get_q_tare () const |
boost::shared_ptr< RIGIDBODY > | get_inboard_link () const |
Gets the inboard link for this joint. | |
boost::shared_ptr< RIGIDBODY > | get_outboard_link () const |
Gets the outboard link for this joint. | |
unsigned | get_index () const |
Gets the joint index (returns UINT_MAX if not set) | |
void | set_index (unsigned index) |
Sets the joint index. More... | |
unsigned | get_constraint_index () const |
Gets the constraint index for this joint. | |
void | set_constraint_index (unsigned idx) |
Sets the constraint index for this joint. | |
void | set_coord_index (unsigned index) |
Sets the coordinate index for this joint. More... | |
unsigned | get_coord_index () const |
Gets the starting coordinate index for this joint. | |
boost::shared_ptr< const POSE3 > | get_pose () const |
Gets the pose of this joint (relative to the inboard pose instead of the outboard pose as returned by get_pose_from_outboard()) | |
boost::shared_ptr< const POSE3 > | get_pose_from_outboard () const |
Gets the pose of this joint relative to the outboard pose (rather than the inboard pose as returned by get_pose()) | |
virtual unsigned | num_constraint_eqns () const |
Gets the number of constraint equations for this joint. | |
virtual const std::vector < SVELOCITY > & | get_spatial_axes () |
void | add_force (const VECTORN &force) |
void | reset_force () |
ConstraintType | get_constraint_type () const |
void | set_constraint_type (ConstraintType type) |
Sets whether this constraint is implicit or explicit (or unknown) | |
boost::shared_ptr < ARTICULATED_BODY > | get_articulated_body () |
Gets the articulated body corresponding to this body. More... | |
void | set_articulated_body (boost::shared_ptr< ARTICULATED_BODY > abody) |
Sets the articulated body corresponding to this body. More... | |
virtual void | set_inboard_link (boost::shared_ptr< RIGIDBODY > link, bool update_pose) |
virtual void | set_outboard_link (boost::shared_ptr< RIGIDBODY > link, bool update_pose) |
void | set_location (const VECTOR3 &p, boost::shared_ptr< RIGIDBODY > inboard, boost::shared_ptr< RIGIDBODY > outboard) |
VECTOR3 | get_location (bool use_outboard=false) const |
virtual void | set_inboard_pose (boost::shared_ptr< const POSE3 > inboard_pose, bool update_joint_pose) |
virtual void | set_outboard_pose (boost::shared_ptr< POSE3 > outboard_pose, bool update_joint_pose) |
virtual void | evaluate_constraints_dot (REAL C[]) |
virtual void | set_q_tare (const VECTORN &tare) |
virtual const VECTORN & | get_q_tare () const |
boost::shared_ptr< RIGIDBODY > | get_inboard_link () const |
Gets the inboard link for this joint. | |
boost::shared_ptr< RIGIDBODY > | get_outboard_link () const |
Gets the outboard link for this joint. | |
unsigned | get_index () const |
Gets the joint index (returns UINT_MAX if not set) | |
void | set_index (unsigned index) |
Sets the joint index. More... | |
unsigned | get_constraint_index () const |
Gets the constraint index for this joint. | |
void | set_constraint_index (unsigned idx) |
Sets the constraint index for this joint. | |
void | set_coord_index (unsigned index) |
Sets the coordinate index for this joint. More... | |
unsigned | get_coord_index () const |
Gets the starting coordinate index for this joint. | |
boost::shared_ptr< const POSE3 > | get_pose () const |
Gets the pose of this joint (relative to the inboard pose instead of the outboard pose as returned by get_pose_from_outboard()) | |
boost::shared_ptr< const POSE3 > | get_pose_from_outboard () const |
Gets the pose of this joint relative to the outboard pose (rather than the inboard pose as returned by get_pose()) | |
virtual unsigned | num_constraint_eqns () const |
Gets the number of constraint equations for this joint. | |
Public Member Functions inherited from Ravelin::virtual_enable_shared_from_this< JOINT > | |
boost::shared_ptr< JOINT > | shared_from_this () |
boost::shared_ptr< const JOINT > | shared_from_this () const |
Protected Member Functions | |
void | update_offset () |
void | update_offset () |
Protected Member Functions inherited from Ravelin::JOINT | |
void | calc_constraint_jacobian_numeric (bool inboard, MATRIXN &Cq) |
bool | transform_jacobian (MATRIXN &J, bool use_inboard, MATRIXN &output) |
void | invalidate_pose_vectors () |
boost::shared_ptr< const POSE3 > | get_inboard_pose () |
boost::shared_ptr< const POSE3 > | get_outboard_pose () |
virtual void | init_data () |
Method for initializing all variables in the joint. More... | |
void | calc_constraint_jacobian_numeric (bool inboard, MATRIXN &Cq) |
bool | transform_jacobian (MATRIXN &J, bool use_inboard, MATRIXN &output) |
void | invalidate_pose_vectors () |
boost::shared_ptr< const POSE3 > | get_inboard_pose () |
boost::shared_ptr< const POSE3 > | get_outboard_pose () |
virtual void | init_data () |
Method for initializing all variables in the joint. More... | |
Protected Attributes | |
VECTOR3 | _vi |
Vectors orthogonal to the normal vector in the outboard link frame. | |
VECTOR3 | _vj |
VECTOR3 | _normal |
The plane normal and tangents (global frame) | |
VECTOR3 | _tan1 |
VECTOR3 | _tan2 |
REAL | _offset |
The plane offset such that n'*x = offset. | |
std::vector< SVELOCITY > | _s_dot |
The derivative of the spatial axis. | |
Protected Attributes inherited from Ravelin::JOINT | |
boost::shared_ptr< POSE3 > | _Fprime |
The frame induced by the joint. | |
boost::shared_ptr< POSE3 > | _F |
The frame of this joint. | |
boost::shared_ptr< POSE3 > | _Fb |
The frame of this joint backward from the outboard link. | |
std::vector< SVELOCITY > | _s |
The spatial axes (in joint frame) for the joint. More... | |
VECTORN | _q_tare |
The stored "tare" value for the initial joint configuration. More... | |
boost::weak_ptr< RIGIDBODY > | _inboard_link |
boost::weak_ptr< RIGIDBODY > | _outboard_link |
boost::weak_ptr< ARTICULATED_BODY > | _abody |
ConstraintType | _constraint_type |
unsigned | _joint_idx |
unsigned | _coord_idx |
unsigned | _constraint_idx |
Additional Inherited Members | |
Public Types inherited from Ravelin::JOINT | |
enum | ConstraintType { eUnknown, eExplicit, eImplicit, eUnknown, eExplicit, eImplicit } |
enum | DOFs { DOF_1 =0, DOF_2 =1, DOF_3 =2, DOF_4 =3, DOF_5 =4, DOF_6 =5, DOF_1 =0, DOF_2 =1, DOF_3 =2, DOF_4 =3, DOF_5 =4, DOF_6 =5 } |
enum | ConstraintType { eUnknown, eExplicit, eImplicit, eUnknown, eExplicit, eImplicit } |
enum | DOFs { DOF_1 =0, DOF_2 =1, DOF_3 =2, DOF_4 =3, DOF_5 =4, DOF_6 =5, DOF_1 =0, DOF_2 =1, DOF_3 =2, DOF_4 =3, DOF_5 =4, DOF_6 =5 } |
Public Attributes inherited from Ravelin::JOINT | |
std::string | joint_id |
The ID of this joint. | |
VECTORN | qdd |
The acceleration of this joint. | |
VECTORN | force |
The actuator force (user/controller sets this) | |
VECTORN | lambda |
Constraint forces calculated by forward dynamics. | |
VECTORN | q |
The position of this joint. | |
VECTORN | qd |
The velocity of this joint. | |
Defines a joint that constrains motion to a plane.
|
virtual |
Computes the constraint Jacobian for this joint with respect to the given body.
inboard | 'true' if the Jacobian is to be computed w.r.t. the inboard link; 'false' for the outboard |
Cq | a 6 x ndof matrix for the given body (on return) |
Implements Ravelin::JOINT.
|
virtual |
Computes the constraint Jacobian for this joint with respect to the given body.
inboard | 'true' if the Jacobian is to be computed w.r.t. the inboard link; 'false' for the outboard |
Cq | a 6 x ndof matrix for the given body (on return) |
Implements Ravelin::JOINT.
|
virtual |
Computes the time derivative of the constraint Jacobian for this joint with respect to the given body.
inboard | 'true' if the Jacobian is to be computed w.r.t. the inboard link; 'false' for the outboard |
Cq | a 6 x ndof matrix for the given body (on return) |
Implements Ravelin::JOINT.
|
virtual |
Computes the time derivative of the constraint Jacobian for this joint with respect to the given body.
inboard | 'true' if the Jacobian is to be computed w.r.t. the inboard link; 'false' for the outboard |
Cq | a 6 x ndof matrix for the given body (on return) |
Implements Ravelin::JOINT.
|
virtual |
Evaluates the constraint equations for this joint.
When the joint constraints are exactly satisfied, the result will be the zero vector.
C | a vector of size num_constraint_eqns(); contains the evaluation (on return) |
Implements Ravelin::JOINT.
|
virtual |
Evaluates the constraint equations for this joint.
When the joint constraints are exactly satisfied, the result will be the zero vector.
C | a vector of size num_constraint_eqns(); contains the evaluation (on return) |
Implements Ravelin::JOINT.
|
virtual |
Abstract method to get the local transform for this joint.
The local transform for the joint transforms the coordinate frame attached to the joint center and aligned with the inner link frame.
Implements Ravelin::JOINT.
|
virtual |
Abstract method to get the local transform for this joint.
The local transform for the joint transforms the coordinate frame attached to the joint center and aligned with the inner link frame.
Implements Ravelin::JOINT.
|
inlinevirtual |
Abstract method to get the spatial axes derivatives for this joint.
Only applicable for reduced-coordinate articulated bodies
Implements Ravelin::JOINT.
|
inlinevirtual |
Abstract method to get the spatial axes derivatives for this joint.
Only applicable for reduced-coordinate articulated bodies
Implements Ravelin::JOINT.
|
inlinevirtual |
Gets whether this joint is in a singular configuration.
Implements Ravelin::JOINT.
|
inlinevirtual |
Gets whether this joint is in a singular configuration.
Implements Ravelin::JOINT.