Fully implemented grasping skill and finding object one