-Appending sample name to the decision variable names
-Fixing the offset of the hqv_inds for different samples
Merge branch 'robust_hand_grab' of https://github.com/hongkai-dai/drake into robust_hand_grab