Commit 82b00950 authored by Pierre Fernbach's avatar Pierre Fernbach

[Tests] correctly test if the given normal is reached for 3D contacts

parent bcfad6ea
......@@ -49,6 +49,8 @@ class TestRBPRMstate3D(unittest.TestCase):
self.assertTrue(state.isLimbInContact(fullbody.rArmId))
self.assertTrue(state.isLimbInContact(fullbody.lArmId))
self.assertTrue(state2.isBalanced())
p_real, n_real = state2.getCenterOfContactForLimb(fullbody.rLegId)
self.assertEqual(n, n_real)
process.kill()
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment