I. Introduction
Robots performing tasks in poor visibility environments, such as sewers or the human body in the case of minimal invasive surgeries, have to rely on information other than cameras. Soft continuum robots equipped with a position and force sensor, operating in an unknown environment, motivate this paper.