2016-08-30 21:44:11 +00:00
|
|
|
#ifndef IK_TRAJECTORY_HELPER_H
|
|
|
|
#define IK_TRAJECTORY_HELPER_H
|
|
|
|
|
|
|
|
enum IK2_Method
|
|
|
|
{
|
|
|
|
IK2_JACOB_TRANS=0,
|
|
|
|
IK2_PURE_PSEUDO,
|
|
|
|
IK2_DLS,
|
|
|
|
IK2_SDLS ,
|
2016-09-20 00:04:05 +00:00
|
|
|
IK2_DLS_SVD,
|
2016-09-22 20:27:09 +00:00
|
|
|
IK2_VEL_DLS,
|
|
|
|
IK2_VEL_DLS_WITH_ORIENTATION,
|
2016-08-30 21:44:11 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
class IKTrajectoryHelper
|
|
|
|
{
|
|
|
|
struct IKTrajectoryHelperInternalData* m_data;
|
|
|
|
|
|
|
|
public:
|
|
|
|
IKTrajectoryHelper();
|
|
|
|
virtual ~IKTrajectoryHelper();
|
|
|
|
|
2016-09-22 20:27:09 +00:00
|
|
|
|
2016-08-30 21:44:11 +00:00
|
|
|
bool computeIK(const double endEffectorTargetPosition[3],
|
2016-09-20 00:04:05 +00:00
|
|
|
const double endEffectorTargetOrientation[4],
|
2016-09-11 01:48:57 +00:00
|
|
|
const double endEffectorWorldPosition[3],
|
2016-09-20 00:04:05 +00:00
|
|
|
const double endEffectorWorldOrientation[4],
|
2016-09-22 20:27:09 +00:00
|
|
|
const double* q_old, int numQ,int endEffectorIndex,
|
2016-09-23 02:48:26 +00:00
|
|
|
double* q_new, int ikMethod, const double* linear_jacobian, const double* angular_jacobian, int jacobian_size, double dampIk=1.);
|
2016-08-30 21:44:11 +00:00
|
|
|
|
|
|
|
};
|
|
|
|
#endif //IK_TRAJECTORY_HELPER_H
|