Energy based modeling, control and reconstruction of soft continuum arm