add method 'normalDirection to RigidBodyContactWrench', change ComplementarityStaticConstraint to use normalDirection method. Previous implementation supposes that the normal direction is FIXED in the WORLD frame
Merge branch 'hongkai/robust_hand_grab'