Fix BeliefDynamicsConstraint.