Thanks Diego for catching the bug in WorldPointEvaluator!
This PR fix a bug in the rotation matrix creation from ground normal direction in WorldPointEvaluator. Another bug related to ground incline was found in CassieFixedPointSolver during testing.
New changes were tested and visualized in cassie sim.
Thanks Diego for catching the bug in
WorldPointEvaluator
!This PR fix a bug in the rotation matrix creation from ground normal direction in
WorldPointEvaluator
. Another bug related to ground incline was found inCassieFixedPointSolver
during testing.New changes were tested and visualized in cassie sim.
This change is