SYSTEMS AND METHODS FOR SAFE COMPLIANT INSERTION AND HYBRID FORCE/MOTION TELEMANIPULATION OF CONTINUUM ROBOTS

摘要

Methods and systems are described for controlling movement of a continuum robot that includes a plurality of independently controlled segments along the length of the continuum robot. The continuum robot is inserted into a cavity of unknown dimensions or shape. A plurality of forces acting upon the continuum robot by the surrounding cavity are estimated. A positioning command indicating a desired movement of the distal end of the continuum robot is received from a manipulator control. The desired movement is augmented based, at least in part, on the estimated plurality of forces acting on the continuum robot such that movement is restricted to within safe boundaries of the surrounding cavity. The positioning of the continuum robot is then adjusted based on the augmented desired movement.