Abstract:This paper proposes a new control algorithm for human-robot co-transportation based on a robot manipulator equipped with a mobile base and a robotic arm. The primary focus is to adapt to human uncertainties through the robot's whole-body kinematics and pose optimization. We introduce an augmented Model Predictive Control (MPC) formulation that explicitly models human uncertainties and contains extra variables than regular MPC to optimize the pose of the robotic arm. The core of our methodology involves a two-step iterative design: At each planning horizon, we select the best pose of the robotic arm (joint angle combination) from a candidate set, aiming to achieve the lowest estimated control cost. This selection is based on solving an uncertainty-aware Discrete Algebraic Ricatti Equation (DARE), which also informs the optimal control inputs for both the mobile base and the robotic arm. To validate the effectiveness of the proposed approach, we provide theoretical derivation for the uncertainty-aware DARE and perform simulated and hardware experiments using a Fetch robot under varying conditions, including different trajectories and noise levels. The results reveal that our proposed approach outperforms baseline algorithms.

What problem does this paper attempt to address?

This paper attempts to solve the problem of how to enable robots to adapt to the uncertainty of human behavior in human - robot collaborative transportation tasks and improve task execution efficiency and safety by optimizing the robot's posture. Specifically, the paper proposes a new control algorithm. Based on a robot equipped with a mobile base and a robotic arm, it adapts to human uncertainty through the robot's full - body kinematics and posture optimization. The following are the main contributions of the paper: 1. **Introduction of a new modeling method**: The paper proposes a model - predictive - control (MPC) tracking problem that includes human uncertainty, which combines the robot's full - body kinematics and posture optimization. Unlike most existing uncertainty - aware MPC methods, this paper explicitly models human uncertainty, rather than only considering the uncertainty from the robot. 2. **Two - stage optimization strategy**: The paper proposes a two - stage optimization strategy. First, it calculates the estimated control cost in the presence of human uncertainty within a certain planning time range, and then selects the optimal posture from a set of joint - angle combinations. This strategy minimizes the expected cost in the future by selecting the best posture. 3. **Theoretical derivation and experimental verification**: The paper verifies the effectiveness of the proposed method through theoretical derivation and experimental verification. Specifically, the author provides the theoretical derivation of the uncertainty - aware discrete - algebraic - Riccati equation (DARE) and conducts simulation and hardware experiments using the Fetch robot, showing that the performance of the proposed method is better than that of the baseline algorithm under different trajectories and noise levels. ### Formula Explanation 1. **Trajectory prediction and human uncertainty**: \[ r(k)=\tilde{r}(k)+D\sum_{\tau = 0}^{k}\varpi(\tau) \] where \(\tilde{r}(k)\) is the predicted human behavior, \(\varpi(\tau)\sim N(0,\Sigma)\) represents the uncertainty of human position, \(\Sigma\) is the covariance matrix, and \(D = \begin{bmatrix}I_3&0_{3\times3}\end{bmatrix}^\top\). 2. **Dynamics model of the mobile base**: \[ s_{\text{base}}(k + 1)=s_{\text{base}}(k)+\tau\begin{bmatrix}\cos(\phi(k))&0\\\sin(\phi(k))&0\\0&1\end{bmatrix}u_{\text{base}}(k) \] where \(s_{\text{base}}=[x_{\text{base}},y_{\text{base}},\phi]^\top\) represents the position and heading angle of the robot, \(u_{\text{base}}=[v,\eta]^\top\) represents the linear velocity and angular velocity, and \(\tau\) is the time interval. 3. **Dynamics model of the robotic arm**: \[ s_{\text{arm}}(k + 1)\approx s_{\text{arm}}(k)+\tau J(\theta(k))\omega(k) \] where \(s_{\text{arm}}=[p_{\text{arm}}^\top,\psi_{\text{arm}}^\top]^\top\) represents the position and orientation of the end - effector of the robotic arm, \(J(\theta(k))\) is the Jacobian matrix, \(\theta = [\phi,\theta_2,\theta_3,\cdots,\theta_8]^\top\) includes the base heading angle and seven robotic - arm joint angles, and \(\omega=\dot{\theta}\) is the corresponding angular velocity. 4. **Overall kinematics model**: \[ s(k + 1)=s(k)+B(\theta(k))

Human-Robot Co-Transportation with Human Uncertainty-Aware MPC and Pose Optimization

Model-Based Robot Learning Control with Uncertainty Directed Exploration

Dynamical Obstacle Avoidance of Task- Constrained Mobile Manipulation Using Model Predictive Control

A Confidence-based Allocation Approach for USV Trajectory Tracking Via Human-Robot Co-Driving

Model Predictive Control for Fluid Human-to-Robot Handovers

Unified Contact Model and Hybrid Motion/force Control for Teleoperated Manipulation in Unknown Environments

Adaptive Safety-critical Control with Uncertainty Estimation for Human-robot Collaboration

Active Uncertainty Reduction for Human-Robot Interaction: An Implicit Dual Control Approach

Adaptive Model Predictive Control with Data-driven Error Model for Quadrupedal Locomotion

Multi-contact Stochastic Predictive Control for Legged Robots with Contact Locations Uncertainty

Hierarchical Control Strategy for Moving A Robot Manipulator Between Small Containers

An Efficient Representation of Whole-body Model Predictive Control for Online Compliant Dual-arm Mobile Manipulation

Integrating Predictive Motion Uncertainties with Distributionally Robust Risk-Aware Control for Safe Robot Navigation in Crowds

Enhancing Sample Efficiency and Uncertainty Compensation in Learning-based Model Predictive Control for Aerial Robots

Can't Touch This: Real-Time, Safe Motion Planning and Control for Manipulators Under Uncertainty

Robust Convex Model Predictive Control for Quadruped Locomotion Under Uncertainties

Model Predictive Control for Human-Centred Lower Limb Robotic Assistance

Collaborative Behavior Models for Optimized Human-Robot Teamwork

Whole-Body MPC for a Dynamically Stable Mobile Manipulator

Model Predictive Robot-Environment Interaction Control for Mobile Manipulation Tasks

Adaptive-Constrained Impedance Control for Human–Robot Co-Transportation