Model-aided 3D shape and force estimation of continuum robots based on Cosserat rod theory and using a magnetic localization system