Shape and contact force estimation of continuum manipulators using pseudo rigid body models