Tensegrity Robot Proprioceptive State Estimation with Geometric Constraints