Force Control of a Haptic Flexible-Link Antenna Based on a Lumped-Mass Model

Haptic organs are common in nature and help animals to navigate environments where vision is not possible. Insects often use slender, lightweight, and flexible links as sensing antennae. These antennae have a muscle-endowed base that changes their orientation and an organ that senses the applied force and moment, enabling active sensing. Sensing antennae detect obstacles through contact during motion and even recognize objects. They can also push obstacles. In all these tasks, force control of the antenna is crucial. The objective of our research is to develop a haptic robotic system based on a sensing antenna, consisting of a very lightweight and slender flexible rod. In this context, the work presented here focuses on the force control of this device. To achieve this, (a) we develop a dynamic model of the antenna that moves under gravity and maintains point contact with an object, based on lumped-mass discretization of the rod; (b) we prove the robust stability property of the closed-loop system using the Routh stability criterion; and (c) based on this property, we design a robust force control system that performs efficiently regardless of the contact point with the object. We built a mechanical device replicating this sensing organ. It is a flexible link connected at one end to a 3D force-torque sensor, which is attached to a mechanical structure with two DC motors, providing azimuthal and elevation movements to the antenna. Our experiments in contact situations demonstrate the effectiveness of our control method.