File tree Expand file tree Collapse file tree 1 file changed +16
-1
lines changed Expand file tree Collapse file tree 1 file changed +16
-1
lines changed Original file line number Diff line number Diff 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+
188202BOOST_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}
You can’t perform that action at this time.
0 commit comments