add the tangentialDirectionDisplacement method to compute the tangential displacement, used in the complementarity static constraint
Merge branch 'robust_hand_grab' of https://github.com/hongkai-dai/drake into robust_hand_grab