Enhanced 6D Pose Estimation for Robotic Fruit Picking