Visual shape and pose recovery for robotic manipulation