A surgical system includes a flexible steerable needle and a shape sensor for measuring the shape of the needle. The surgical system can be manual (e.g., laparoscopic), robotic, or any combination of the two. By directly measuring the shape of the needle, complex and potentially inaccurate modeling of the needle to determine trajectory and insertion depth can be avoided in favor of much more robust direct measurement and modeling of needle shape and/or pose.