21 Network::setLocalMode(
true);
23 SECTION(
"Checking fakeJointCoupling device")
26 IJointCoupling*
ijc=
nullptr;
29 p_cfg.put(
"device",
"fakeJointCoupling");
84 CHECK(
ijc->convertFromPhysicalJointsToActuatedAxesPos(physJointsPos, actAxesPos));
85 CHECK(actAxesPos[0] == 0.0);
86 CHECK(actAxesPos[1] == 1.0);
87 CHECK(actAxesPos[2] == 5.0);
89 CHECK(
ijc->convertFromPhysicalJointsToActuatedAxesVel(physJointsPos, physJointsVel, actAxesVel));
90 CHECK(actAxesVel[0] == 0.0);
91 CHECK(actAxesVel[1] == 1.0);
92 CHECK(actAxesVel[2] == 10.0);
94 CHECK(
ijc->convertFromPhysicalJointsToActuatedAxesAcc(physJointsPos, physJointsVel, physJointsAcc, actAxesAcc));
95 CHECK(actAxesAcc[0] == 0.0);
96 CHECK(actAxesAcc[1] == 1.0);
97 CHECK(actAxesAcc[2] == 15.0);
99 CHECK_FALSE(
ijc->convertFromPhysicalJointsToActuatedAxesTrq(physJointsPos, physJointsAcc, actAxesAcc));
101 CHECK(
ijc->convertFromActuatedAxesToPhysicalJointsPos(actAxesPos, physJointsPos));
102 CHECK(physJointsPos[0] == 0.0);
103 CHECK(physJointsPos[1] == 1.0);
104 CHECK(physJointsPos[2] == 2.5);
105 CHECK(physJointsPos[3] == 2.5);
107 CHECK(
ijc->convertFromActuatedAxesToPhysicalJointsVel(actAxesPos, actAxesVel, physJointsVel));
108 CHECK(physJointsVel[0] == 0.0);
109 CHECK(physJointsVel[1] == 1.0);
110 CHECK(physJointsVel[2] == -2.5);
111 CHECK(physJointsVel[3] == 7.5);
113 CHECK(
ijc->convertFromActuatedAxesToPhysicalJointsAcc(actAxesPos, actAxesVel, actAxesAcc, physJointsAcc));
114 CHECK(physJointsAcc[0] == 0.0);
115 CHECK(physJointsAcc[1] == 1.0);
116 CHECK(physJointsAcc[2] == -10.0);
117 CHECK(physJointsAcc[3] == 15.0);
119 CHECK_FALSE(
ijc->convertFromActuatedAxesToPhysicalJointsTrq(actAxesPos, actAxesAcc, physJointsAcc));
121 double min{0.0}, max{0.0};
122 CHECK(
ijc->getPhysicalJointLimits(0, min, max));
125 CHECK(
ijc->getPhysicalJointLimits(1, min, max));
128 CHECK(
ijc->getPhysicalJointLimits(2, min, max));
131 CHECK(
ijc->getPhysicalJointLimits(3, min, max));
144 Network::setLocalMode(
false);