Learning-Enhanced Observer for Sensorless Task-Null-Space Compliant Control
Authors: Nuo Chen, Ya-Jun Pan, Onur Toker
Organizations: Advanced Control and Mechatronics Lab, Department of Mechanical Engineering, Dalhousie University, Halifax, B3H 4R2, Canada · Department of Computer Engineering, Florida Polytechnic University, Lakeland, FL 33805, United States
This paper presents a novel framework integrating a robust wrench observer with a hybrid pose and force controller for physical Human-Robot Interaction (pHRI). In pHRI tasks, robots are expected to perform task-space motions robustly while remaining compliance with human disturbance, which proposes distinct control objectives. Most existing approaches focus mainly on either robustness or compliance and rely on force sensors for real-time tracking. To address these limitations, we propose a novel framework with the following key contributions. Firstly, a neural network (NN) is trained to improve the observer performance by compensating for system friction and unmodeled dynamics. Secondly, a task-null-space decomposition is applied to separate the joint velocity and reduce the effect of the human disturbance on the observer. Finally, a hybrid pose and force controller is introduced to achieve the end-effector pose and force tracking. Experimental results demonstrate that the proposed framework provides robust and accurate wrench estimation while maintaining reliable pose and force tracking performance. The proposed approach offers an effective solution and framework for pHRI without the need of force/torque sensor measurements which can be applied to many robotic manipulator platforms which do not have force/torque sensors.
Figures & tables
Fig. 1: Overview of the proposed framework. The observer estimates the end-effector force using a momentum observer and NN compensation. A task-null-space decomposition separates the joint velocity q˙ into the task-space velocity q˙t and null-space velocity q˙n . The task-space velocity q˙t is sent to the NN to reduce the effect of human disturbance on force estimation, while q˙n is used for null-space compliant control. The proposed hybrid pose and force controller provides reliable position, orientation, and force tracking while maintaining compliance in the null-space.
Fig. 2: Hardware Setup: (a) A 7-DOF Franka Emika robotic manipulator in the Advanced Control and Mechatronics Laboratory, Dalhousie University. (b) An end-effector installed with force sensor for data collection and validation.
Fig. 3: Conventional momentum observer sim-to-real gap. (a) Test in Gazebo. (b) Test in real world. (c) Observer output difference between the simulation and real world.
Fig. 4: Comparison of the end-effector force estimation performance under human applied disturbances. The conventional momentum observer, the learning-based observer using the full joint velocity, and the proposed observer were compared with sensor force. The enlarged regions within box lines highlight the estimation performance during human disturbance periods at around T=14s and 27s respectively.
Observer
Overall
Region 1
Region 2
Maximum
RMSE(N)
RMSE(N)
RMSE(N)
Error(N)
F^mz
7.513
9.334
3.103
12.253
F^Φ(q,q˙)z
0.960
2.016
0.878
3.054
F^Φ(q,q˙t)z
0.729
0.804
0.408
1.892
TABLE I: Comparisons of the end-effector force estimation performance
Fig. 5: Controller tracking performance with two reference trajectories (a) R1 and (b) R2 . The translational position tracking errors Px , Py , and Pz are along the x, y and z directions. The orientation tracking errors Oψ , Oθ , and Oϕ are yaw, pitch, and roll. The force tracking errors Fz are along the z direction.
Fig. 6: Reference trajectories R1 and R2 . (a) R1 is a circular trajectory and (b) R2 is a rounded trapezoidal trajectory.