Skip to content

Commit

Permalink
updated HumanIKTest
Browse files Browse the repository at this point in the history
  • Loading branch information
davidegorbani committed Dec 11, 2023
1 parent 141b569 commit ebfa0e0
Showing 1 changed file with 6 additions and 6 deletions.
12 changes: 6 additions & 6 deletions src/IK/tests/HumanIKTest.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -53,12 +53,12 @@ TEST_CASE("InverseKinematic test")

ik.initialize(handler, kinDyn);

ik.setDt(0.1);
ik.setInitialJointPositions(qInitial);
ik.setLink1OrientationAndAngVel(orientationDesired, angVelDesired);
ik.advance();
ik.getJointPositions(JointPositions);
ik.getJointVelocities(JointVelocities);
REQUIRE(ik.setDt(0.1));
REQUIRE(ik.setInitialJointPositions(qInitial));
REQUIRE(ik.setLink1OrientationAndAngVel(orientationDesired, angVelDesired));
REQUIRE(ik.advance());
REQUIRE(ik.getJointPositions(JointPositions));
REQUIRE(ik.getJointVelocities(JointVelocities));
std::cout << "JointPositions = " << JointPositions.transpose() << std::endl;
std::cout << "JointVelocities = " << JointVelocities.transpose() << std::endl;
}

0 comments on commit ebfa0e0

Please sign in to comment.