Blender  V2.59
Classes | Typedefs | Functions | Variables
KDL Namespace Reference

Classes

class  Chain
 This class encapsulates a serial kinematic interconnection structure. It is build out of segments. More...
class  ChainFkSolverPos
 This abstract class encapsulates a solver for the forward position kinematics for a KDL::Chain. More...
class  ChainFkSolverVel
 This abstract class encapsulates a solver for the forward velocity kinematics for a KDL::Chain. More...
class  ChainFkSolverAcc
 This abstract class encapsulates a solver for the forward acceleration kinematics for a KDL::Chain. More...
class  ChainFkSolverPos_recursive
class  ChainJntToJacSolver
 Class to calculate the jacobian of a general KDL::Chain, it is used by other solvers. It should not be used outside of KDL. More...
class  VectorAcc
class  RotationAcc
class  FrameAcc
class  TwistAcc
class  Vector
 A concrete implementation of a 3 dimensional vector class. More...
class  Rotation
 represents rotations in 3 dimensional space. More...
class  Frame
 represents a frame transformation in 3D space (rotation + translation) More...
class  Twist
 represents both translational and rotational velocities. More...
class  Wrench
 represents both translational and rotational acceleration. More...
class  Vector2
 2D version of Vector More...
class  Rotation2
class  Frame2
class  VectorVel
class  RotationVel
class  FrameVel
class  TwistVel
class  Inertia
class  Jacobian
class  JntArray
 This class represents an fixed size array containing joint values of a KDL::Chain. More...
class  JntArrayAcc
class  JntArrayVel
class  Joint
 This class encapsulates a simple joint, that is with one parameterized degree of freedom and with scalar dynamic properties. More...
class  Segment
 This class encapsulates a simple segment, that is a "rigid body" (i.e., a frame and an inertia) with a joint and with "handles", root and tip to connect to other segments. More...
class  TreeElement
class  Tree
 This class encapsulates a tree kinematic interconnection structure. It is build out of segments. More...
class  TreeFkSolverPos
 This abstract class encapsulates a solver for the forward position kinematics for a KDL::Tree. More...
class  TreeFkSolverPos_recursive
class  TreeJntToJacSolver
class  Error
class  Error_IO
class  Error_BasicIO
class  Error_BasicIO_File
class  Error_BasicIO_Exp_Delim
class  Error_BasicIO_Not_A_Space
class  Error_BasicIO_Unexpected
class  Error_BasicIO_ToBig
class  Error_BasicIO_Not_Opened
class  Error_FrameIO
class  Error_Frame_Vector_Unexpected_id
class  Error_Frame_Frame_Unexpected_id
class  Error_Frame_Rotation_Unexpected_id
class  Error_ChainIO
class  Error_Chain_Unexpected_id
class  Error_RedundancyIO
 Error_Redundancy indicates an error that occured during solving for redundancy. More...
class  Error_Redundancy_Illegal_Resolutiontype
class  Error_Redundancy
class  Error_Redundancy_Unavoidable
class  Error_Redundancy_Low_Manip
class  Error_MotionIO
class  Error_MotionIO_Unexpected_MotProf
class  Error_MotionIO_Unexpected_Traj
class  Error_MotionPlanning
class  Error_MotionPlanning_Circle_ToSmall
class  Error_MotionPlanning_Circle_No_Plane
class  Error_MotionPlanning_Incompatible
class  Error_MotionPlanning_Not_Feasible
class  Error_MotionPlanning_Not_Applicable
class  Error_Integrator
 Abstract subclass of all errors that can be thrown by Adaptive_Integrator. More...
class  Error_Stepsize_Underflow
 Error_Stepsize_Underflow is thrown if the stepsize becomes to small. More...
class  Error_To_Many_Steps
class  Error_Stepsize_To_Small
 Error_Stepsize_To_Small is thrown if the stepsize becomes to small. More...
class  Error_Criterium
class  Error_Criterium_Unexpected_id
class  Error_Limits
class  Error_Limits_Unexpected_id
class  Error_Not_Implemented
class  Rall1d
class  Rall2d
class  TI
class  TI< double >
class  TI< int >

Typedefs

typedef Rall2d< double, double,
double > 
doubleAcc
typedef Rall1d< double > doubleVel
typedef std::map< std::string,
TreeElement
SegmentMap
typedef std::stack< std::string > ErrorStack

Functions

VectorAcc operator+ (const VectorAcc &r1, const VectorAcc &r2)
VectorAcc operator- (const VectorAcc &r1, const VectorAcc &r2)
VectorAcc operator+ (const Vector &r1, const VectorAcc &r2)
VectorAcc operator- (const Vector &r1, const VectorAcc &r2)
VectorAcc operator+ (const VectorAcc &r1, const Vector &r2)
VectorAcc operator- (const VectorAcc &r1, const Vector &r2)
VectorAcc operator- (const VectorAcc &r)
VectorAcc operator* (const VectorAcc &r1, const VectorAcc &r2)
VectorAcc operator* (const VectorAcc &r1, const Vector &r2)
VectorAcc operator* (const Vector &r1, const VectorAcc &r2)
VectorAcc operator* (double r1, const VectorAcc &r2)
VectorAcc operator* (const VectorAcc &r1, double r2)
VectorAcc operator* (const doubleAcc &r1, const VectorAcc &r2)
VectorAcc operator* (const VectorAcc &r2, const doubleAcc &r1)
doubleAcc dot (const VectorAcc &lhs, const VectorAcc &rhs)
doubleAcc dot (const VectorAcc &lhs, const Vector &rhs)
doubleAcc dot (const Vector &lhs, const VectorAcc &rhs)
bool Equal (const VectorAcc &r1, const VectorAcc &r2, double eps)
bool Equal (const Vector &r1, const VectorAcc &r2, double eps)
bool Equal (const VectorAcc &r1, const Vector &r2, double eps)
VectorAcc operator/ (const VectorAcc &r1, double r2)
VectorAcc operator/ (const VectorAcc &r2, const doubleAcc &r1)
RotationAcc operator* (const RotationAcc &r1, const RotationAcc &r2)
RotationAcc operator* (const Rotation &r1, const RotationAcc &r2)
RotationAcc operator* (const RotationAcc &r1, const Rotation &r2)
VectorAcc operator* (const Rotation &R, const VectorAcc &x)
bool Equal (const RotationAcc &r1, const RotationAcc &r2, double eps)
bool Equal (const Rotation &r1, const RotationAcc &r2, double eps)
bool Equal (const RotationAcc &r1, const Rotation &r2, double eps)
FrameAcc operator* (const FrameAcc &lhs, const FrameAcc &rhs)
FrameAcc operator* (const FrameAcc &lhs, const Frame &rhs)
FrameAcc operator* (const Frame &lhs, const FrameAcc &rhs)
bool Equal (const FrameAcc &r1, const FrameAcc &r2, double eps)
bool Equal (const Frame &r1, const FrameAcc &r2, double eps)
bool Equal (const FrameAcc &r1, const Frame &r2, double eps)
TwistAcc operator* (const TwistAcc &lhs, double rhs)
TwistAcc operator* (double lhs, const TwistAcc &rhs)
TwistAcc operator/ (const TwistAcc &lhs, double rhs)
TwistAcc operator* (const TwistAcc &lhs, const doubleAcc &rhs)
TwistAcc operator* (const doubleAcc &lhs, const TwistAcc &rhs)
TwistAcc operator/ (const TwistAcc &lhs, const doubleAcc &rhs)
TwistAcc operator+ (const TwistAcc &lhs, const TwistAcc &rhs)
TwistAcc operator- (const TwistAcc &lhs, const TwistAcc &rhs)
TwistAcc operator- (const TwistAcc &arg)
bool Equal (const TwistAcc &a, const TwistAcc &b, double eps)
bool Equal (const Twist &a, const TwistAcc &b, double eps)
bool Equal (const TwistAcc &a, const Twist &b, double eps)
bool Equal (const Rotation &a, const Rotation &b, double eps)
Rotation operator* (const Rotation &lhs, const Rotation &rhs)
bool operator== (const Rotation &a, const Rotation &b)
IMETHOD Vector diff (const Vector &a, const Vector &b, double dt=1)
IMETHOD Vector diff (const Rotation &R_a_b1, const Rotation &R_a_b2, double dt=1)
IMETHOD Twist diff (const Frame &F_a_b1, const Frame &F_a_b2, double dt=1)
IMETHOD Twist diff (const Twist &a, const Twist &b, double dt=1)
IMETHOD Wrench diff (const Wrench &W_a_p1, const Wrench &W_a_p2, double dt=1)
IMETHOD Vector addDelta (const Vector &a, const Vector &da, double dt=1)
IMETHOD Rotation addDelta (const Rotation &a, const Vector &da, double dt=1)
IMETHOD Frame addDelta (const Frame &a, const Twist &da, double dt=1)
IMETHOD Twist addDelta (const Twist &a, const Twist &da, double dt=1)
IMETHOD Wrench addDelta (const Wrench &a, const Wrench &da, double dt=1)
std::ostream & operator<< (std::ostream &os, const Vector &v)
std::ostream & operator<< (std::ostream &os, const Twist &v)
std::ostream & operator<< (std::ostream &os, const Wrench &v)
std::ostream & operator<< (std::ostream &os, const Rotation &R)
std::ostream & operator<< (std::ostream &os, const Frame &T)
std::ostream & operator<< (std::ostream &os, const Vector2 &v)
std::ostream & operator<< (std::ostream &os, const Rotation2 &R)
std::ostream & operator<< (std::ostream &os, const Frame2 &T)
std::istream & operator>> (std::istream &is, Vector &v)
std::istream & operator>> (std::istream &is, Twist &v)
std::istream & operator>> (std::istream &is, Wrench &v)
std::istream & operator>> (std::istream &is, Rotation &r)
std::istream & operator>> (std::istream &is, Frame &T)
std::istream & operator>> (std::istream &is, Vector2 &v)
std::istream & operator>> (std::istream &is, Rotation2 &r)
std::istream & operator>> (std::istream &is, Frame2 &T)
IMETHOD doubleVel diff (const doubleVel &a, const doubleVel &b, double dt=1.0)
IMETHOD doubleVel addDelta (const doubleVel &a, const doubleVel &da, double dt=1.0)
IMETHOD void random (doubleVel &F)
IMETHOD void posrandom (doubleVel &F)
IMETHOD VectorVel diff (const VectorVel &a, const VectorVel &b, double dt=1.0)
IMETHOD VectorVel addDelta (const VectorVel &a, const VectorVel &da, double dt=1.0)
IMETHOD VectorVel diff (const RotationVel &a, const RotationVel &b, double dt=1.0)
IMETHOD RotationVel addDelta (const RotationVel &a, const VectorVel &da, double dt=1.0)
IMETHOD TwistVel diff (const FrameVel &a, const FrameVel &b, double dt=1.0)
IMETHOD FrameVel addDelta (const FrameVel &a, const TwistVel &da, double dt=1.0)
IMETHOD void random (VectorVel &a)
IMETHOD void random (TwistVel &a)
IMETHOD void random (RotationVel &R)
IMETHOD void random (FrameVel &F)
IMETHOD void posrandom (VectorVel &a)
IMETHOD void posrandom (TwistVel &a)
IMETHOD void posrandom (RotationVel &R)
IMETHOD void posrandom (FrameVel &F)
FrameVel operator* (const FrameVel &lhs, const FrameVel &rhs)
FrameVel operator* (const FrameVel &lhs, const Frame &rhs)
FrameVel operator* (const Frame &lhs, const FrameVel &rhs)
bool Equal (const FrameVel &r1, const FrameVel &r2, double eps)
bool Equal (const Frame &r1, const FrameVel &r2, double eps)
bool Equal (const FrameVel &r1, const Frame &r2, double eps)
RotationVel operator* (const RotationVel &r1, const RotationVel &r2)
RotationVel operator* (const Rotation &r1, const RotationVel &r2)
RotationVel operator* (const RotationVel &r1, const Rotation &r2)
VectorVel operator+ (const VectorVel &r1, const VectorVel &r2)
VectorVel operator- (const VectorVel &r1, const VectorVel &r2)
VectorVel operator+ (const VectorVel &r1, const Vector &r2)
VectorVel operator- (const VectorVel &r1, const Vector &r2)
VectorVel operator+ (const Vector &r1, const VectorVel &r2)
VectorVel operator- (const Vector &r1, const VectorVel &r2)
VectorVel operator- (const VectorVel &r)
void SetToZero (VectorVel &v)
VectorVel operator* (const VectorVel &r1, const VectorVel &r2)
VectorVel operator* (const VectorVel &r1, const Vector &r2)
VectorVel operator* (const Vector &r1, const VectorVel &r2)
VectorVel operator* (double r1, const VectorVel &r2)
VectorVel operator* (const VectorVel &r1, double r2)
VectorVel operator* (const doubleVel &r1, const VectorVel &r2)
VectorVel operator* (const VectorVel &r2, const doubleVel &r1)
VectorVel operator/ (const VectorVel &r1, double r2)
VectorVel operator/ (const VectorVel &r2, const doubleVel &r1)
VectorVel operator* (const Rotation &R, const VectorVel &x)
bool Equal (const VectorVel &r1, const VectorVel &r2, double eps)
bool Equal (const Vector &r1, const VectorVel &r2, double eps)
bool Equal (const VectorVel &r1, const Vector &r2, double eps)
bool Equal (const RotationVel &r1, const RotationVel &r2, double eps)
bool Equal (const Rotation &r1, const RotationVel &r2, double eps)
bool Equal (const RotationVel &r1, const Rotation &r2, double eps)
bool Equal (const TwistVel &a, const TwistVel &b, double eps)
bool Equal (const Twist &a, const TwistVel &b, double eps)
bool Equal (const TwistVel &a, const Twist &b, double eps)
IMETHOD doubleVel dot (const VectorVel &lhs, const VectorVel &rhs)
IMETHOD doubleVel dot (const VectorVel &lhs, const Vector &rhs)
IMETHOD doubleVel dot (const Vector &lhs, const VectorVel &rhs)
TwistVel operator* (const TwistVel &lhs, double rhs)
TwistVel operator* (double lhs, const TwistVel &rhs)
TwistVel operator/ (const TwistVel &lhs, double rhs)
TwistVel operator* (const TwistVel &lhs, const doubleVel &rhs)
TwistVel operator* (const doubleVel &lhs, const TwistVel &rhs)
TwistVel operator/ (const TwistVel &lhs, const doubleVel &rhs)
TwistVel operator+ (const TwistVel &lhs, const TwistVel &rhs)
TwistVel operator- (const TwistVel &lhs, const TwistVel &rhs)
TwistVel operator- (const TwistVel &arg)
void SetToZero (TwistVel &v)
void SetToZero (Jacobian &jac)
void changeRefPoint (const Jacobian &src1, const Vector &base_AB, Jacobian &dest)
void changeBase (const Jacobian &src1, const Rotation &rot, Jacobian &dest)
void changeRefFrame (const Jacobian &src1, const Frame &frame, Jacobian &dest)
bool Equal (const Jacobian &a, const Jacobian &b, double eps)
void Add (const JntArray &src1, const JntArray &src2, JntArray &dest)
void Subtract (const JntArray &src1, const JntArray &src2, JntArray &dest)
void Multiply (const JntArray &src, const double &factor, JntArray &dest)
void Divide (const JntArray &src, const double &factor, JntArray &dest)
void MultiplyJacobian (const Jacobian &jac, const JntArray &src, Twist &dest)
void SetToZero (JntArray &array)
bool Equal (const JntArray &src1, const JntArray &src2, double eps)
bool operator== (const JntArray &src1, const JntArray &src2)
void Add (const JntArrayAcc &src1, const JntArrayAcc &src2, JntArrayAcc &dest)
void Add (const JntArrayAcc &src1, const JntArrayVel &src2, JntArrayAcc &dest)
void Add (const JntArrayAcc &src1, const JntArray &src2, JntArrayAcc &dest)
void Subtract (const JntArrayAcc &src1, const JntArrayAcc &src2, JntArrayAcc &dest)
void Subtract (const JntArrayAcc &src1, const JntArrayVel &src2, JntArrayAcc &dest)
void Subtract (const JntArrayAcc &src1, const JntArray &src2, JntArrayAcc &dest)
void Multiply (const JntArrayAcc &src, const double &factor, JntArrayAcc &dest)
void Multiply (const JntArrayAcc &src, const doubleVel &factor, JntArrayAcc &dest)
void Multiply (const JntArrayAcc &src, const doubleAcc &factor, JntArrayAcc &dest)
void Divide (const JntArrayAcc &src, const double &factor, JntArrayAcc &dest)
void Divide (const JntArrayAcc &src, const doubleVel &factor, JntArrayAcc &dest)
void Divide (const JntArrayAcc &src, const doubleAcc &factor, JntArrayAcc &dest)
void SetToZero (JntArrayAcc &array)
bool Equal (const JntArrayAcc &src1, const JntArrayAcc &src2, double eps)
void Add (const JntArrayVel &src1, const JntArrayVel &src2, JntArrayVel &dest)
void Add (const JntArrayVel &src1, const JntArray &src2, JntArrayVel &dest)
void Subtract (const JntArrayVel &src1, const JntArrayVel &src2, JntArrayVel &dest)
void Subtract (const JntArrayVel &src1, const JntArray &src2, JntArrayVel &dest)
void Multiply (const JntArrayVel &src, const double &factor, JntArrayVel &dest)
void Multiply (const JntArrayVel &src, const doubleVel &factor, JntArrayVel &dest)
void Divide (const JntArrayVel &src, const double &factor, JntArrayVel &dest)
void Divide (const JntArrayVel &src, const doubleVel &factor, JntArrayVel &dest)
void SetToZero (JntArrayVel &array)
bool Equal (const JntArrayVel &src1, const JntArrayVel &src2, double eps)
std::ostream & operator<< (std::ostream &os, const Joint &joint)
std::istream & operator>> (std::istream &is, Joint &joint)
std::ostream & operator<< (std::ostream &os, const Segment &segment)
std::istream & operator>> (std::istream &is, Segment &segment)
std::ostream & operator<< (std::ostream &os, const Chain &chain)
std::istream & operator>> (std::istream &is, Chain &chain)
std::ostream & operator<< (std::ostream &os, const Tree &tree)
std::ostream & operator<< (std::ostream &os, SegmentMap::const_iterator root)
std::istream & operator>> (std::istream &is, Tree &tree)
std::ostream & operator<< (std::ostream &os, const JntArray &array)
std::istream & operator>> (std::istream &is, JntArray &array)
std::ostream & operator<< (std::ostream &os, const Jacobian &jac)
std::istream & operator>> (std::istream &is, Jacobian &jac)
template<typename T >
std::ostream & operator<< (std::ostream &os, const std::vector< T > &vec)
template<typename T >
std::istream & operator>> (std::istream &is, std::vector< T > &vec)
void IOTrace (const std::string &description)
void IOTracePop ()
 pops a description of the IO-stack
void IOTraceOutput (std::ostream &os)
 outputs the IO-stack to a stream to provide a better errormessage.
void IOTracePopStr (char *buffer, int size)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator/ (const Rall1d< T, V, S > &lhs, const Rall1d< T, V, S > &rhs)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator* (const Rall1d< T, V, S > &lhs, const Rall1d< T, V, S > &rhs)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator+ (const Rall1d< T, V, S > &lhs, const Rall1d< T, V, S > &rhs)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator- (const Rall1d< T, V, S > &lhs, const Rall1d< T, V, S > &rhs)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator- (const Rall1d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator* (S s, const Rall1d< T, V, S > &v)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator* (const Rall1d< T, V, S > &v, S s)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator+ (S s, const Rall1d< T, V, S > &v)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator+ (const Rall1d< T, V, S > &v, S s)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator- (S s, const Rall1d< T, V, S > &v)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator- (const Rall1d< T, V, S > &v, S s)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator/ (S s, const Rall1d< T, V, S > &v)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > operator/ (const Rall1d< T, V, S > &v, S s)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > exp (const Rall1d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > log (const Rall1d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > sin (const Rall1d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > cos (const Rall1d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > tan (const Rall1d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > sinh (const Rall1d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > cosh (const Rall1d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > sqr (const Rall1d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > pow (const Rall1d< T, V, S > &arg, double m)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > sqrt (const Rall1d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > atan (const Rall1d< T, V, S > &x)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > hypot (const Rall1d< T, V, S > &y, const Rall1d< T, V, S > &x)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > asin (const Rall1d< T, V, S > &x)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > acos (const Rall1d< T, V, S > &x)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > abs (const Rall1d< T, V, S > &x)
template<class T , class V , class S >
INLINE S Norm (const Rall1d< T, V, S > &value)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > tanh (const Rall1d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > atan2 (const Rall1d< T, V, S > &y, const Rall1d< T, V, S > &x)
template<class T , class V , class S >
INLINE Rall1d< T, V, S > LinComb (S alfa, const Rall1d< T, V, S > &a, const T &beta, const Rall1d< T, V, S > &b)
template<class T , class V , class S >
INLINE void LinCombR (S alfa, const Rall1d< T, V, S > &a, const T &beta, const Rall1d< T, V, S > &b, Rall1d< T, V, S > &result)
template<class T , class V , class S >
INLINE void SetToZero (Rall1d< T, V, S > &value)
template<class T , class V , class S >
INLINE void SetToIdentity (Rall1d< T, V, S > &value)
template<class T , class V , class S >
INLINE bool Equal (const Rall1d< T, V, S > &y, const Rall1d< T, V, S > &x, double eps=epsilon)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator/ (const Rall2d< T, V, S > &lhs, const Rall2d< T, V, S > &rhs)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator* (const Rall2d< T, V, S > &lhs, const Rall2d< T, V, S > &rhs)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator+ (const Rall2d< T, V, S > &lhs, const Rall2d< T, V, S > &rhs)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator- (const Rall2d< T, V, S > &lhs, const Rall2d< T, V, S > &rhs)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator- (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator* (S s, const Rall2d< T, V, S > &v)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator* (const Rall2d< T, V, S > &v, S s)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator+ (S s, const Rall2d< T, V, S > &v)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator+ (const Rall2d< T, V, S > &v, S s)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator- (S s, const Rall2d< T, V, S > &v)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator- (const Rall2d< T, V, S > &v, S s)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator/ (S s, const Rall2d< T, V, S > &rhs)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > operator/ (const Rall2d< T, V, S > &v, S s)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > exp (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > log (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > sin (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > cos (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > tan (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > sinh (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > cosh (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > tanh (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > sqr (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > pow (const Rall2d< T, V, S > &arg, double m)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > sqrt (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > asin (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > acos (const Rall2d< T, V, S > &arg)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > atan (const Rall2d< T, V, S > &x)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > atan2 (const Rall2d< T, V, S > &y, const Rall2d< T, V, S > &x)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > abs (const Rall2d< T, V, S > &x)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > hypot (const Rall2d< T, V, S > &y, const Rall2d< T, V, S > &x)
template<class T , class V , class S >
INLINE S Norm (const Rall2d< T, V, S > &value)
template<class T , class V , class S >
INLINE Rall2d< T, V, S > LinComb (S alfa, const Rall2d< T, V, S > &a, const T &beta, const Rall2d< T, V, S > &b)
template<class T , class V , class S >
INLINE void LinCombR (S alfa, const Rall2d< T, V, S > &a, const T &beta, const Rall2d< T, V, S > &b, Rall2d< T, V, S > &result)
template<class T , class V , class S >
INLINE void SetToZero (Rall2d< T, V, S > &value)
template<class T , class V , class S >
INLINE void SetToIdentity (Rall2d< T, V, S > &value)
template<class T , class V , class S >
INLINE bool Equal (const Rall2d< T, V, S > &y, const Rall2d< T, V, S > &x, double eps=epsilon)
template<typename Scalar >
Scalar PYTHAG (Scalar a, Scalar b)
template<typename Scalar >
Scalar SIGN (Scalar a, Scalar b)
template<typename MatrixA , typename MatrixUV , typename VectorS >
int svd_eigen_HH (const Eigen::MatrixBase< MatrixA > &A, Eigen::MatrixBase< MatrixUV > &U, Eigen::MatrixBase< VectorS > &S, Eigen::MatrixBase< MatrixUV > &V, Eigen::MatrixBase< VectorS > &tmp, int maxiter=150)
double sin (double a)
double cos (double a)
double exp (double a)
double log (double a)
double tan (double a)
double cosh (double a)
double sinh (double a)
double sqrt (double a)
double atan (double a)
double acos (double a)
double asin (double a)
double tanh (double a)
double pow (double a, double b)
double atan2 (double a, double b)
double max (double a, double b)
double min (double a, double b)
double LinComb (double alfa, double a, double beta, double b)
void LinCombR (double alfa, double a, double beta, double b, double &result)
void SetToZero (double &arg)
 to uniformly set double, RNDouble,Vector,... objects to zero in template-classes
void SetToIdentity (double &arg)
 to uniformly set double, RNDouble,Vector,... objects to the identity element in template-classes
double sign (double arg)
double sqr (double arg)
double Norm (double arg)
bool Equal (double a, double b, double eps=epsilon)
void random (double &a)
void posrandom (double &a)
double diff (double a, double b, double dt)
double addDelta (double a, double da, double dt)
void _check_istream (std::istream &is)
int _EatUntilEndOfLine (std::istream &is, int *countp=NULL)
int _EatUntilEndOfComment (std::istream &is, int *countp=NULL)
int _EatSpace (std::istream &is, int *countp=NULL)
void Eat (std::istream &is, int delim)
void EatEnd (std::istream &is, int delim)
char Upper (char ch)
void Eat (std::istream &is, const char *descript)
void EatWord (std::istream &is, const char *delim, char *storage, int maxsize)

Variables

ErrorStack errorstack
int STREAMBUFFERSIZE = 10000
int MAXLENFILENAME = 255
 maximal length of a file name
const double PI = 3.1415926535897932384626433832795
 the value of pi
const double deg2rad = 0.01745329251994329576923690768488
 the value pi/180
const double rad2deg = 57.2957795130823208767981548141052
 the value 180/pi
double epsilon = 0.000001
 default precision while comparing with Equal(..,..) functions. Initialized at 0.0000001.
double epsilon2 = 0.000001*0.000001
 power or 2 of epsilon
int VSIZE
 the number of derivatives used in the RN-... objects.

Typedef Documentation

typedef Rall2d<double,double,double> KDL::doubleAcc

Definition at line 40 of file frameacc.hpp.

typedef Rall1d<double> KDL::doubleVel

Definition at line 36 of file framevel.hpp.

typedef std::stack<std::string> KDL::ErrorStack

Definition at line 30 of file error_stack.cpp.

typedef std::map<std::string,TreeElement> KDL::SegmentMap

Definition at line 34 of file tree.hpp.


Function Documentation

void KDL::_check_istream ( std::istream &  is)

checks validity of basic io of is

Definition at line 35 of file utility_io.cpp.

Referenced by _EatSpace(), _EatUntilEndOfComment(), _EatUntilEndOfLine(), and EatWord().

int KDL::_EatSpace ( std::istream &  is,
int *  countp = NULL 
)

Definition at line 79 of file utility_io.cpp.

References _check_istream(), _EatUntilEndOfComment(), _EatUntilEndOfLine(), and NULL.

Referenced by Eat(), EatEnd(), and EatWord().

int KDL::_EatUntilEndOfComment ( std::istream &  is,
int *  countp = NULL 
)

Definition at line 57 of file utility_io.cpp.

References _check_istream(), and NULL.

Referenced by _EatSpace().

int KDL::_EatUntilEndOfLine ( std::istream &  is,
int *  countp = NULL 
)

Definition at line 43 of file utility_io.cpp.

References _check_istream(), and NULL.

Referenced by _EatSpace().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::abs ( const Rall1d< T, V, S > &  x)

Definition at line 409 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, Sign(), and T.

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::abs ( const Rall2d< T, V, S > &  x)

Definition at line 465 of file rall2d.h.

References KDL::Rall2d< T, V, S >::d, KDL::Rall2d< T, V, S >::dd, Sign(), and T.

double KDL::acos ( double  a) [inline]

Definition at line 113 of file utility.h.

References acos().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::acos ( const Rall1d< T, V, S > &  x)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::acos ( const Rall2d< T, V, S > &  arg)
void KDL::Add ( const JntArrayVel &  src1,
const JntArrayVel &  src2,
JntArrayVel &  dest 
)

Definition at line 54 of file jntarrayvel.cpp.

References Add(), KDL::JntArrayVel::q, and KDL::JntArrayVel::qdot.

void KDL::Add ( const JntArrayVel &  src1,
const JntArray &  src2,
JntArrayVel &  dest 
)

Definition at line 59 of file jntarrayvel.cpp.

References Add(), KDL::JntArrayVel::q, and KDL::JntArrayVel::qdot.

void KDL::Add ( const JntArrayAcc &  src1,
const JntArrayAcc &  src2,
JntArrayAcc &  dest 
)
void KDL::Add ( const JntArrayAcc &  src1,
const JntArrayVel &  src2,
JntArrayAcc &  dest 
)
void KDL::Add ( const JntArrayAcc &  src1,
const JntArray &  src2,
JntArrayAcc &  dest 
)
void KDL::Add ( const JntArray &  src1,
const JntArray &  src2,
JntArray &  dest 
)

Function to add two joint arrays, all the arguments must have the same size: A + B = C. This function is aliasing-safe, A or B can be the same array as C.

Parameters:
src1A
src2B
destC

Definition at line 98 of file jntarray.cpp.

References assert, and i.

Referenced by Add(), Divide(), and Multiply().

IMETHOD doubleVel KDL::addDelta ( const doubleVel &  a,
const doubleVel &  da,
double  dt = 1.0 
)

Definition at line 42 of file framevel.hpp.

double KDL::addDelta ( double  a,
double  da,
double  dt 
) [inline]

Definition at line 286 of file utility.h.

IMETHOD VectorVel KDL::addDelta ( const VectorVel &  a,
const VectorVel &  da,
double  dt = 1.0 
)

Definition at line 313 of file framevel.hpp.

References addDelta(), KDL::VectorVel::p, and KDL::VectorVel::v.

IMETHOD RotationVel KDL::addDelta ( const RotationVel &  a,
const VectorVel &  da,
double  dt = 1.0 
)
IMETHOD FrameVel KDL::addDelta ( const FrameVel &  a,
const TwistVel &  da,
double  dt = 1.0 
)

Definition at line 328 of file framevel.hpp.

IMETHOD Vector KDL::addDelta ( const Vector &  a,
const Vector &  da,
double  dt = 1 
)

Referenced by addDelta(), and addDelta().

IMETHOD Rotation KDL::addDelta ( const Rotation &  a,
const Vector &  da,
double  dt = 1 
)
IMETHOD Frame KDL::addDelta ( const Frame &  a,
const Twist &  da,
double  dt = 1 
)
IMETHOD Twist KDL::addDelta ( const Twist &  a,
const Twist &  da,
double  dt = 1 
)
IMETHOD Wrench KDL::addDelta ( const Wrench &  a,
const Wrench &  da,
double  dt = 1 
)
double KDL::asin ( double  a) [inline]

Definition at line 116 of file utility.h.

References asin().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::asin ( const Rall1d< T, V, S > &  x)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::asin ( const Rall2d< T, V, S > &  arg)
double KDL::atan ( double  a) [inline]

Definition at line 110 of file utility.h.

References atan().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::atan ( const Rall1d< T, V, S > &  x)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::atan ( const Rall2d< T, V, S > &  x)
double KDL::atan2 ( double  a,
double  b 
) [inline]

Definition at line 125 of file utility.h.

References atan2().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::atan2 ( const Rall1d< T, V, S > &  y,
const Rall1d< T, V, S > &  x 
)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::atan2 ( const Rall2d< T, V, S > &  y,
const Rall2d< T, V, S > &  x 
)
void KDL::changeBase ( const Jacobian &  src1,
const Rotation &  rot,
Jacobian &  dest 
)
void KDL::changeRefFrame ( const Jacobian &  src1,
const Frame &  frame,
Jacobian &  dest 
)

Definition at line 103 of file jacobian.cpp.

References assert, i, and KDL::Jacobian::twists.

void KDL::changeRefPoint ( const Jacobian &  src1,
const Vector &  base_AB,
Jacobian &  dest 
)
double KDL::cos ( double  a) [inline]

Definition at line 89 of file utility.h.

References cos().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::cos ( const Rall1d< T, V, S > &  arg)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::cos ( const Rall2d< T, V, S > &  arg)
double KDL::cosh ( double  a) [inline]

Definition at line 101 of file utility.h.

References cosh().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::cosh ( const Rall1d< T, V, S > &  arg)

Definition at line 345 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, sinh(), KDL::Rall1d< T, V, S >::t, and T.

Referenced by cosh(), sinh(), and tanh().

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::cosh ( const Rall2d< T, V, S > &  arg)
IMETHOD doubleVel KDL::diff ( const doubleVel &  a,
const doubleVel &  b,
double  dt = 1.0 
)

Definition at line 38 of file framevel.hpp.

double KDL::diff ( double  a,
double  b,
double  dt 
) [inline]

Definition at line 280 of file utility.h.

IMETHOD VectorVel KDL::diff ( const VectorVel &  a,
const VectorVel &  b,
double  dt = 1.0 
)

Definition at line 309 of file framevel.hpp.

References diff(), KDL::VectorVel::p, and KDL::VectorVel::v.

IMETHOD VectorVel KDL::diff ( const RotationVel &  a,
const RotationVel &  b,
double  dt = 1.0 
)

Definition at line 316 of file framevel.hpp.

References diff(), KDL::RotationVel::R, and KDL::RotationVel::w.

IMETHOD TwistVel KDL::diff ( const FrameVel &  a,
const FrameVel &  b,
double  dt = 1.0 
)

Definition at line 324 of file framevel.hpp.

IMETHOD Vector KDL::diff ( const Vector &  a,
const Vector &  b,
double  dt = 1 
)
IMETHOD Vector KDL::diff ( const Rotation &  R_a_b1,
const Rotation &  R_a_b2,
double  dt = 1 
)
IMETHOD Twist KDL::diff ( const Frame &  F_a_b1,
const Frame &  F_a_b2,
double  dt = 1 
)
IMETHOD Twist KDL::diff ( const Twist &  a,
const Twist &  b,
double  dt = 1 
)
IMETHOD Wrench KDL::diff ( const Wrench &  W_a_p1,
const Wrench &  W_a_p2,
double  dt = 1 
)
void KDL::Divide ( const JntArrayVel &  src,
const double &  factor,
JntArrayVel &  dest 
)

Definition at line 89 of file jntarrayvel.cpp.

References Divide(), KDL::JntArrayVel::q, and KDL::JntArrayVel::qdot.

void KDL::Divide ( const JntArrayVel &  src,
const doubleVel &  factor,
JntArrayVel &  dest 
)
void KDL::Divide ( const JntArray &  src,
const double &  factor,
JntArray &  dest 
)

Function to divide all the array values with a scalar factor: A/b=C. This function is aliasing-safe, A can be the same array as C.

Parameters:
srcA
factorb
destC

Definition at line 119 of file jntarray.cpp.

References assert, i, and KDL::JntArray::rows().

Referenced by Divide().

void KDL::Divide ( const JntArrayAcc &  src,
const double &  factor,
JntArrayAcc &  dest 
)
void KDL::Divide ( const JntArrayAcc &  src,
const doubleVel &  factor,
JntArrayAcc &  dest 
)
void KDL::Divide ( const JntArrayAcc &  src,
const doubleAcc &  factor,
JntArrayAcc &  dest 
)
doubleAcc KDL::dot ( const VectorAcc &  lhs,
const VectorAcc &  rhs 
)

Definition at line 138 of file frameacc.hpp.

Referenced by dot().

doubleAcc KDL::dot ( const VectorAcc &  lhs,
const Vector &  rhs 
)

Definition at line 145 of file frameacc.hpp.

doubleAcc KDL::dot ( const Vector &  lhs,
const VectorAcc &  rhs 
)

Definition at line 152 of file frameacc.hpp.

IMETHOD doubleVel KDL::dot ( const VectorVel &  lhs,
const VectorVel &  rhs 
)

Definition at line 358 of file framevel.hpp.

IMETHOD doubleVel KDL::dot ( const VectorVel &  lhs,
const Vector &  rhs 
)

Definition at line 361 of file framevel.hpp.

IMETHOD doubleVel KDL::dot ( const Vector &  lhs,
const VectorVel &  rhs 
)

Definition at line 364 of file framevel.hpp.

void KDL::Eat ( std::istream &  is,
int  delim 
)

Eats characters of the stream until the character delim is encountered

Parameters:
isa stream
delimeat until this character is encountered

Definition at line 111 of file utility_io.cpp.

References _EatSpace().

Referenced by operator>>().

void KDL::Eat ( std::istream &  is,
const char *  descript 
)

Eats characters of the stream as long as they satisfy the description in descript

Parameters:
isa stream
descriptdescription string. A sequence of spaces, tabs, new-lines and comments is regarded as 1 space in the description string.

Definition at line 154 of file utility_io.cpp.

References _EatSpace(), p, and Upper().

void KDL::EatEnd ( std::istream &  is,
int  delim 
)

Eats characters of the stream until the character delim is encountered similar to Eat(is,delim) but spaces at the end are not read.

Parameters:
isa stream
delimeat until this character is encountered

Definition at line 125 of file utility_io.cpp.

References _EatSpace().

Referenced by operator>>().

void KDL::EatWord ( std::istream &  is,
const char *  delim,
char *  storage,
int  maxsize 
)

Eats a word of the stream delimited by the letters in delim or space(tabs...)

Parameters:
isa stream
delima string containing the delimmiting characters
storagefor returning the word
maxsizea word can be maximally maxsize-1 long.

Definition at line 185 of file utility_io.cpp.

References _check_istream(), _EatSpace(), NULL, p, and size().

Referenced by operator>>().

bool KDL::Equal ( const FrameVel &  r1,
const FrameVel &  r2,
double  eps = epsilon 
)

Definition at line 76 of file framevel.hpp.

bool KDL::Equal ( const Frame &  r1,
const FrameVel &  r2,
double  eps = epsilon 
)

Definition at line 79 of file framevel.hpp.

bool KDL::Equal ( const FrameVel &  r1,
const Frame &  r2,
double  eps = epsilon 
)

Definition at line 82 of file framevel.hpp.

bool KDL::Equal ( const JntArrayVel &  src1,
const JntArrayVel &  src2,
double  eps = epsilon 
)

Definition at line 108 of file jntarrayvel.cpp.

References Equal(), KDL::JntArrayVel::q, and KDL::JntArrayVel::qdot.

bool KDL::Equal ( const Jacobian &  a,
const Jacobian &  b,
double  eps = epsilon 
)
bool KDL::Equal ( const JntArray &  src1,
const JntArray &  src2,
double  eps = epsilon 
)

Function to check if two arrays are the same with a precision of eps

Parameters:
src1
src2
epsdefault: epsilon
Returns:
true if each element of src1 is within eps of the same element in src2, or if both src1 and src2 have no data (ie 0==rows())

Definition at line 141 of file jntarray.cpp.

References assert, Equal(), and i.

bool KDL::Equal ( const Rotation &  a,
const Rotation &  b,
double  eps = epsilon 
)

do not use operator == because the definition of Equal(.,.) is slightly different. It compares whether the 2 arguments are equal in an eps-interval

Definition at line 157 of file frames.cpp.

References KDL::Rotation::data, and Equal().

bool KDL::Equal ( const VectorAcc &  r1,
const VectorAcc &  r2,
double  eps = epsilon 
)
bool KDL::Equal ( const Vector &  r1,
const VectorAcc &  r2,
double  eps = epsilon 
)

Definition at line 167 of file frameacc.hpp.

bool KDL::Equal ( const JntArrayAcc &  src1,
const JntArrayAcc &  src2,
double  eps = epsilon 
)
bool KDL::Equal ( const VectorAcc &  r1,
const Vector &  r2,
double  eps = epsilon 
)

Definition at line 174 of file frameacc.hpp.

bool KDL::Equal ( double  a,
double  b,
double  eps = epsilon 
) [inline]

Definition at line 266 of file utility.h.

References eps.

bool KDL::Equal ( const RotationAcc &  r1,
const RotationAcc &  r2,
double  eps = epsilon 
)

Definition at line 324 of file frameacc.hpp.

bool KDL::Equal ( const VectorVel &  r1,
const VectorVel &  r2,
double  eps = epsilon 
)

Definition at line 324 of file framevel.hpp.

References diff(), KDL::FrameVel::M, and KDL::FrameVel::p.

bool KDL::Equal ( const Rotation &  r1,
const RotationAcc &  r2,
double  eps = epsilon 
)

Definition at line 327 of file frameacc.hpp.

bool KDL::Equal ( const Vector &  r1,
const VectorVel &  r2,
double  eps = epsilon 
)

Definition at line 327 of file framevel.hpp.

bool KDL::Equal ( const VectorVel &  r1,
const Vector &  r2,
double  eps = epsilon 
)

Definition at line 330 of file framevel.hpp.

bool KDL::Equal ( const RotationAcc &  r1,
const Rotation &  r2,
double  eps = epsilon 
)

Definition at line 331 of file frameacc.hpp.

bool KDL::Equal ( const RotationVel &  r1,
const RotationVel &  r2,
double  eps = epsilon 
)

Definition at line 334 of file framevel.hpp.

bool KDL::Equal ( const Rotation &  r1,
const RotationVel &  r2,
double  eps = epsilon 
)

Definition at line 337 of file framevel.hpp.

bool KDL::Equal ( const RotationVel &  r1,
const Rotation &  r2,
double  eps = epsilon 
)

Definition at line 340 of file framevel.hpp.

bool KDL::Equal ( const TwistVel &  a,
const TwistVel &  b,
double  eps = epsilon 
)

Definition at line 343 of file framevel.hpp.

bool KDL::Equal ( const Twist &  a,
const TwistVel &  b,
double  eps = epsilon 
)

Definition at line 347 of file framevel.hpp.

bool KDL::Equal ( const TwistVel &  a,
const Twist &  b,
double  eps = epsilon 
)

Definition at line 351 of file framevel.hpp.

bool KDL::Equal ( const FrameAcc &  r1,
const FrameAcc &  r2,
double  eps = epsilon 
)

Definition at line 394 of file frameacc.hpp.

bool KDL::Equal ( const Frame &  r1,
const FrameAcc &  r2,
double  eps = epsilon 
)

Definition at line 397 of file frameacc.hpp.

bool KDL::Equal ( const FrameAcc &  r1,
const Frame &  r2,
double  eps = epsilon 
)

Definition at line 400 of file frameacc.hpp.

template<class T , class V , class S >
INLINE bool KDL::Equal ( const Rall1d< T, V, S > &  y,
const Rall1d< T, V, S > &  x,
double  eps = epsilon 
)

Definition at line 469 of file rall1d.h.

References eps, Equal(), KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE bool KDL::Equal ( const Rall2d< T, V, S > &  y,
const Rall2d< T, V, S > &  x,
double  eps = epsilon 
)
bool KDL::Equal ( const TwistAcc &  a,
const TwistAcc &  b,
double  eps = epsilon 
)

Definition at line 587 of file frameacc.hpp.

bool KDL::Equal ( const Twist &  a,
const TwistAcc &  b,
double  eps = epsilon 
)

Definition at line 591 of file frameacc.hpp.

bool KDL::Equal ( const TwistAcc &  a,
const Twist &  b,
double  eps = epsilon 
)

Definition at line 595 of file frameacc.hpp.

double KDL::exp ( double  a) [inline]

Definition at line 92 of file utility.h.

References exp().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::exp ( const Rall1d< T, V, S > &  arg)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::exp ( const Rall2d< T, V, S > &  arg)
template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::hypot ( const Rall1d< T, V, S > &  y,
const Rall1d< T, V, S > &  x 
)

Definition at line 385 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, KDL::Rall1d< T, V, S >::t, and T.

Referenced by Eigentql2(), and hypot().

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::hypot ( const Rall2d< T, V, S > &  y,
const Rall2d< T, V, S > &  x 
)
void KDL::IOTrace ( const std::string &  description)

Definition at line 36 of file error_stack.cpp.

References errorstack.

Referenced by operator>>().

void KDL::IOTraceOutput ( std::ostream &  os)

outputs the IO-stack to a stream to provide a better errormessage.

Definition at line 45 of file error_stack.cpp.

References errorstack.

void KDL::IOTracePop ( )

pops a description of the IO-stack

Definition at line 41 of file error_stack.cpp.

References errorstack.

Referenced by operator>>().

void KDL::IOTracePopStr ( char *  buffer,
int  size 
)

outputs one element of the IO-stack to the buffer (maximally size chars) returns empty string if no elements on the stack.

Definition at line 53 of file error_stack.cpp.

References errorstack, and size().

double KDL::LinComb ( double  alfa,
double  a,
double  beta,
double  b 
) [inline]

Definition at line 228 of file utility.h.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::LinComb ( alfa,
const Rall1d< T, V, S > &  a,
const T &  beta,
const Rall1d< T, V, S > &  b 
)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::LinComb ( alfa,
const Rall2d< T, V, S > &  a,
const T &  beta,
const Rall2d< T, V, S > &  b 
)
void KDL::LinCombR ( double  alfa,
double  a,
double  beta,
double  b,
double &  result 
) [inline]

Definition at line 233 of file utility.h.

template<class T , class V , class S >
INLINE void KDL::LinCombR ( alfa,
const Rall1d< T, V, S > &  a,
const T &  beta,
const Rall1d< T, V, S > &  b,
Rall1d< T, V, S > &  result 
)
template<class T , class V , class S >
INLINE void KDL::LinCombR ( alfa,
const Rall2d< T, V, S > &  a,
const T &  beta,
const Rall2d< T, V, S > &  b,
Rall2d< T, V, S > &  result 
)
double KDL::log ( double  a) [inline]

Definition at line 95 of file utility.h.

References log().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::log ( const Rall1d< T, V, S > &  arg)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::log ( const Rall2d< T, V, S > &  arg)
double KDL::max ( double  a,
double  b 
) [inline]

Definition at line 201 of file utility.h.

double KDL::min ( double  a,
double  b 
) [inline]

Definition at line 209 of file utility.h.

void KDL::Multiply ( const JntArrayVel &  src,
const double &  factor,
JntArrayVel &  dest 
)

Definition at line 76 of file jntarrayvel.cpp.

References Multiply(), KDL::JntArrayVel::q, and KDL::JntArrayVel::qdot.

void KDL::Multiply ( const JntArrayVel &  src,
const doubleVel &  factor,
JntArrayVel &  dest 
)
void KDL::Multiply ( const JntArrayAcc &  src,
const double &  factor,
JntArrayAcc &  dest 
)
void KDL::Multiply ( const JntArrayAcc &  src,
const doubleVel &  factor,
JntArrayAcc &  dest 
)
void KDL::Multiply ( const JntArray &  src,
const double &  factor,
JntArray &  dest 
)

Function to multiply all the array values with a scalar factor: A*b=C. This function is aliasing-safe, A can be the same array as C.

Parameters:
srcA
factorb
destC

Definition at line 112 of file jntarray.cpp.

References assert, and i.

Referenced by Divide(), and Multiply().

void KDL::Multiply ( const JntArrayAcc &  src,
const doubleAcc &  factor,
JntArrayAcc &  dest 
)
void KDL::MultiplyJacobian ( const Jacobian &  jac,
const JntArray &  src,
Twist &  dest 
)

Function to multiply a KDL::Jacobian with a KDL::JntArray to get a KDL::Twist, it should not be used to calculate the forward velocity kinematics, the solver classes are built for this purpose. J*q = t

Parameters:
jacJ
srcq
destt
Postcondition:
dest==Twist::Zero() if 0==src.rows() (ie src is empty)

Definition at line 126 of file jntarray.cpp.

References assert, KDL::Jacobian::columns(), i, and SetToZero().

double KDL::Norm ( double  arg) [inline]

Definition at line 253 of file utility.h.

References fabs().

template<class T , class V , class S >
INLINE S KDL::Norm ( const Rall1d< T, V, S > &  value)

Definition at line 418 of file rall1d.h.

References KDL::Rall1d< T, V, S >::t.

Referenced by Norm(), and iTaSC::Distance::updateControlOutput().

template<class T , class V , class S >
INLINE S KDL::Norm ( const Rall2d< T, V, S > &  value)

Definition at line 483 of file rall2d.h.

References Norm(), and KDL::Rall2d< T, V, S >::t.

FrameVel KDL::operator* ( const FrameVel &  lhs,
const FrameVel &  rhs 
)

Definition at line 34 of file framevel.hpp.

FrameVel KDL::operator* ( const FrameVel &  lhs,
const Frame &  rhs 
)

Definition at line 38 of file framevel.hpp.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

FrameVel KDL::operator* ( const Frame &  lhs,
const FrameVel &  rhs 
)

Definition at line 42 of file framevel.hpp.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

VectorAcc KDL::operator* ( const VectorAcc &  r1,
const VectorAcc &  r2 
)

Definition at line 53 of file frameacc.hpp.

VectorAcc KDL::operator* ( const VectorAcc &  r1,
const Vector &  r2 
)

Definition at line 60 of file frameacc.hpp.

VectorAcc KDL::operator* ( const Vector &  r1,
const VectorAcc &  r2 
)

Definition at line 64 of file frameacc.hpp.

VectorAcc KDL::operator* ( double  r1,
const VectorAcc &  r2 
)

Definition at line 71 of file frameacc.hpp.

VectorAcc KDL::operator* ( const VectorAcc &  r1,
double  r2 
)

Definition at line 75 of file frameacc.hpp.

VectorAcc KDL::operator* ( const doubleAcc &  r1,
const VectorAcc &  r2 
)

Definition at line 79 of file frameacc.hpp.

VectorAcc KDL::operator* ( const VectorAcc &  r2,
const doubleAcc &  r1 
)

Definition at line 86 of file frameacc.hpp.

RotationVel KDL::operator* ( const RotationVel &  r1,
const RotationVel &  r2 
)

Definition at line 95 of file framevel.hpp.

RotationVel KDL::operator* ( const Rotation &  r1,
const RotationVel &  r2 
)

Definition at line 99 of file framevel.hpp.

RotationVel KDL::operator* ( const RotationVel &  r1,
const Rotation &  r2 
)

Definition at line 103 of file framevel.hpp.

Rotation KDL::operator* ( const Rotation &  lhs,
const Rotation &  rhs 
)

Definition at line 177 of file frames.cpp.

References KDL::Rotation::data, and Rotation().

RotationAcc KDL::operator* ( const RotationAcc &  r1,
const RotationAcc &  r2 
)

Definition at line 193 of file frameacc.hpp.

RotationAcc KDL::operator* ( const Rotation &  r1,
const RotationAcc &  r2 
)

Definition at line 200 of file frameacc.hpp.

RotationAcc KDL::operator* ( const RotationAcc &  r1,
const Rotation &  r2 
)

Definition at line 204 of file frameacc.hpp.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator* ( const Rall1d< T, V, S > &  lhs,
const Rall1d< T, V, S > &  rhs 
)

Definition at line 223 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator* ( const Rall2d< T, V, S > &  lhs,
const Rall2d< T, V, S > &  rhs 
)
VectorVel KDL::operator* ( const VectorVel &  r1,
const VectorVel &  r2 
)

Definition at line 246 of file framevel.hpp.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator* ( s,
const Rall1d< T, V, S > &  v 
)

Definition at line 248 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

VectorVel KDL::operator* ( const VectorVel &  r1,
const Vector &  r2 
)

Definition at line 250 of file framevel.hpp.

VectorVel KDL::operator* ( const Vector &  r1,
const VectorVel &  r2 
)

Definition at line 254 of file framevel.hpp.

References KDL::TwistVel::rot, KDL::VectorVel::value(), and KDL::TwistVel::vel.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator* ( const Rall1d< T, V, S > &  v,
s 
)

Definition at line 254 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

VectorAcc KDL::operator* ( const Rotation &  R,
const VectorAcc &  x 
)

Definition at line 255 of file frameacc.hpp.

VectorVel KDL::operator* ( double  r1,
const VectorVel &  r2 
)

Definition at line 261 of file framevel.hpp.

VectorVel KDL::operator* ( const VectorVel &  r1,
double  r2 
)

Definition at line 265 of file framevel.hpp.

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator* ( s,
const Rall2d< T, V, S > &  v 
)
VectorVel KDL::operator* ( const doubleVel &  r1,
const VectorVel &  r2 
)

Definition at line 271 of file framevel.hpp.

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator* ( const Rall2d< T, V, S > &  v,
s 
)
VectorVel KDL::operator* ( const VectorVel &  r2,
const doubleVel &  r1 
)

Definition at line 275 of file framevel.hpp.

VectorVel KDL::operator* ( const Rotation &  R,
const VectorVel &  x 
)

Definition at line 287 of file framevel.hpp.

FrameAcc KDL::operator* ( const FrameAcc &  lhs,
const FrameAcc &  rhs 
)

Definition at line 350 of file frameacc.hpp.

FrameAcc KDL::operator* ( const FrameAcc &  lhs,
const Frame &  rhs 
)

Definition at line 354 of file frameacc.hpp.

FrameAcc KDL::operator* ( const Frame &  lhs,
const FrameAcc &  rhs 
)

Definition at line 358 of file frameacc.hpp.

TwistVel KDL::operator* ( const TwistVel &  lhs,
double  rhs 
)

Definition at line 416 of file framevel.hpp.

TwistVel KDL::operator* ( double  lhs,
const TwistVel &  rhs 
)

Definition at line 421 of file framevel.hpp.

TwistVel KDL::operator* ( const TwistVel &  lhs,
const doubleVel &  rhs 
)

Definition at line 432 of file framevel.hpp.

TwistVel KDL::operator* ( const doubleVel &  lhs,
const TwistVel &  rhs 
)

Definition at line 437 of file framevel.hpp.

TwistAcc KDL::operator* ( const TwistAcc &  lhs,
double  rhs 
)

Definition at line 472 of file frameacc.hpp.

TwistAcc KDL::operator* ( double  lhs,
const TwistAcc &  rhs 
)

Definition at line 477 of file frameacc.hpp.

TwistAcc KDL::operator* ( const TwistAcc &  lhs,
const doubleAcc &  rhs 
)

Definition at line 488 of file frameacc.hpp.

TwistAcc KDL::operator* ( const doubleAcc &  lhs,
const TwistAcc &  rhs 
)

Definition at line 493 of file frameacc.hpp.

VectorAcc KDL::operator+ ( const VectorAcc &  r1,
const VectorAcc &  r2 
)

Definition at line 25 of file frameacc.hpp.

VectorAcc KDL::operator+ ( const Vector &  r1,
const VectorAcc &  r2 
)

Definition at line 32 of file frameacc.hpp.

VectorAcc KDL::operator+ ( const VectorAcc &  r1,
const Vector &  r2 
)

Definition at line 39 of file frameacc.hpp.

VectorVel KDL::operator+ ( const VectorVel &  r1,
const VectorVel &  r2 
)

Definition at line 211 of file framevel.hpp.

VectorVel KDL::operator+ ( const VectorVel &  r1,
const Vector &  r2 
)

Definition at line 219 of file framevel.hpp.

VectorVel KDL::operator+ ( const Vector &  r1,
const VectorVel &  r2 
)

Definition at line 227 of file framevel.hpp.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator+ ( const Rall1d< T, V, S > &  lhs,
const Rall1d< T, V, S > &  rhs 
)

Definition at line 229 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator+ ( const Rall2d< T, V, S > &  lhs,
const Rall2d< T, V, S > &  rhs 
)
template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator+ ( s,
const Rall1d< T, V, S > &  v 
)

Definition at line 260 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator+ ( const Rall1d< T, V, S > &  v,
s 
)

Definition at line 266 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator+ ( s,
const Rall2d< T, V, S > &  v 
)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator+ ( const Rall2d< T, V, S > &  v,
s 
)
TwistVel KDL::operator+ ( const TwistVel &  lhs,
const TwistVel &  rhs 
)

Definition at line 450 of file framevel.hpp.

TwistAcc KDL::operator+ ( const TwistAcc &  lhs,
const TwistAcc &  rhs 
)

Definition at line 506 of file frameacc.hpp.

VectorAcc KDL::operator- ( const VectorAcc &  r1,
const VectorAcc &  r2 
)

Definition at line 29 of file frameacc.hpp.

VectorAcc KDL::operator- ( const Vector &  r1,
const VectorAcc &  r2 
)

Definition at line 36 of file frameacc.hpp.

VectorAcc KDL::operator- ( const VectorAcc &  r1,
const Vector &  r2 
)

Definition at line 43 of file frameacc.hpp.

VectorAcc KDL::operator- ( const VectorAcc &  r)

Definition at line 48 of file frameacc.hpp.

VectorVel KDL::operator- ( const VectorVel &  r1,
const VectorVel &  r2 
)

Definition at line 215 of file framevel.hpp.

VectorVel KDL::operator- ( const VectorVel &  r1,
const Vector &  r2 
)

Definition at line 223 of file framevel.hpp.

VectorVel KDL::operator- ( const Vector &  r1,
const VectorVel &  r2 
)

Definition at line 231 of file framevel.hpp.

VectorVel KDL::operator- ( const VectorVel &  r)

Definition at line 236 of file framevel.hpp.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator- ( const Rall1d< T, V, S > &  lhs,
const Rall1d< T, V, S > &  rhs 
)

Definition at line 236 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator- ( const Rall1d< T, V, S > &  arg)

Definition at line 242 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator- ( const Rall2d< T, V, S > &  lhs,
const Rall2d< T, V, S > &  rhs 
)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator- ( const Rall2d< T, V, S > &  arg)
template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator- ( s,
const Rall1d< T, V, S > &  v 
)

Definition at line 272 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator- ( const Rall1d< T, V, S > &  v,
s 
)

Definition at line 278 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator- ( s,
const Rall2d< T, V, S > &  v 
)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator- ( const Rall2d< T, V, S > &  v,
s 
)
TwistVel KDL::operator- ( const TwistVel &  lhs,
const TwistVel &  rhs 
)

Definition at line 455 of file framevel.hpp.

TwistVel KDL::operator- ( const TwistVel &  arg)

Definition at line 461 of file framevel.hpp.

TwistAcc KDL::operator- ( const TwistAcc &  lhs,
const TwistAcc &  rhs 
)

Definition at line 511 of file frameacc.hpp.

TwistAcc KDL::operator- ( const TwistAcc &  arg)

Definition at line 517 of file frameacc.hpp.

VectorAcc KDL::operator/ ( const VectorAcc &  r1,
double  r2 
)

Definition at line 181 of file frameacc.hpp.

VectorAcc KDL::operator/ ( const VectorAcc &  r2,
const doubleAcc &  r1 
)

Definition at line 185 of file frameacc.hpp.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator/ ( const Rall1d< T, V, S > &  lhs,
const Rall1d< T, V, S > &  rhs 
)

Definition at line 217 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator/ ( const Rall2d< T, V, S > &  lhs,
const Rall2d< T, V, S > &  rhs 
)
VectorVel KDL::operator/ ( const VectorVel &  r1,
double  r2 
)

Definition at line 279 of file framevel.hpp.

VectorVel KDL::operator/ ( const VectorVel &  r2,
const doubleVel &  r1 
)

Definition at line 283 of file framevel.hpp.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator/ ( s,
const Rall1d< T, V, S > &  v 
)

Definition at line 284 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::operator/ ( const Rall1d< T, V, S > &  v,
s 
)

Definition at line 290 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, and KDL::Rall1d< T, V, S >::t.

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator/ ( s,
const Rall2d< T, V, S > &  rhs 
)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::operator/ ( const Rall2d< T, V, S > &  v,
s 
)
TwistVel KDL::operator/ ( const TwistVel &  lhs,
double  rhs 
)

Definition at line 426 of file framevel.hpp.

TwistVel KDL::operator/ ( const TwistVel &  lhs,
const doubleVel &  rhs 
)

Definition at line 442 of file framevel.hpp.

TwistAcc KDL::operator/ ( const TwistAcc &  lhs,
double  rhs 
)

Definition at line 482 of file frameacc.hpp.

TwistAcc KDL::operator/ ( const TwistAcc &  lhs,
const doubleAcc &  rhs 
)

Definition at line 498 of file frameacc.hpp.

std::ostream & KDL::operator<< ( std::ostream &  os,
const Joint &  joint 
)

Definition at line 29 of file kinfam_io.cpp.

References KDL::Joint::getTypeName().

std::ostream & KDL::operator<< ( std::ostream &  os,
const Segment &  segment 
)

Definition at line 37 of file kinfam_io.cpp.

References KDL::Segment::getFrameToTip(), and KDL::Segment::getJoint().

std::ostream & KDL::operator<< ( std::ostream &  os,
const Vector &  v 
)

width to be used when printing variables out with frames_io.h global variable, can be changed.

Definition at line 45 of file frames_io.cpp.

References KDL_FRAME_WIDTH.

std::ostream & KDL::operator<< ( std::ostream &  os,
const Chain &  chain 
)

Definition at line 46 of file kinfam_io.cpp.

References KDL::Chain::getNrOfSegments(), KDL::Chain::getSegment(), and i.

std::ostream & KDL::operator<< ( std::ostream &  os,
const Twist &  v 
)

Definition at line 51 of file frames_io.cpp.

References KDL_FRAME_WIDTH, KDL::Twist::rot, and KDL::Twist::vel.

template<typename T >
std::ostream& KDL::operator<< ( std::ostream &  os,
const std::vector< T > &  vec 
)

Definition at line 54 of file kinfam_io.hpp.

References i.

std::ostream & KDL::operator<< ( std::ostream &  os,
const Tree &  tree 
)

Definition at line 58 of file kinfam_io.cpp.

References KDL::Tree::getSegment(), and MakeCursor::root.

std::ostream & KDL::operator<< ( std::ostream &  os,
const Wrench &  v 
)

Definition at line 62 of file frames_io.cpp.

References KDL::Wrench::force, KDL_FRAME_WIDTH, and KDL::Wrench::torque.

std::ostream & KDL::operator<< ( std::ostream &  os,
SegmentMap::const_iterator  root 
)

Definition at line 63 of file kinfam_io.cpp.

References i.

std::ostream & KDL::operator<< ( std::ostream &  os,
const Rotation &  R 
)

Definition at line 74 of file frames_io.cpp.

References KDL::Rotation::GetEulerZYX(), KDL::Rotation::GetRPY(), i, KDL_FRAME_WIDTH, p, and R.

std::ostream & KDL::operator<< ( std::ostream &  os,
const JntArray &  array 
)

Definition at line 76 of file kinfam_io.cpp.

References i, KDL_FRAME_WIDTH, and KDL::JntArray::rows().

std::ostream & KDL::operator<< ( std::ostream &  os,
const Jacobian &  jac 
)

Definition at line 88 of file kinfam_io.cpp.

References KDL::Jacobian::columns(), i, KDL_FRAME_WIDTH, and KDL::Jacobian::rows().

std::ostream & KDL::operator<< ( std::ostream &  os,
const Frame &  T 
)

Definition at line 108 of file frames_io.cpp.

References KDL::Frame::M, and KDL::Frame::p.

std::ostream & KDL::operator<< ( std::ostream &  os,
const Vector2 &  v 
)

Definition at line 114 of file frames_io.cpp.

References KDL_FRAME_WIDTH.

std::ostream & KDL::operator<< ( std::ostream &  os,
const Rotation2 &  R 
)

Definition at line 121 of file frames_io.cpp.

References KDL::Rotation2::GetRot(), and rad2deg.

std::ostream & KDL::operator<< ( std::ostream &  os,
const Frame2 &  T 
)

Definition at line 126 of file frames_io.cpp.

References KDL::Frame2::M, and KDL::Frame2::p.

bool KDL::operator== ( const JntArray &  src1,
const JntArray &  src2 
)

Definition at line 150 of file jntarray.cpp.

References Equal().

bool KDL::operator== ( const Rotation &  a,
const Rotation &  b 
)

Definition at line 377 of file frames.cpp.

References KDL::Rotation::data, and Equal().

Referenced by operator!=().

std::istream & KDL::operator>> ( std::istream &  is,
Joint &  joint 
)

Definition at line 33 of file kinfam_io.cpp.

std::istream & KDL::operator>> ( std::istream &  is,
Segment &  segment 
)

Definition at line 42 of file kinfam_io.cpp.

std::istream & KDL::operator>> ( std::istream &  is,
Chain &  chain 
)

Definition at line 54 of file kinfam_io.cpp.

template<typename T >
std::istream& KDL::operator>> ( std::istream &  is,
std::vector< T > &  vec 
)

Definition at line 64 of file kinfam_io.hpp.

std::istream & KDL::operator>> ( std::istream &  is,
Tree &  tree 
)

Definition at line 72 of file kinfam_io.cpp.

std::istream & KDL::operator>> ( std::istream &  is,
JntArray &  array 
)

Definition at line 84 of file kinfam_io.cpp.

std::istream & KDL::operator>> ( std::istream &  is,
Jacobian &  jac 
)

Definition at line 99 of file kinfam_io.cpp.

std::istream & KDL::operator>> ( std::istream &  is,
Vector &  v 
)

Definition at line 132 of file frames_io.cpp.

References Eat(), EatEnd(), EatWord(), IOTrace(), IOTracePop(), and KDL::Vector::Zero().

std::istream & KDL::operator>> ( std::istream &  is,
Twist &  v 
)

Definition at line 155 of file frames_io.cpp.

References Eat(), EatEnd(), IOTrace(), IOTracePop(), KDL::Twist::rot, and KDL::Twist::vel.

std::istream & KDL::operator>> ( std::istream &  is,
Wrench &  v 
)

Definition at line 174 of file frames_io.cpp.

References Eat(), EatEnd(), KDL::Wrench::force, IOTrace(), IOTracePop(), and KDL::Wrench::torque.

std::istream & KDL::operator>> ( std::istream &  is,
Rotation &  r 
)
std::istream & KDL::operator>> ( std::istream &  is,
Frame &  T 
)
std::istream & KDL::operator>> ( std::istream &  is,
Vector2 &  v 
)

Definition at line 285 of file frames_io.cpp.

References Eat(), EatEnd(), IOTrace(), and IOTracePop().

std::istream & KDL::operator>> ( std::istream &  is,
Rotation2 &  r 
)
std::istream & KDL::operator>> ( std::istream &  is,
Frame2 &  T 
)

Definition at line 305 of file frames_io.cpp.

References IOTrace(), IOTracePop(), KDL::Frame2::M, and KDL::Frame2::p.

IMETHOD void KDL::posrandom ( doubleVel &  F)

Definition at line 50 of file framevel.hpp.

Referenced by posrandom(), and posrandom().

void KDL::posrandom ( double &  a) [inline]

Definition at line 276 of file utility.h.

IMETHOD void KDL::posrandom ( VectorVel &  a)

Definition at line 353 of file framevel.hpp.

References KDL::VectorVel::p, posrandom(), and KDL::VectorVel::v.

IMETHOD void KDL::posrandom ( TwistVel &  a)

Definition at line 357 of file framevel.hpp.

IMETHOD void KDL::posrandom ( RotationVel &  R)

Definition at line 362 of file framevel.hpp.

References posrandom(), and KDL::RotationVel::R.

IMETHOD void KDL::posrandom ( FrameVel &  F)

Definition at line 367 of file framevel.hpp.

References KDL::FrameVel::M, KDL::FrameVel::p, and posrandom().

double KDL::pow ( double  a,
double  b 
) [inline]

Definition at line 122 of file utility.h.

References pow().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::pow ( const Rall1d< T, V, S > &  arg,
double  m 
)

Definition at line 361 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, KDL::Rall1d< T, V, S >::t, and T.

Referenced by pow().

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::pow ( const Rall2d< T, V, S > &  arg,
double  m 
)
template<typename Scalar >
Scalar KDL::PYTHAG ( Scalar  a,
Scalar  b 
) [inline]

Definition at line 33 of file svd_eigen_HH.hpp.

References at, fabs(), and sqrt().

Referenced by svd_eigen_HH().

IMETHOD void KDL::random ( doubleVel &  F)

Definition at line 46 of file framevel.hpp.

Referenced by posrandom(), random(), and random().

void KDL::random ( double &  a) [inline]

Definition at line 272 of file utility.h.

IMETHOD void KDL::random ( VectorVel &  a)

Definition at line 335 of file framevel.hpp.

References KDL::VectorVel::p, and random().

IMETHOD void KDL::random ( TwistVel &  a)

Definition at line 339 of file framevel.hpp.

IMETHOD void KDL::random ( RotationVel &  R)

Definition at line 344 of file framevel.hpp.

References KDL::RotationVel::R, random(), and KDL::RotationVel::w.

IMETHOD void KDL::random ( FrameVel &  F)

Definition at line 349 of file framevel.hpp.

References KDL::FrameVel::M, and random().

void KDL::SetToIdentity ( double &  arg) [inline]

to uniformly set double, RNDouble,Vector,... objects to the identity element in template-classes

Definition at line 244 of file utility.h.

template<class T , class V , class S >
INLINE void KDL::SetToIdentity ( Rall1d< T, V, S > &  value)
template<class T , class V , class S >
INLINE void KDL::SetToIdentity ( Rall2d< T, V, S > &  value)
void KDL::SetToZero ( Jacobian &  jac)

Definition at line 81 of file jacobian.cpp.

References i, SetToZero(), and KDL::Jacobian::twists.

void KDL::SetToZero ( JntArrayVel &  array)

Definition at line 102 of file jntarrayvel.cpp.

References KDL::JntArrayVel::q, KDL::JntArrayVel::qdot, and SetToZero().

void KDL::SetToZero ( JntArray &  array)

Function to set all the values of the array to 0

Parameters:
array

Definition at line 135 of file jntarray.cpp.

References i.

void KDL::SetToZero ( JntArrayAcc &  array)
void KDL::SetToZero ( double &  arg) [inline]

to uniformly set double, RNDouble,Vector,... objects to zero in template-classes

Definition at line 239 of file utility.h.

void KDL::SetToZero ( VectorVel &  v)
template<class T , class V , class S >
INLINE void KDL::SetToZero ( Rall1d< T, V, S > &  value)

Definition at line 456 of file rall1d.h.

References KDL::Rall1d< T, V, S >::grad, SetToZero(), and KDL::Rall1d< T, V, S >::t.

void KDL::SetToZero ( TwistVel &  v)

Definition at line 466 of file framevel.hpp.

template<class T , class V , class S >
INLINE void KDL::SetToZero ( Rall2d< T, V, S > &  value)
template<typename Scalar >
Scalar KDL::SIGN ( Scalar  a,
Scalar  b 
) [inline]

Definition at line 51 of file svd_eigen_HH.hpp.

References fabs().

Referenced by svd_eigen_HH().

double KDL::sign ( double  arg) [inline]

Definition at line 248 of file utility.h.

Referenced by KDL::Rotation::GetRPY().

double KDL::sin ( double  a) [inline]

Definition at line 85 of file utility.h.

References sin().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::sin ( const Rall1d< T, V, S > &  arg)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::sin ( const Rall2d< T, V, S > &  arg)
double KDL::sinh ( double  a) [inline]

Definition at line 104 of file utility.h.

References sinh().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::sinh ( const Rall1d< T, V, S > &  arg)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::sinh ( const Rall2d< T, V, S > &  arg)
double KDL::sqr ( double  arg) [inline]

Definition at line 252 of file utility.h.

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::sqr ( const Rall1d< T, V, S > &  arg)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::sqr ( const Rall2d< T, V, S > &  arg)
double KDL::sqrt ( double  a) [inline]

Definition at line 107 of file utility.h.

References sqrt().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::sqrt ( const Rall1d< T, V, S > &  arg)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::sqrt ( const Rall2d< T, V, S > &  arg)
void KDL::Subtract ( const JntArrayVel &  src1,
const JntArrayVel &  src2,
JntArrayVel &  dest 
)

Definition at line 65 of file jntarrayvel.cpp.

References KDL::JntArrayVel::q, KDL::JntArrayVel::qdot, and Subtract().

void KDL::Subtract ( const JntArrayVel &  src1,
const JntArray &  src2,
JntArrayVel &  dest 
)

Definition at line 70 of file jntarrayvel.cpp.

References KDL::JntArrayVel::q, KDL::JntArrayVel::qdot, and Subtract().

void KDL::Subtract ( const JntArrayAcc &  src1,
const JntArrayAcc &  src2,
JntArrayAcc &  dest 
)
void KDL::Subtract ( const JntArrayAcc &  src1,
const JntArrayVel &  src2,
JntArrayAcc &  dest 
)
void KDL::Subtract ( const JntArrayAcc &  src1,
const JntArray &  src2,
JntArrayAcc &  dest 
)
void KDL::Subtract ( const JntArray &  src1,
const JntArray &  src2,
JntArray &  dest 
)

Function to subtract two joint arrays, all the arguments must have the same size: A - B = C. This function is aliasing-safe, A or B can be the same array as C.

Parameters:
src1A
src2B
destC

Definition at line 105 of file jntarray.cpp.

References assert, and i.

Referenced by Divide(), and Subtract().

template<typename MatrixA , typename MatrixUV , typename VectorS >
int KDL::svd_eigen_HH ( const Eigen::MatrixBase< MatrixA > &  A,
Eigen::MatrixBase< MatrixUV > &  U,
Eigen::MatrixBase< VectorS > &  S,
Eigen::MatrixBase< MatrixUV > &  V,
Eigen::MatrixBase< VectorS > &  tmp,
int  maxiter = 150 
)

svd calculation of boost ublas matrices

Parameters:
Amatrix<double>(mxn)
Umatrix<double>(mxn)
Svector<double> n
Vmatrix<double>(nxn)
tmpvector<double> n
maxiterdefaults to 150
Returns:
-2 if maxiter exceeded, 0 otherwise

Definition at line 68 of file svd_eigen_HH.hpp.

References e_scalar, fabs(), g, i, PYTHAG(), SIGN(), and sqrt().

Referenced by iTaSC::ConstraintSet::closeLoop(), iTaSC::WSDLSSolver::solve(), iTaSC::WDLSSolver::solve(), and iTaSC::Scene::update().

double KDL::tan ( double  a) [inline]

Definition at line 98 of file utility.h.

References tan().

template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::tan ( const Rall1d< T, V, S > &  arg)
template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::tan ( const Rall2d< T, V, S > &  arg)
double KDL::tanh ( double  a) [inline]

Definition at line 119 of file utility.h.

References tanh().

template<class T , class V , class S >
INLINE Rall2d<T,V,S> KDL::tanh ( const Rall2d< T, V, S > &  arg)
template<class T , class V , class S >
INLINE Rall1d<T,V,S> KDL::tanh ( const Rall1d< T, V, S > &  arg)

Definition at line 424 of file rall1d.h.

References cosh(), KDL::Rall1d< T, V, S >::grad, sqr(), KDL::Rall1d< T, V, S >::t, and T.

Referenced by tanh().

char KDL::Upper ( char  ch) [inline]

Definition at line 144 of file utility_io.cpp.

Referenced by Eat().


Variable Documentation

const double KDL::deg2rad = 0.01745329251994329576923690768488

the value pi/180

Definition at line 20 of file utility.cpp.

Referenced by operator>>().

double KDL::epsilon = 0.000001
double KDL::epsilon2 = 0.000001*0.000001

power or 2 of epsilon

Definition at line 23 of file utility.cpp.

Referenced by cloth_collision_response_static(), and iTaSC::Armature::updateJoint().

Definition at line 32 of file error_stack.cpp.

Referenced by IOTrace(), IOTraceOutput(), IOTracePop(), and IOTracePopStr().

maximal length of a file name

Definition at line 18 of file utility.cpp.

const double KDL::PI = 3.1415926535897932384626433832795
const double KDL::rad2deg = 57.2957795130823208767981548141052

the value 180/pi

Definition at line 21 of file utility.cpp.

Referenced by operator<<().

int KDL::STREAMBUFFERSIZE = 10000

/note linkage Something fishy about the difference between C++ and C in C++ const values default to INTERNAL linkage, in C they default to EXTERNAL linkage. Here the constants should have EXTERNAL linkage because they, for at least some of them, can be changed by the user. If you want to explicitly declare internal linkage, use "static".

Definition at line 17 of file utility.cpp.

the number of derivatives used in the RN-... objects.