Skip to content

Error in test_state when checking with free-flyer.

I added the following test in test_state to check for the cases where there is a freeflyer in the state.

`class StatePinocchioFFTest(StateTestCase):

from crocoddyl import loadTalosLegs

rmodel = loadTalosLegs().model

StateTestCase.NX = rmodel.nq + rmodel.nv

StateTestCase.STATE = StatePinocchio(rmodel) `

I get errors.

I'm investigating why this happens.

====================================================================== FAIL: test_velocity_from_Jintegrate_Jdiff (main.StatePinocchioFFTest)

Traceback (most recent call last): File "/home/rbudhira/devel/src/loco3d/crocoddyl/unittest/test_state.py", line 126, in test_velocity_from_Jintegrate_Jdiff "Velocity computed from Jdiff is wrong.") AssertionError: Velocity computed from Jdiff is wrong.

====================================================================== FAIL: test_integrate_against_difference (main.StatePinocchioTest)

Traceback (most recent call last): File "/home/rbudhira/devel/src/loco3d/crocoddyl/unittest/test_state.py", line 36, in test_integrate_against_difference "Integrate function doesn't agree with difference rule.") AssertionError: Integrate function doesn't agree with difference rule.

====================================================================== FAIL: test_velocity_from_Jintegrate_Jdiff (main.StatePinocchioTest)

Traceback (most recent call last): File "/home/rbudhira/devel/src/loco3d/crocoddyl/unittest/test_state.py", line 126, in test_velocity_from_Jintegrate_Jdiff "Velocity computed from Jdiff is wrong.") AssertionError: Velocity computed from Jdiff is wrong.

====================================================================== FAIL: test_velocity_from_Jintegrate_Jdiff (main.StateTestCase)

Traceback (most recent call last): File "/home/rbudhira/devel/src/loco3d/crocoddyl/unittest/test_state.py", line 126, in test_velocity_from_Jintegrate_Jdiff "Velocity computed from Jdiff is wrong.") AssertionError: Velocity computed from Jdiff is wrong.

====================================================================== FAIL: test_integrate_against_difference (main.StateUnicycleTest)

Traceback (most recent call last): File "/home/rbudhira/devel/src/loco3d/crocoddyl/unittest/test_state.py", line 36, in test_integrate_against_difference "Integrate function doesn't agree with difference rule.") AssertionError: Integrate function doesn't agree with difference rule.

====================================================================== FAIL: test_velocity_from_Jintegrate_Jdiff (main.StateUnicycleTest)

Traceback (most recent call last): File "/home/rbudhira/devel/src/loco3d/crocoddyl/unittest/test_state.py", line 126, in test_velocity_from_Jintegrate_Jdiff "Velocity computed from Jdiff is wrong.") AssertionError: Velocity computed from Jdiff is wrong.

====================================================================== FAIL: test_integrate_against_difference (main.StateVectorTest)

Traceback (most recent call last): File "/home/rbudhira/devel/src/loco3d/crocoddyl/unittest/test_state.py", line 36, in test_integrate_against_difference "Integrate function doesn't agree with difference rule.") AssertionError: Integrate function doesn't agree with difference rule.

====================================================================== FAIL: test_velocity_from_Jintegrate_Jdiff (main.StateVectorTest)

Traceback (most recent call last): File "/home/rbudhira/devel/src/loco3d/crocoddyl/unittest/test_state.py", line 126, in test_velocity_from_Jintegrate_Jdiff "Velocity computed from Jdiff is wrong.") AssertionError: Velocity computed from Jdiff is wrong.