A Differentiable Extended Kalman Filter for Object Tracking Under Sliding Regime

Tactile sensing represents a valuable source of information in robotics for perception of the state of objects and their properties. Modern soft tactile sensors allow perceiving orthogonal forces and, in some cases, relative motions along the surface of the object. Detecting and measuring this kind of lateral motion is fundamental to react to possibly uncontrolled slipping and sliding of the object being manipulated. Object slip detection and prediction have been extensively studied in the robotic community leading to solutions with good accuracy and suitable for closed-loop grip stabilization. However, algorithms for object perception, such as in-hand object pose estimation and tracking algorithms, often assume no relative motion between the object and the hand and rarely consider the problem of tracking the pose of the object subjected to slipping and sliding motions. In this work, we propose a differentiable Extended Kalman filter that can be trained to track the position and the velocity of an object under translational sliding regime from tactile observations alone. Experiments with several objects, carried out on the iCub humanoid robot platform, show that the proposed approach allows achieving an average position tracking error in the order of 0.6 cm, and that the provided estimate of the object state can be used to take control decisions using tactile feedback alone. A video of the experiments is available as Supplementary Material.

[1]  Kostas E. Bekris,et al.  Robust, Occlusion-aware Pose Estimation for Objects Grasped by Adaptive Hands , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[2]  Shigeki Sugano,et al.  A modular, distributed, soft, 3-axis sensor system for robot hands , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[3]  Edward H. Adelson,et al.  GelSight: High-Resolution Robot Tactile Sensors for Estimating Geometry and Force , 2017, Sensors.

[4]  Elliott Donlon,et al.  Maintaining Grasps within Slipping Bounds by Monitoring Incipient Slip , 2018, 2019 International Conference on Robotics and Automation (ICRA).

[5]  Francisco José Madrid-Cuevas,et al.  Automatic generation and detection of highly reliable fiducial markers under occlusion , 2014, Pattern Recognit..

[6]  Hujun Bao,et al.  PVNet: Pixel-Wise Voting Network for 6DoF Pose Estimation , 2018, 2019 IEEE/CVF Conference on Computer Vision and Pattern Recognition (CVPR).

[7]  Dieter Fox,et al.  Deep Object Pose Estimation for Semantic Robotic Grasping of Household Objects , 2018, CoRL.

[8]  Jianhua Li,et al.  GelSlim: A High-Resolution, Compact, Robust, and Calibrated Tactile-sensing Finger , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[9]  Mike Lambeta,et al.  DIGIT: A Novel Design for a Low-Cost Compact High-Resolution Tactile Sensor With Application to In-Hand Manipulation , 2020, IEEE Robotics and Automation Letters.

[10]  Helge J. Ritter,et al.  Distinguishing sliding from slipping during object pushing , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[11]  Dieter Fox,et al.  PoseCNN: A Convolutional Neural Network for 6D Object Pose Estimation in Cluttered Scenes , 2017, Robotics: Science and Systems.

[12]  Siddhartha S. Srinivasa,et al.  Pose estimation for planar contact manipulation with manifold particle filters , 2015, Int. J. Robotics Res..

[13]  Michelle A. Lee,et al.  Multimodal Sensor Fusion with Differentiable Filters , 2020, 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[14]  Sergey Levine,et al.  Backprop KF: Learning Discriminative Deterministic State Estimators , 2016, NIPS.

[15]  Jeannette Bohg,et al.  How to train your differentiable filter , 2020, Autonomous Robots.

[16]  R. E. Kalman,et al.  A New Approach to Linear Filtering and Prediction Problems , 2002 .

[17]  Kaspar Althoefer,et al.  Global estimation of an object’s pose using tactile sensing , 2015, Adv. Robotics.

[18]  Gerald E. Loeb,et al.  Multimodal Tactile Sensor , 2014, The Human Hand as an Inspiration for Robot Hand Development.

[19]  Byron Boots,et al.  Robust Learning of Tactile Force Estimation through Robot Interaction , 2018, 2019 International Conference on Robotics and Automation (ICRA).

[20]  Maria Bauza,et al.  Tactile Object Pose Estimation from the First Touch with Geometric Contact Rendering , 2020, CoRL.

[21]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[22]  Shigeki Sugano,et al.  Magnetic 3-axis Soft and Sensitive Fingertip Sensors Integration for the iCub Humanoid Robot , 2019, 2019 IEEE-RAS 19th International Conference on Humanoid Robots (Humanoids).

[23]  Michael Kaess,et al.  Learning Tactile Models for Factor Graph-based State Estimation , 2020, ArXiv.

[24]  Natalia Gimelshein,et al.  PyTorch: An Imperative Style, High-Performance Deep Learning Library , 2019, NeurIPS.

[25]  Giorgio Battistelli,et al.  Memory Unscented Particle Filter for 6-DOF Tactile Localization , 2017, IEEE Transactions on Robotics.

[26]  Kuan-Ting Yu,et al.  Realtime State Estimation with Tactile and Visual Sensing for Inserting a Suction-held Object , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[27]  Jiri Matas,et al.  EPOS: Estimating 6D Pose of Objects With Symmetries , 2020, 2020 IEEE/CVF Conference on Computer Vision and Pattern Recognition (CVPR).

[28]  Giulio Sandini,et al.  The iCub humanoid robot: An open-systems platform for research in cognitive development , 2010, Neural Networks.

[29]  Giorgio Metta,et al.  Hierarchical grasp controller using tactile feedback , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[30]  Kuan-Ting Yu,et al.  Realtime State Estimation with Tactile and Visual Sensing. Application to Planar Manipulation , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[31]  Kuan-Ting Yu,et al.  Tactile SLAM: Real-time inference of shape and pose from planar pushing , 2020, 2021 IEEE International Conference on Robotics and Automation (ICRA).

[32]  Jan Peters,et al.  Grip Stabilization of Novel Objects Using Slip Prediction , 2018, IEEE Transactions on Haptics.

[33]  Giorgio Metta,et al.  YARP: Yet Another Robot Platform , 2006 .