Full 3D motion control for programmable bevel-tip steerable needles