Dynamic Modeling, Robust Control and Contact Estimation of Soft Robotics