Tensegrity Robot Proprioceptive State Estimation With Geometric Constraints