Soft Robot Shape Estimation With IMUs Leveraging PCC Kinematics for Drift Filtering

The control possibilities for soft robots have long been hindered by the need for reliable methods to estimate their configuration. Inertial measurement units (IMUs) can solve this challenge, but they are affected by well-known drift issues. This letter proposes a method to eliminate this limitation by leveraging the Piecewise Constant Curvature model assumption. We validate the reconstruction capabilities of the algorithm in simulation and experimentally. To this end, we also present a novel large-scale, foam-based manipulator with embedded IMU sensors. Using the filter, we bring the accuracy in IMU-based reconstruction algorithms to 93% of the soft robot's length and enable substantially longer measurements than the baseline. We also show that the proposed technique generates reliable estimations for closed-loop control of the robot's shape.