Skip to content

Commit 765065f

Browse files
author
earlaud
committed
Minor fix in contact tests
1 parent 9d552e2 commit 765065f

File tree

1 file changed

+16
-1
lines changed

1 file changed

+16
-1
lines changed

tests/inverse_dynamics.cpp

Lines changed: 16 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -185,6 +185,20 @@ BOOST_AUTO_TEST_CASE(KinodynamicsID_contactPoint_cost)
185185
test_contact(simu);
186186
}
187187

188+
BOOST_AUTO_TEST_CASE(KinodynamicsID_contactQuad_cost)
189+
{
190+
TestKinoID simu(
191+
getTalosModelHandler(), KinodynamicsID::Settings()
192+
.set_kp_base(1.0)
193+
.set_kp_posture(1.)
194+
.set_kp_contact(10.0)
195+
.set_w_base(1.)
196+
.set_w_posture(0.05)
197+
.set_w_contact_motion(10.0)
198+
.set_w_contact_force(1.0));
199+
test_contact(simu);
200+
}
201+
188202
BOOST_AUTO_TEST_CASE(KinodynamicsID_contactPoint_equality)
189203
{
190204
TestKinoID simu(
@@ -207,8 +221,9 @@ BOOST_AUTO_TEST_CASE(KinodynamicsID_contactQuad_equality)
207221
.set_kp_posture(1.)
208222
.set_kp_contact(10.0)
209223
.set_w_base(1.)
210-
.set_w_posture(0.1)
224+
.set_w_posture(0.05)
211225
.set_w_contact_motion(10.0)
226+
.set_w_contact_force(1.0)
212227
.set_contact_motion_equality(true));
213228
test_contact(simu);
214229
}

0 commit comments

Comments
 (0)