ToMPC: Task-oriented Model Predictive Control via ADMM for Safe Robotic Manipulation

Xinyu Jia, Wenxin Wang, Jun Yang, Yongping Pan · 2026

Read ToMPC: Task-oriented Model Predictive Control via ADMM for Safe Robotic Manipulation by Xinyu Jia, Wenxin Wang, Jun Yang, Yongping Pan (2026) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2603-13944.txt.

Introduction

Jia and co-authors propose ToMPC, a task-oriented model predictive control scheme for safe robot manipulation. It unifies collision-free motion and contact interaction in one framework. Task-oriented obstacle avoidance uses the arm's spare kinematic freedom to widen the working range in clutter. The hard optimization is split by ADMM into two subproblems, solved by dynamic programming and quadratic programming. Tests in simulation and on a Franka Panda arm show real-time planning. Safety limits hold as hard constraints throughout.

Catalog record

CREATORXinyu Jia, Wenxin Wang, Jun Yang, Yongping Pan
YEAR2026
COLLECTIONPAPERS
FORMATTXT
FILE SIZE42793
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

Source: https://arxiv.org/abs/2603.13944

Browse the full library · About the Tower of Babel

Full text

The opening of the work, from the library's hosted text:

ToMPC: Task-oriented Model Predictive Control via ADMM for Safe Robotic Manipulation Thanks: Received 24 January 2025; accepted 28 May 2025. This article was recommended for publication by Associate Editor M. Benallegue and Editor O. Stasse upon evaluation of the reviewers’ comments. This work was supported by the Singapore Ministry of Education Academic Research Fund (AcRF) Tier 2 under Grant T2EP50222-0009. ( Corresponding author: Haoyong Yu .) Thanks: Xinyu Jia, Wenxin Wang, Jun Yang, and Haoyong Yu are with the Department of Biomedical Engineering, National University of Singapore, Singapore 117583 (e-mail: [email protected]; [email protected]; [email protected]; [email protected]). Thanks: Yongping Pan is with the Peng Cheng Laboratory, Shenzhen 518057, China, and also the School of Electrical and Electronic Engineering, Nanyang Technological University, Singapore 639798 (e-mail: [email protected]). Thanks: Digital Object Identifier (DOI): see top of this page. Xinyu Jia, Wenxin Wang, Jun Yang, Yongping Pan Abstract This paper proposes a task-oriented model predictive control (ToMPC) framework for safe and efficient robotic manipulation in open workspaces. The framework unifies collision-free motion and robot-environment interaction to address diverse scenarios. Additionally, it introduces task-oriented obstacle avoidance that leverages kinematic redundancy to enhance manipulation efficiency in obstructed environments. This complex optimization problem is solved by the alternating direction method of multipliers (ADMM), which decomposes the problem into two subproblems tackled by differential dynamic programming (DDP) and quadratic programming (QP), respectively. The effectiveness of this approach is validated in simulation and hardware experiments on a Franka Panda robotic manipulator. Results demonstrate that the framework can plan motion and/or force trajectories in real time, maximize the manipulation range while avoiding obstacles, and strictly adhere to safety-related hard constraints. I Introduction Increasing demands in open workspaces require robotic manipulators to possess versatile motion and interaction capabilities [ 17 ] . Beyond performing general pick-and-place tasks [ 15 ] , robots must address safety concerns posed by the environment, such as avoiding collisions with obstacles [ 13 ] , or ensuring controllable external contacts [ 9 ] . In motion planning, random sampling-based approaches can rapidly generate collision-free paths; however, they often overlook task execution requirements and face challenges in physical interactions [ 24 ] . By contrast, optimization-based methods provide a convenient framework to incorporate diverse objectives and enforce complex constraints [ 17 ] . Among optimization methods, model predictive control (MPC) stands out for its capability of online replanning [ 22 ] , enabling adaptability in dynamic and uncertain environments. Therefore, this work will leverage the MPC approach to improve robot safety and manipulation behavior. In the field of MPC applications, there are extensive studies for safe robotic manipulation. For instance, adding velocity damping terms in the cost function allows manipulators to stably pass through singular configurations [ 18 ] . Additionally, extending the prediction horizon has been shown to reduce velocity constraint saturation [ 16 ] . For obstacles in the workspace, enforcing distance constraints can prevent the robot from collisions [ 12 ] . While the MPC handles position and velocity objectives or constraints effectively, it may struggle with force-based manipulation if only using kinematic information. In [ 27 ] , the authors design a MPC-based admittance controller to maintain a desired contact wrench. Alternatively, dynamics-based formulations can directly overcome this issue, albeit at the expense of increased computational burden. In [ 3 ] , a model predictive impedance control is developed with interaction dynamics. Later, simplified robot dynamics are introduced to support a sequence of manipulation tasks [ 8 ] . In recent years, full-body dynamics are integrated into contact problems [ 28 ] . However, few studies consider obstacle avoidance while applying contact force. The manipulation quality is also often ignored in avoidance. The gap is probably due to the increased complexity of the problem, posing challenges for real-time implementation. Fig. 1: A schematic diagram depicting the the proposed ToMPC planner, where the ADMM solves the optimization problem in a distributed fashion. The computational efficiency of MPC remains a concern in robotics. To address this challenge, a common approach is to linearize the system model and transcribe the MPC into a quadratic programming (QP) problem, where convexification of the QP enables very high replanning frequencies [ 18 ] . Other acceleration techniques include exploiting multiple threads of processors [ 12 ] or reformulating the problem using multiple-shooting method [ 14 ] . Recently, differential dynamic programming (DDP) [ 28 ] and its first-order variants [ 6 ] are widely adopted to solve nonlinear optimization problems. The backward pass in DDP reduces computational complexity by solving an approximated linear–quadratic regulator problem over the entire time horizon [ 20 ] . Nevertheless, a major drawback of the DDP is its inability to handle hard inequality constraints. To this end, various solutions have been developed, such as active-set methods [ 29 ] , quadratic barrier functions [ 16 ] , or augmented Lagrangian (AL) techniques [ 11 ] . Among them, the alternating direction method of multipliers (ADMM) emerged from AL garners much attention due to its decomposability. It can take advantage of the problem structure to solve large-scale optimization problems [ 4 ] . The ADMM has been successfully applied in diverse robotics to reduce computation burdens, including autonomous cars [ 20 ] , drones [ 23 ] , and contact-aware manipulation [ 2 ] . However, few prior works exploit this superior efficiency to tackle robotic manipulation tasks that couple full-system dynamics with collision avoidance. In this paper, we present a novel task-oriented MPC (ToMPC) trajectory planner based on the ADMM, which enables safe and efficient robotic manipulation in obstructed environments (see Fig. 1 ). The contributions are summarized as follows. • We propose a unified MPC framework for collision-free motion and environment interaction tasks. The framework supports online planning of motion and/or force trajectories in the workspace shared with obstacles. Moreover, by exploiting full-body dynamics, compliant contact is available without relying on additional force sensors. • We define a task-oriented avoidance strategy that leverages kinematic redundancy to balance obstacle avoidance and task execution. The robot link proactive motion increases the manipulation range of the end-effector. • We use ADMM distributed optimization to implement the ToMPC. The constrained nonlinear problem is separated into two subproblems solved by DDP and QP algorithms. Since equality and inequality constraints are decoupled, the MPC problem is solved in real time, and obstacle avoidance is strictly satisfied as one of hard constraints. The approach is validated on a redundant robotic manipulator through simulations and real-hardware experiments. The remainder of this paper is organized as follows. Section II briefly introduces the necessary background knowledge. Section III details the ToMPC formulation, and Section IV discusses its implementation through distributed optimization. Section V shows the results validated in simulation and on real hardware. Finally, Section VI summarizes this work. II Background II-A Model Predictive Control MPC is an advanced control method for systems with multiple variables and constraints [ 6 ] , which can be expressed as \displaystyle\min_{\bm{x}_{0:T},\bm{u}_{0:T-1}} \displaystyle\ell_{T}(\bm{x}_{T})+\sum_{t=0}^{T-1}\ell_{t}(\bm{x}_{t},\bm{u}_{t}) (1) s.t. \displaystyle\bm{x}_{t+1}=\bm{f}(\bm{x}_{t},\bm{u}_{t}),\quad\forall t\in\{0,1,\dots,T-1\}, \displaystyle\bm{c}_{t}(\bm{x}_{t},\bm{u}_{t})\geq 0,\quad\forall t\in\{0,1,\dots,T-1\}, \displaystyle\bm{c}_{T}(\bm{x}_{T})\geq 0,\quad\bm{x}_{0}=\bm{x}(0), where \bm{x}_{t}\!\in\!\mathbb{R}^{n_{x}} and \bm{u}_{t}\!\in\!\mathbb{R}^{n_{u}} are the vectors of state and input variables at t time step, \bm{x}_{0:T}\!=\!(\bm{x}_{0},\bm{x}_{1},\cdots\!,\bm{x}_{T}) and \bm{u}_{0:T-1}\!=\!(\bm{u}_{0},\bm{u}_{1},\cdots\!,\bm{u}_{T-1}) are the optimization variable sequences, T is the prediction horizon, \ell_{t}(\bm{x}_{t},\bm{u}_{t}),\ell_{T}(\bm{x}_{T})\!\in\!\mathbb{R}^{+} are the stage cost and terminal cost, \bm{c}_{t}(\bm{x}_{t},\bm{u}_{t}),\bm{c}_{T}(\bm{x}_{T})\!\in\!\mathbb{R}^{n_{c}}

Read the complete text