add the test for GraspFrictionConeWrench. The test for old GraspWrench is broken