23 #ifndef KDL_FRAMEVEL_H 24 #define KDL_FRAMEVEL_H 26 #include "utilities/utility.h" 27 #include "utilities/rall1d.h" 28 #include "utilities/traits.h" 39 return doubleVel((b.t-a.t)/dt,(b.grad-a.grad)/dt);
43 return doubleVel(a.t+da.t*dt,a.grad+da.grad*dt);
215 M(_T.
M,_t.rot),
p(_T.
p,_t.vel) {}
VectorVel(const Vector &_p)
Definition: framevel.hpp:96
represents rotations in 3 dimensional space.
Definition: frames.hpp:301
TwistVel()
Definition: framevel.hpp:263
FrameVel(const RotationVel &_M, const VectorVel &_p)
Definition: framevel.hpp:217
VectorVel vel
Definition: framevel.hpp:258
VectorVel rot
Definition: framevel.hpp:259
IMETHOD void ReverseSign()
Definition: framevel.hpp:315
static IMETHOD RotationVel RotZ(const doubleVel &angle)
Definition: framevel.hpp:190
TwistVel(const VectorVel &_vel, const VectorVel &_rot)
Definition: framevel.hpp:264
FrameVel()
Definition: framevel.hpp:209
IMETHOD Twist GetTwistDot() const
Definition: framevel.hpp:533
IMETHOD VectorVel operator*(const Vector &arg) const
Definition: framevel.hpp:160
IMETHOD VectorVel & operator+=(const VectorVel &arg)
Definition: framevel.hpp:301
FrameVel(const Frame &_T, const Twist &_t)
Definition: framevel.hpp:214
RotationVel(const Rotation &_R)
Definition: framevel.hpp:150
IMETHOD RotationVel & operator=(const RotationVel &arg)
Definition: framevel.hpp:107
IMETHOD friend VectorVel operator+(const VectorVel &r1, const VectorVel &r2)
Definition: framevel.hpp:211
IMETHOD friend VectorVel operator/(const VectorVel &r1, double r2)
Definition: framevel.hpp:279
IMETHOD Vector diff(const Vector &p_w_a, const Vector &p_w_b, double dt=1)
determines the difference of vector b with vector a.
Definition: frames.hpp:1123
Frame value() const
Definition: framevel.hpp:221
IMETHOD void DoRotZ(const doubleVel &angle)
Definition: framevel.hpp:186
Vector deriv() const
Definition: framevel.hpp:155
Definition: framevel.hpp:253
IMETHOD friend VectorVel operator*(const VectorVel &r1, const VectorVel &r2)
Definition: framevel.hpp:246
IMETHOD friend TwistVel operator/(const TwistVel &lhs, double rhs)
Definition: framevel.hpp:426
IMETHOD FrameVel Inverse() const
Definition: framevel.hpp:66
static IMETHOD FrameVel Identity()
Definition: framevel.hpp:29
RotationVel(const Rotation &_R, const Vector &_w)
Definition: framevel.hpp:151
TwistVel(const Twist &p)
Definition: framevel.hpp:266
IMETHOD void DoRotX(const doubleVel &angle)
Definition: framevel.hpp:170
represents both translational and rotational velocities.
Definition: frames.hpp:720
static IMETHOD VectorVel Zero()
Definition: framevel.hpp:312
Definition: framevel.hpp:84
static IMETHOD RotationVel Rot(const Vector &rotvec, const doubleVel &angle)
Definition: framevel.hpp:195
IMETHOD friend TwistVel operator-(const TwistVel &lhs, const TwistVel &rhs)
Definition: framevel.hpp:455
IMETHOD bool Equal(const FrameAcc &r1, const FrameAcc &r2, double eps=epsilon)
Definition: frameacc.hpp:394
static IMETHOD RotationVel RotY(const doubleVel &angle)
Definition: framevel.hpp:182
Definition: articulatedbodyinertia.cpp:28
VectorVel()
Definition: framevel.hpp:94
Rotation value() const
Definition: framevel.hpp:154
A concrete implementation of a 3 dimensional vector class.
Definition: frames.hpp:160
IMETHOD friend bool Equal(const FrameVel &r1, const FrameVel &r2, double eps)
Definition: framevel.hpp:76
Vector p
Definition: framevel.hpp:91
Rotation R
Definition: framevel.hpp:146
RotationVel M
Definition: framevel.hpp:206
Definition: framevel.hpp:139
IMETHOD VectorVel operator*(const VectorVel &arg) const
Definition: framevel.hpp:155
KDL::doubleVel derivType
Definition: framevel.hpp:60
static IMETHOD TwistVel Zero()
Definition: framevel.hpp:379
IMETHOD friend TwistVel operator+(const TwistVel &lhs, const TwistVel &rhs)
Definition: framevel.hpp:450
IMETHOD void DoRotY(const doubleVel &angle)
Definition: framevel.hpp:178
IMETHOD friend TwistVel operator*(const TwistVel &lhs, double rhs)
Definition: framevel.hpp:416
Twist deriv() const
Definition: framevel.hpp:271
Vector deriv() const
Definition: framevel.hpp:99
IMETHOD friend void SetToZero(TwistVel &v)
Definition: framevel.hpp:466
IMETHOD VectorVel UnitY() const
Definition: framevel.hpp:122
IMETHOD void posrandom(Vector &a)
Definition: frames.hpp:1237
IMETHOD doubleVel Norm() const
Definition: framevel.hpp:319
Vector value() const
Definition: framevel.hpp:98
Vector w
Definition: framevel.hpp:147
IMETHOD FrameVel & operator=(const Frame &arg)
Definition: framevel.hpp:71
static IMETHOD RotationVel Rot2(const Vector &rotvec, const doubleVel &angle)
Definition: framevel.hpp:204
IMETHOD Twist GetTwist() const
Definition: framevel.hpp:529
IMETHOD VectorVel & operator-=(const VectorVel &arg)
Definition: framevel.hpp:306
double valueType
Definition: framevel.hpp:59
IMETHOD friend doubleVel dot(const VectorVel &lhs, const VectorVel &rhs)
Definition: framevel.hpp:358
IMETHOD friend bool Equal(const VectorVel &r1, const VectorVel &r2, double eps)
Definition: framevel.hpp:324
RotationVel()
Definition: framevel.hpp:149
Vector v
Definition: framevel.hpp:92
IMETHOD VectorVel UnitX() const
Definition: framevel.hpp:118
represents a frame transformation in 3D space (rotation + translation)
Definition: frames.hpp:570
IMETHOD TwistVel RefPoint(const VectorVel &v_base_AB)
Definition: framevel.hpp:391
VectorVel p
Definition: framevel.hpp:207
Twist deriv() const
Definition: framevel.hpp:222
IMETHOD friend VectorVel operator-(const VectorVel &r1, const VectorVel &r2)
Definition: framevel.hpp:215
IMETHOD Twist GetTwist() const
Definition: framevel.hpp:90
IMETHOD Vector addDelta(const Vector &p_w_a, const Vector &p_w_da, double dt=1)
adds vector da to vector a.
Definition: frames.hpp:1150
static IMETHOD RotationVel RotX(const doubleVel &angle)
Definition: framevel.hpp:174
IMETHOD friend void SetToZero(VectorVel &v)
Definition: framevel.hpp:240
IMETHOD TwistVel & operator+=(const TwistVel &arg)
Definition: framevel.hpp:408
IMETHOD VectorVel UnitZ() const
Definition: framevel.hpp:126
static IMETHOD RotationVel Identity()
Definition: framevel.hpp:132
Definition: framevel.hpp:197
IMETHOD friend bool Equal(const RotationVel &r1, const RotationVel &r2, double eps)
Definition: framevel.hpp:334
Twist value() const
Definition: framevel.hpp:268
IMETHOD VectorVel operator*(const VectorVel &arg) const
Definition: framevel.hpp:47
IMETHOD void random(Vector &a)
addDelta operator for displacement rotational velocity.
Definition: frames.hpp:1208
IMETHOD friend bool Equal(const TwistVel &a, const TwistVel &b, double eps)
Definition: framevel.hpp:343
IMETHOD void ReverseSign()
Definition: framevel.hpp:385
Rall1d< double > doubleVel
Definition: framevel.hpp:36
IMETHOD TwistVel & operator-=(const TwistVel &arg)
Definition: framevel.hpp:401
IMETHOD RotationVel Inverse() const
Definition: framevel.hpp:136
IMETHOD VectorVel & operator=(const VectorVel &arg)
Definition: framevel.hpp:291
IMETHOD Frame GetFrame() const
Definition: framevel.hpp:86