Modal-based Kinematics and Contact Detection of Soft Robots

Soft robots offer an alternative approach to manipulate within a constrained space while maintaining a safe interaction with the external environment. Owing to its adaptable compliance characteristic, external contact force can easily deform the robot shapes and lead to undesired robot kinematic and dynamic properties. Accurate contact detection and contact location estimation are of critical importance for soft robot modeling, control, trajectory planning, and eventually affect the success of task completion. In this article, we focus on the investigation of a one degree of freedom (1-DoF) soft pneumatic bending robot, which is regarded as one of the fundamental components to construct complex, multi-DoFs soft robots. This 1-DoF soft robot is modeled through the integral representation of the spatial curve, where direct and instantaneous kinematics are calculated explicitly through a modal method. The fixed centrode deviation method is used to detect the external contact and estimate the contact location. Simulation results and experimental studies indicate that the contact location can be accurately estimated by solving a nonlinear least-square optimization problem. Experimental validation shows that the proposed algorithm is able to successfully estimate the contact location with the estimation error of 1.46 mm.