Ground Reaction Force-Aware Model Predictive Control for Underactuated Upright Physical Assistance
Authors: Darren Biskup, Jeonghan Yu, Zibo Yu, Sunil K. Agrawal
Organizations: Department of Mechanical Engineering, Columbia University, New York, NY 10027, USA. · Department of Mechanical Engineering, SUNY Korea, Incheon 21985, Republic of Korea. · Department of Rehabilitation and Regenerative Medicine, Columbia University, New York, NY 10027, USA.
Many rehabilitation robots execute prescribed motions using reactive tracking controllers that do not explicitly incorporate the user's instantaneous human-ground interaction. This paper presents Ground Reaction Force-Aware Model Predictive Control (GRF-MPC), a framework for upright physical assistance. By integrating live GRF and center of pressure (CoP) measurements directly into a human centroidal dynamics model, GRF-MPC formulates a real-time quadratic program (QP) that optimizes assistive forces and moments over a receding horizon. We deployed GRF-MPC on the Robotic Upright Stand Trainer (RobUST) in an underactuated 4-cable configuration and evaluated it against a fully actuated 8-cable Cartesian impedance baseline in nearly 300 trials across six healthy participants. Across tasks spanning impulsive perturbations, lunge trajectories, and voluntary limits of stability, GRF-MPC reduced peak planar center-of-mass (CoM) error by 19.6% during perturbations, lowered trajectory tracking error by 24.1%, required 28.7% less net mechanical work, and permitted a 45.9% greater normalized voluntary excursion area. The underlying QP solves in under 1 ms, comfortably enabling 100 Hz replanning and demonstrating that incorporating live human-ground interaction into predictive control yields stronger, more transparent physical assistance with half the actuators.
Figures & tables
Fig. 1: (A) Schematic of the Robotic Upright Stand Trainer (RobUST) system highlighting motion tracking, cable actuation, and CoP/GRF measurement. (B) Photograph of the experimental setup showing the user equipped with Vive trackers, standing on force plates, and receiving visual feedback. (C) Real-time graphical interface displaying the user’s inertia ellipsoid, target and predicted positions, and force vectors.
Fig. 2: Hierarchical control architecture for GRF-MPC on RobUST. The high-level controller implemented in C# uses tracker and force plate data to solve the convex QP problem in real-time. The resulting optimal tension commands are transmitted asynchronously to the low-level NI PXIe system, which tracks the tension via load cell feedback.
Parameter
Value
4-Cable GRF-MPC
N (prediction horizon)
10 steps
Δt (discretization)
0.05 s
Qx,y
500
Qz
100
Qp˙
50
TABLE I: Controller Parameters
Fig. 3: (A) Illustration of the fully actuated impedance control baseline, contrasted with the underactuated 4-cable GRF-MPC. (B) Illustration of experimental tasks: Stable Standing under perturbation (left); Deep Lunge tracking (middle); and Permitted Workspace Mapping via voluntary chest displacement (right).
Fig. 4: Representative perturbation response for a single subject. (Top) Planar CoM position vs. time under Transparent, Impedance, and MPC conditions. (Bottom) Planar CoP excursion measured by the force plates during the same trial.
Fig. 5: Experimental results across all three tasks. Error bars indicate Standard Deviation. (A) Task 1: Standing Perturbation — comparison of peak planar CoM error (top) and settling decay time (bottom) for subjects S1–S6 under Transparent, Impedance, and MPC control modes. (B) Task 2: Lunge tracking efficiency — CoM planar error (top) and cumulative mechanical work (bottom). (C) Task 3: Permitted workspace mapping — normalized excursion area demonstrating the MPC’s ability to preserve a significantly larger functional workspace compared to rigid impedance control.
This paper presents Residual Koopman MPC (RK-MPC), a Koopman-based, data-driven model predictive control framework for quadruped locomotion that improves prediction fidelity while preserving real-time tractability. RK-MPC augments a nominal template model with a compact linear residual predictor learned from data in lifted coordinates, enabling systematic correction of model mismatch induced by contact variability and terrain disturbances with provable bounds on multi-step prediction error. The learned residual model is embedded within a convex quadratic-program MPC formulation, yielding a receding-horizon controller that runs onboard at 500 Hz and retains the structure and constraint-handling advantages of optimization-based control. We evaluate RK-MPC in both Gazebo simulation and Unitree Go1 hardware experiments, demonstrating reliable blind locomotion across contact disturbances, multiple gait schedules, and challenging off-road terrains including grass, gravel, snow, and ice. We further compare against Koopman/EDMD baselines using alternative observable dictionaries, including monomial and SE(3)-structured bases, and show that the residual correction improves multi-step prediction and closed-loop performance while reducing sensitivity to the choice of observables. Overall, RK-MPC provides a practical, hardware-validated pathway for data-driven predictive control of quadrupeds in unstructured environments. See https://sriram-2502.github.io/rk-mpc for implementation videos.
Sriram S. K. S. Narayanan, Umesh Vaidya
Department of Mechanical Engineering, Clemson University, Clemson, SC 29630, USA
Continuous legged manipulation requires accurate end-effector tracking while the base keeps walking. Combining reinforcement learning (RL) with model predictive control (MPC) suits this task: the learned policy provides robust locomotion, while MPC coordinates the base and arm to compensate for tracking errors. However, MPC can compensate only for base motion that it can predict, and a learned policy's command response varies with gait phase, contact, and payload. We present ReCo, a framework that couples response-consistent locomotion with policy-aware MPC for legged manipulation. Response shaping trains the policy to respond to commands consistently and repeatably across randomized dynamics. An identified closed-loop response model then lets MPC jointly plan locomotion commands and arm motion. On the simulation benchmark, ReCo reduces position and orientation root-mean-square error (RMSE) by 28.7% and 27.4% relative to the best baseline for each metric. Real-world experiments demonstrate onboard continuous legged manipulation with coordinated base and arm motion.
Kuankuan Sima, Yichao Gao, Chenxi Gu +2
Department of Electrical and Computer Engineering, National University of Singapore, Singapore 119077, Singapore · Department of Mechanical Engineering, National University of Singapore, Singapore 119077, Singapore
Humanoid locomotion requires deciding where to step and how to distribute contact forces. However, a disturbance can invalidate the nominal plan, requiring coordinated revision under constraints that switch with every footfall. To solve this online, the proposed approach employs the single-rigid-body model, which retains attitude dynamics and the full contact wrench. An iterative linear-quadratic-regulator MPC (iLQR-MPC) then jointly optimizes contact forces and footstep locations in a single receding-horizon problem, without a separate step planner. Specifically, contact and motion constraints are incorporated into the backward pass through augmented-Lagrangian and relaxed-barrier penalties. A whole-body controller subsequently maps the plan to joint torques at 500 Hz while preserving contact feasibility. The model-based formulation makes disturbance responses interpretable through explicit costs and constraints, and requires no platform-specific policy training. In MuJoCo simulations, the iLQR-MPC replans at 100 Hz (mean solve time 8.9 ms); the Unitree G1 sustains steady-state walking and recovers from impulsive 245 N forward and 175 N lateral pushes.
Xiang Li, Linlin Ou, Ruihan Wu +1
Zhejiang University of Technology, Hangzhou, China