close with goToGripperPose1. Need to work on quarternion aspect