Sid's changes for checking collision with gripper