00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041
00042
00043
00044
00045
00046
00047
00048
00049
00050
00051
00052
00053
00054
00055
00056
00057
00058
00059
00061
00062 #ifndef FKPosition_hpp
00063 #define FKPosition_hpp
00064
00065 #include "Math/Matrix.h"
00066 #include "Math/Vector.h"
00067 #include "Math/HandPose.h"
00068 #include "Math/Xform.h"
00069 #include "ForwardKinematics/FKErrors.h"
00070 #include "ForwardKinematics/Kinematics.h"
00071 #include "ForwardKinematics/FKPositionBase.h"
00072
00073
00075 namespace OSCAR {
00076
00089 class FKPosition : public Kinematics, public FKPositionBase
00090 {
00091 public:
00092
00108 FKPosition(const String& DHfilename, OSCARError& err = DUMMY_ERROR(noError), const String& name = String(" "));
00109
00110
00124 FKPosition(const DHData& dhParams, OSCARError& err = DUMMY_ERROR(noError), const String& name = String(" "));
00125
00126
00134 FKPosition(const FKPosition& fkp);
00135
00136
00144 FKPosition& operator=(const FKPosition& fkp);
00145
00159 const Xform* GetHandPose(const Vector& jointVector);
00160
00161
00169 const Xform* GetLocalTransformation(unsigned int jointNo) const;
00170
00171
00181 const Xform* GetLocalTransformation(unsigned int jointNo, const Vector& jointVector);
00182
00183
00193 const Xform* GetGlobalTransformation(unsigned int jointNo) const;
00194
00206 const Xform* GetGlobalTransformation(unsigned int jointNo, const Vector& jointVector);
00207
00215 const Xform* GetAllLocalTransformations() const;
00216
00224 const Xform* GetAllLocalTransformations(const Vector& jointVector);
00225
00226
00235 const Xform* GetAllGlobalTransformations() const;
00236
00237
00246 const Xform* GetAllGlobalTransformations(const Vector& jointVector);
00247
00248
00249
00250 virtual ~FKPosition();
00251 protected:
00252 double *cosalpha, *sinalpha;
00253 double *costheta, *sintheta;
00254 Xform *localTransformations;
00255 Xform *linkToBase;
00256
00257 virtual void calculateTransformations(const Vector& input_vector);
00258 virtual void calculateLinkTransformation(int joint_no, double joint_value);
00259 virtual void calculateLinkToBaseTransformations(const Vector& input_vector);
00260 void makeToolPointAdjustment(void);
00261 void makeRobotPoseAdjustment(void);
00262 void initialize(void);
00263
00264 };
00265
00266 #include "ForwardKinematics/FKPosition.ipp"
00267
00268 }
00269 #endif // FKPosition_hpp