Added option to print file in NonlinearProgram
Merge branch 'robust_hand_grab' of ssh://github.com/hongkai-dai/drake into robust_hand_grab