Modified DH notation robot class. More...
#include <robot.h>
Public Member Functions | |
virtual ReturnMatrix | C (const ColumnVector &qp) |
Joint torque due to centrifugal and Corriolis based on Recursive Newton-Euler formulation. More... | |
virtual void | delta_torque (const ColumnVector &q, const ColumnVector &qp, const ColumnVector &qpp, const ColumnVector &dq, const ColumnVector &dqp, const ColumnVector &dqpp, ColumnVector &torque, ColumnVector &dtorque) |
Delta torque dynamics. More... | |
virtual void | dq_torque (const ColumnVector &q, const ColumnVector &qp, const ColumnVector &qpp, const ColumnVector &dq, ColumnVector &torque, ColumnVector &dtorque) |
Delta torque due to delta joint position. More... | |
virtual void | dqp_torque (const ColumnVector &q, const ColumnVector &qp, const ColumnVector &dqp, ColumnVector &torque, ColumnVector &dtorque) |
Delta torque due to delta joint velocity. More... | |
virtual void | dTdqi (Matrix &dRot, ColumnVector &dp, const int i) |
Partial derivative of the robot position (homogeneous transf.) More... | |
virtual ReturnMatrix | dTdqi (const int i) |
Partial derivative of the robot position (homogeneous transf.) More... | |
virtual ReturnMatrix | G () |
Joint torque due to gravity based on Recursive Newton-Euler formulation. More... | |
ReturnMatrix | inv_kin (const Matrix &Tobj, const int mj=0) |
Overload inv_kin function. More... | |
virtual ReturnMatrix | inv_kin (const Matrix &Tobj, const int mj, const int endlink, bool &converge) |
Inverse kinematics solutions. More... | |
virtual ReturnMatrix | inv_kin_puma (const Matrix &Tobj, bool &converge) |
Analytic Puma inverse kinematics. More... | |
virtual ReturnMatrix | inv_kin_rhino (const Matrix &Tobj, bool &converge) |
Analytic Rhino inverse kinematics. More... | |
virtual ReturnMatrix | inv_kin_schilling (const Matrix &Tobj, bool &converge) |
Analytic Schilling inverse kinematics. More... | |
virtual ReturnMatrix | jacobian (const int ref=0) const |
Jacobian of mobile links expressed at frame ref. More... | |
virtual ReturnMatrix | jacobian (const int endlink, const int ref) const |
Jacobian of mobile joints up to endlink expressed at frame ref. More... | |
virtual ReturnMatrix | jacobian_dot (const int ref=0) const |
Jacobian derivative of mobile joints expressed at frame ref. More... | |
virtual void | kine_pd (Matrix &Rot, ColumnVector &pos, ColumnVector &pos_dot, const int ref) const |
Direct kinematics with velocity. More... | |
mRobot (const int ndof=1) | |
Constructor. More... | |
mRobot (const Matrix &initrobot_motor) | |
Constructor. More... | |
mRobot (const Matrix &initrobot, const Matrix &initmotor) | |
Constructor. More... | |
mRobot (const mRobot &x) | |
Copy constructor. More... | |
mRobot (const std::string &filename, const std::string &robotName) | |
virtual void | robotType_inv_kin () |
Identify inverse kinematics familly. More... | |
virtual ReturnMatrix | torque (const ColumnVector &q, const ColumnVector &qp, const ColumnVector &qpp) |
Joint torque, without contact force, based on Recursive Newton-Euler formulation. More... | |
virtual ReturnMatrix | torque (const ColumnVector &q, const ColumnVector &qp, const ColumnVector &qpp, const ColumnVector &Fext_, const ColumnVector &Next_) |
Joint torque based on Recursive Newton-Euler formulation. More... | |
virtual ReturnMatrix | torque_novelocity (const ColumnVector &qpp) |
Joint torque. when joint velocity is 0, based on Recursive Newton-Euler formulation. More... | |
virtual | ~mRobot () |
Destructor. More... | |
Public Member Functions inherited from Robot_basic | |
ReturnMatrix | acceleration (const ColumnVector &q, const ColumnVector &qp, const ColumnVector &tau) |
Joints acceleration without contact force. More... | |
ReturnMatrix | acceleration (const ColumnVector &q, const ColumnVector &qp, const ColumnVector &tau, const ColumnVector &Fext, const ColumnVector &Next) |
Joints acceleration. More... | |
ReturnMatrix | dtau_dq (const ColumnVector &q, const ColumnVector &qp, const ColumnVector &qpp) |
Sensitivity of the dynamics with respect to . More... | |
ReturnMatrix | dtau_dqp (const ColumnVector &q, const ColumnVector &qp) |
Sensitivity of the dynamics with respect to . More... | |
void | error (const std::string &msg1) const |
Print the message msg1 on the console. More... | |
int | get_available_dof () const |
Counts number of currently non-immobile links. More... | |
int | get_available_dof (const int endlink) const |
Counts number of currently non-immobile links up to and including endlink. More... | |
ReturnMatrix | get_available_q (void) const |
Return the joint position vector of available (non-immobile) joints. More... | |
ReturnMatrix | get_available_q (const int endlink) const |
Return the joint position vector of available (non-immobile) joints up to and including endlink. More... | |
ReturnMatrix | get_available_qp (void) const |
Return the joint velocity vector of available (non-immobile) joints. More... | |
ReturnMatrix | get_available_qp (const int endlink) const |
Return the joint velocity vector of available (non-immobile) joints up to and including endlink. More... | |
ReturnMatrix | get_available_qpp (void) const |
Return the joint acceleration vector of available (non-immobile) joints. More... | |
ReturnMatrix | get_available_qpp (const int endlink) const |
Return the joint acceleration vector of available (non-immobile) joints up to and including endlink. More... | |
bool | get_DH () const |
Return true if in DH notation, false otherwise. More... | |
int | get_dof () const |
Return dof. More... | |
int | get_fix () const |
Return fix. More... | |
Real | get_q (const int i) const |
ReturnMatrix | get_q (void) const |
Return the joint position vector. More... | |
ReturnMatrix | get_qp (void) const |
Return the joint velocity vector. More... | |
ReturnMatrix | get_qpp (void) const |
Return the joint acceleration vector. More... | |
ReturnMatrix | inertia (const ColumnVector &q) |
Inertia of the manipulator. More... | |
ReturnMatrix | inv_kin (const Matrix &Tobj, const int mj, bool &converge) |
ReturnMatrix | jacobian_DLS_inv (const double eps, const double lambda_max, const int ref=0) const |
Inverse Jacobian based on damped least squares inverse. More... | |
void | kine (Matrix &Rot, ColumnVector &pos) const |
Direct kinematics at end effector. More... | |
void | kine (Matrix &Rot, ColumnVector &pos, const int j) const |
Direct kinematics at end effector. More... | |
ReturnMatrix | kine (void) const |
Return the end effector direct kinematics transform matrix. More... | |
ReturnMatrix | kine (const int j) const |
Return the frame j direct kinematics transform matrix. More... | |
ReturnMatrix | kine_pd (const int ref=0) const |
Direct kinematics with velocity. More... | |
Robot_basic & | operator= (const Robot_basic &x) |
Overload = operator. More... | |
Robot_basic (const int ndof=1, const bool dh_parameter=false, const bool min_inertial_para=false) | |
Constructor. More... | |
Robot_basic (const Matrix &initrobot_motor, const bool dh_parameter=false, const bool min_inertial_para=false) | |
Constructor. More... | |
Robot_basic (const Matrix &initrobot, const Matrix &initmotor, const bool dh_parameter=false, const bool min_inertial_para=false) | |
Constructor. More... | |
Robot_basic (const std::string &filename, const std::string &robotName, const bool dh_parameter=false, const bool min_inertial_para=false) | |
Robot_basic (const Robot_basic &x) | |
Copy constructor. More... | |
void | set_q (const ColumnVector &q) |
Set the joint position vector. More... | |
void | set_q (const Matrix &q) |
Set the joint position vector. More... | |
void | set_q (const Real q, const int i) |
void | set_qp (const ColumnVector &qp) |
Set the joint velocity vector. More... | |
void | set_qpp (const ColumnVector &qpp) |
Set the joint acceleration vector. More... | |
virtual | ~Robot_basic () |
Destructor. More... | |
Additional Inherited Members | |
Public Attributes inherited from Robot_basic | |
ColumnVector * | a |
ColumnVector * | da |
ColumnVector * | df |
ColumnVector * | dF |
ColumnVector * | dn |
ColumnVector * | dN |
ColumnVector * | dp |
ColumnVector * | dvp |
ColumnVector * | dw |
ColumnVector * | dwp |
ColumnVector * | f |
ColumnVector * | F |
ColumnVector * | f_nv |
ColumnVector | gravity |
Gravity vector. More... | |
Link * | links |
Pointer on Link cclass. More... | |
ColumnVector * | N |
ColumnVector * | n |
ColumnVector * | n_nv |
ColumnVector * | p |
ColumnVector * | pp |
Matrix * | R |
Temprary rotation matrix. More... | |
ColumnVector * | vp |
ColumnVector * | w |
ColumnVector * | wp |
ColumnVector | z0 |
Axis vector at each joint. More... | |
mRobot::mRobot | ( | const Matrix & | initrobot_motor | ) |
mRobot::mRobot | ( | const std::string & | filename, |
const std::string & | robotName | ||
) |
|
virtual |
Joint torque due to centrifugal and Corriolis based on Recursive Newton-Euler formulation.
Implements Robot_basic.
Definition at line 636 of file dynamics.cpp.
|
virtual |
Delta torque dynamics.
This function computes
Murray and Neuman Cite_: Murray86 have developed an efficient recursive linearized Newton-Euler formulation. In order to apply the RNE as presented in let us define the following variables
Forward Iterations for . Initialize: .
Backward Iterations for . Initialize: .
Implements Robot_basic.
Definition at line 291 of file delta_t.cpp.
|
virtual |
Delta torque due to delta joint position.
This function computes . See mRobot::delta_torque for equations.
Implements Robot_basic.
Definition at line 205 of file comp_dq.cpp.
|
virtual |
Delta torque due to delta joint velocity.
This function computes . See mRobot::delta_torque for equations.
Implements Robot_basic.
Definition at line 188 of file comp_dqp.cpp.
|
virtual |
Partial derivative of the robot position (homogeneous transf.)
This function computes the partial derivatives:
with
for a revolute joint and
for a prismatic joint.
and are modified on output.
Implements Robot_basic.
Definition at line 582 of file kinemat.cpp.
|
virtual |
Partial derivative of the robot position (homogeneous transf.)
See mRobot::dTdqi(Matrix & dRot, ColumnVector & dp, const int i) for equations.
Implements Robot_basic.
Definition at line 664 of file kinemat.cpp.
|
virtual |
Joint torque due to gravity based on Recursive Newton-Euler formulation.
Implements Robot_basic.
Definition at line 599 of file dynamics.cpp.
|
virtual |
Overload inv_kin function.
Reimplemented from Robot_basic.
Definition at line 617 of file invkine.cpp.
|
virtual |
Inverse kinematics solutions.
The solution is based on the analytic inverse kinematics if robot type (familly) is Rhino or Puma, otherwise used the numerical algoritm defined in Robot_basic class.
Reimplemented from Robot_basic.
Definition at line 625 of file invkine.cpp.
|
virtual |
Analytic Puma inverse kinematics.
converge will be false if the desired end effector pose is outside robot range.
Implements Robot_basic.
Definition at line 755 of file invkine.cpp.
|
virtual |
Analytic Rhino inverse kinematics.
converge will be false if the desired end effector pose is outside robot range.
Implements Robot_basic.
Definition at line 650 of file invkine.cpp.
|
virtual |
Analytic Schilling inverse kinematics.
converge will be false if the desired end effector pose is outside robot range.
Implements Robot_basic.
Definition at line 915 of file invkine.cpp.
|
inlinevirtual |
Jacobian of mobile links expressed at frame ref.
Reimplemented from Robot_basic.
|
virtual |
Jacobian of mobile joints up to endlink expressed at frame ref.
See Robot::jacobian for equations.
Implements Robot_basic.
Definition at line 682 of file kinemat.cpp.
|
virtual |
Jacobian derivative of mobile joints expressed at frame ref.
See Robot::jacobian_dot for equations.
Implements Robot_basic.
Definition at line 736 of file kinemat.cpp.
|
virtual |
Direct kinematics with velocity.
Rot | Frame j rotation matrix w.r.t to the base frame. |
pos | Frame j position vector wr.r.t to the base frame. |
pos_dot | Frame j velocity vector w.r.t to the base frame. |
j | Frame j. Print an error on the console if j is out of range. |
Implements Robot_basic.
Definition at line 552 of file kinemat.cpp.
|
virtual |
Identify inverse kinematics familly.
Identify the inverse kinematics analytic solution based on the similarity of the robot DH parameters and the DH parameters of know robots (ex: Puma, Rhino, ...). The inverse kinematics will be based on a numerical alogorithm if there is no match .
Implements Robot_basic.
|
virtual |
Joint torque, without contact force, based on Recursive Newton-Euler formulation.
Implements Robot_basic.
Definition at line 412 of file dynamics.cpp.
|
virtual |
Joint torque based on Recursive Newton-Euler formulation.
In order to apply the RNE, let us define the following variables (referenced in the coordinate frame if applicable):
is the joint type; for a revolute joint and for a prismatic joint.
is the position of the $i^{th}$ with respect to the $i-1^{th}$ frame.
Forward Iterations for . Initialize: .
Backward Iterations for . Initialize: .
Implements Robot_basic.
Definition at line 422 of file dynamics.cpp.
|
virtual |
Joint torque. when joint velocity is 0, based on Recursive Newton-Euler formulation.
Implements Robot_basic.
Definition at line 555 of file dynamics.cpp.