Geometric Constraint Based Modeling and Analysis of a Novel Continuum Robot with SMA Initiated Variable Stiffness