6
6
* BSD-3-Clause license. See the accompanying LICENSE file for details.
7
7
*/
8
8
9
- #include " HandMk5CouplingHandler .h"
9
+ #include " CouplingXCubHandMk5 .h"
10
10
#include < yarp/os/LogStream.h>
11
11
#include < yarp/os/LogComponent.h>
12
12
#include < cmath>
15
15
YARP_DECLARE_LOG_COMPONENT (HANDMK5COUPLINGHANDLER)
16
16
17
17
18
- double HandMk5CouplingHandler ::evaluateCoupledJoint(const double & q1, const std::string& finger_name)
18
+ double CouplingXCubHandMk5 ::evaluateCoupledJoint(const double & q1, const std::string& finger_name)
19
19
{
20
20
/* *
21
21
* Coupling law taken from from https://icub-tech-iit.github.io/documentation/hands/hands_mk5_coupling
@@ -43,7 +43,7 @@ double HandMk5CouplingHandler::evaluateCoupledJoint(const double& q1, const std:
43
43
}
44
44
45
45
46
- double HandMk5CouplingHandler ::evaluateCoupledJointJacobian (const double & q1, const std::string& finger_name)
46
+ double CouplingXCubHandMk5 ::evaluateCoupledJointJacobian (const double & q1, const std::string& finger_name)
47
47
{
48
48
/* *
49
49
* Coupling law jacobian taken from from https://icub-tech-iit.github.io/documentation/hands/hands_mk5_coupling
@@ -72,14 +72,14 @@ double HandMk5CouplingHandler::evaluateCoupledJointJacobian(const double& q1, co
72
72
}
73
73
74
74
75
- HandMk5CouplingHandler::HandMk5CouplingHandler ()
75
+ CouplingXCubHandMk5::CouplingXCubHandMk5 ()
76
76
{
77
77
m_couplingSize = 12 ;
78
78
}
79
79
80
80
81
81
82
- bool HandMk5CouplingHandler ::parseFingerParameters (yarp::os::Searchable& config)
82
+ bool CouplingXCubHandMk5 ::parseFingerParameters (yarp::os::Searchable& config)
83
83
{
84
84
85
85
yarp::os::Bottle& hand_params = config.findGroup (" COUPLING_PARAMS" );
@@ -119,7 +119,7 @@ bool HandMk5CouplingHandler::parseFingerParameters(yarp::os::Searchable& config)
119
119
return true ;
120
120
}
121
121
122
- bool HandMk5CouplingHandler ::parseCouplingParameters (yarp::os::Searchable& config) {
122
+ bool CouplingXCubHandMk5 ::parseCouplingParameters (yarp::os::Searchable& config) {
123
123
yarp::sig::VectorOf<size_t > coupled_physical_joints{0 , 1 , 2 , 3 , 4 , 5 , 6 , 7 , 8 , 9 , 10 , 11 };
124
124
yarp::sig::VectorOf<size_t > coupled_actuated_axes{0 , 1 , 2 , 3 , 4 , 5 };
125
125
std::vector<std::string> physical_joint_names;
@@ -197,7 +197,7 @@ bool HandMk5CouplingHandler::parseCouplingParameters(yarp::os::Searchable& confi
197
197
return true ;
198
198
}
199
199
200
- bool HandMk5CouplingHandler ::open (yarp::os::Searchable& config) {
200
+ bool CouplingXCubHandMk5 ::open (yarp::os::Searchable& config) {
201
201
202
202
// TODO INVOKE ImplementCoupling::initialise()
203
203
bool ok = parseFingerParameters (config);
@@ -215,7 +215,7 @@ bool HandMk5CouplingHandler::open(yarp::os::Searchable& config) {
215
215
return ok;
216
216
}
217
217
218
- bool HandMk5CouplingHandler ::convertFromPhysicalJointsToActuatedAxesPos (const yarp::sig::Vector& physJointsPos, yarp::sig::Vector& actAxesPos) {
218
+ bool CouplingXCubHandMk5 ::convertFromPhysicalJointsToActuatedAxesPos (const yarp::sig::Vector& physJointsPos, yarp::sig::Vector& actAxesPos) {
219
219
size_t nrOfPhysicalJoints;
220
220
size_t nrOfActuatedAxes;
221
221
auto ok = getNrOfPhysicalJoints (nrOfPhysicalJoints);
@@ -244,7 +244,7 @@ bool HandMk5CouplingHandler::convertFromPhysicalJointsToActuatedAxesPos(const ya
244
244
return true ;
245
245
}
246
246
247
- bool HandMk5CouplingHandler ::convertFromPhysicalJointsToActuatedAxesVel (const yarp::sig::Vector& physJointsPos, const yarp::sig::Vector& physJointsVel, yarp::sig::Vector& actAxesVel) {
247
+ bool CouplingXCubHandMk5 ::convertFromPhysicalJointsToActuatedAxesVel (const yarp::sig::Vector& physJointsPos, const yarp::sig::Vector& physJointsVel, yarp::sig::Vector& actAxesVel) {
248
248
size_t nrOfPhysicalJoints;
249
249
size_t nrOfActuatedAxes;
250
250
auto ok = getNrOfPhysicalJoints (nrOfPhysicalJoints);
@@ -273,16 +273,16 @@ bool HandMk5CouplingHandler::convertFromPhysicalJointsToActuatedAxesVel(const ya
273
273
}
274
274
275
275
276
- bool HandMk5CouplingHandler ::convertFromPhysicalJointsToActuatedAxesAcc (const yarp::sig::Vector& physJointsPos, const yarp::sig::Vector& physJointsVel, const yarp::sig::Vector& physJointsAcc, yarp::sig::Vector& actAxesAcc) {
276
+ bool CouplingXCubHandMk5 ::convertFromPhysicalJointsToActuatedAxesAcc (const yarp::sig::Vector& physJointsPos, const yarp::sig::Vector& physJointsVel, const yarp::sig::Vector& physJointsAcc, yarp::sig::Vector& actAxesAcc) {
277
277
return false ;
278
278
}
279
279
280
- bool HandMk5CouplingHandler ::convertFromPhysicalJointsToActuatedAxesTrq (const yarp::sig::Vector& physJointsPos, const yarp::sig::Vector& physJointsTrq, yarp::sig::Vector& actAxesTrq) {
280
+ bool CouplingXCubHandMk5 ::convertFromPhysicalJointsToActuatedAxesTrq (const yarp::sig::Vector& physJointsPos, const yarp::sig::Vector& physJointsTrq, yarp::sig::Vector& actAxesTrq) {
281
281
return false ;
282
282
}
283
283
284
284
285
- bool HandMk5CouplingHandler ::convertFromActuatedAxesToPhysicalJointsPos (const yarp::sig::Vector& actAxesPos, yarp::sig::Vector& physJointsPos) {
285
+ bool CouplingXCubHandMk5 ::convertFromActuatedAxesToPhysicalJointsPos (const yarp::sig::Vector& actAxesPos, yarp::sig::Vector& physJointsPos) {
286
286
size_t nrOfPhysicalJoints;
287
287
size_t nrOfActuatedAxes;
288
288
auto ok = getNrOfPhysicalJoints (nrOfPhysicalJoints);
@@ -319,7 +319,7 @@ bool HandMk5CouplingHandler::convertFromActuatedAxesToPhysicalJointsPos(const ya
319
319
}
320
320
321
321
322
- bool HandMk5CouplingHandler ::convertFromActuatedAxesToPhysicalJointsVel (const yarp::sig::Vector& actAxesPos, const yarp::sig::Vector& actAxesVel, yarp::sig::Vector& physJointsVel) {
322
+ bool CouplingXCubHandMk5 ::convertFromActuatedAxesToPhysicalJointsVel (const yarp::sig::Vector& actAxesPos, const yarp::sig::Vector& actAxesVel, yarp::sig::Vector& physJointsVel) {
323
323
size_t nrOfPhysicalJoints;
324
324
size_t nrOfActuatedAxes;
325
325
auto ok = getNrOfPhysicalJoints (nrOfPhysicalJoints);
@@ -372,9 +372,9 @@ bool HandMk5CouplingHandler::convertFromActuatedAxesToPhysicalJointsVel(const ya
372
372
return true ;
373
373
}
374
374
375
- bool HandMk5CouplingHandler ::convertFromActuatedAxesToPhysicalJointsAcc (const yarp::sig::Vector& actAxesPos, const yarp::sig::Vector& actAxesVel, const yarp::sig::Vector& actAxesAcc, yarp::sig::Vector& physJointsAcc) {
375
+ bool CouplingXCubHandMk5 ::convertFromActuatedAxesToPhysicalJointsAcc (const yarp::sig::Vector& actAxesPos, const yarp::sig::Vector& actAxesVel, const yarp::sig::Vector& actAxesAcc, yarp::sig::Vector& physJointsAcc) {
376
376
return false ;
377
377
}
378
- bool HandMk5CouplingHandler ::convertFromActuatedAxesToPhysicalJointsTrq (const yarp::sig::Vector& actAxesPos, const yarp::sig::Vector& actAxesTrq, yarp::sig::Vector& physJointsTrq) {
378
+ bool CouplingXCubHandMk5 ::convertFromActuatedAxesToPhysicalJointsTrq (const yarp::sig::Vector& actAxesPos, const yarp::sig::Vector& actAxesTrq, yarp::sig::Vector& physJointsTrq) {
379
379
return false ;
380
380
}
0 commit comments