Orientation to Pose: Continuum Robots Shape Sensing Based on Piecewise Polynomial Curvature Model.