---
title: Constraint-Consistent Torque Controller
url: https://www.emergentmind.com/topics/constraint-consistent-torque-controller
type: topic
---

# Constraint-Consistent Torque Controller

Searching arXiv for recent and foundational papers on constraint-consistent torque control and closely related formulations.
Across these works, a constraint-consistent torque controller is a torque-level control law in which the commanded torque is synthesized together with task, safety, kinematic, force, contact, or actuator constraints rather than after them. The common objective is to preserve consistency between the commanded torque and the constrained dynamics of the underlying system, whether the system is a torque-controlled manipulator, a biped, a surgical robot, a synchronous machine, or a mobile platform. Representative formulations include probabilistic fusion of elementary torque laws, quadratic programs with Lyapunov or barrier constraints, projection-based inverse dynamics for holonomic constraints, viability-based safe torque projection, predictive optimization under input and state limits, and analytic feedforward solutions under current and voltage constraints [1712.07249], [1302.7314], [2403.09853], [2509.14075], [1211.5761], [1611.01629].

## 1. Definition and dynamical setting

A recurrent starting point is the rigid-body dynamics of a fully actuated manipulator,
$$
M(q)\,\ddot q + C(q,\dot q)\,\dot q + G(q) = \tau,
$$
or closely related notations such as
$$
H(q)\,\ddot q + C(q,\dot q)\,\dot q + G(q)=\tau_c+\tau_{ext},
$$
and, for bipedal systems,
$$
D(q)\,\ddot q + C(q,\dot q)\,\dot q + G(q)=B(q)\,u.
$$
In electrical-drive applications the same design idea appears in linearized state-space form, for example
$$
\dot x(t)=A\,x(t)+B\,u(t)+d,
$$
with explicit input and state constraints [2303.17252], [2403.09853], [1302.7314], [1211.5761].

Within this setting, “constraint-consistent” denotes a controller whose torque command is computed so that the constraint representation remains compatible with the system dynamics. Depending on the domain, the relevant constraints are expressed as task Jacobian relations, force-tracking laws, torque saturations, current and voltage bounds, control Lyapunov inequalities, control barrier inequalities, viability conditions, friction-cone conditions, unilateral-contact conditions, or rheonomic holonomic constraints such as remote center of motion (RCM) constraints in surgical robotics [1712.07249], [1705.10635], [2509.14075].

This suggests that the topic is not a single algorithmic family but a design principle. The principle is to move the constraint representation into the torque-synthesis stage itself, rather than treating torque generation and constraint handling as separate layers.

## 2. Main synthesis mechanisms

One major mechanism is probabilistic torque fusion. In “Probabilistic Learning of Torque Controllers from Kinematic and Force Constraints,” each elementary torque controller \(i\) defines a Gaussian torque distribution
$$
p_i(\tau)=\mathcal{N}(\tau;\mu_i,\Sigma_i),
$$
and the fused torque is obtained from the product of Gaussians,
$$
\tau^*=\mu^*=\Bigl(\sum_{i=1}^N \Sigma_i^{-1}\Bigr)^{-1}\sum_{i=1}^N \Sigma_i^{-1}\mu_i.
$$
The covariance encodes controller relevance or confidence, so small eigenvalues of \(\Sigma_i\) force accurate satisfaction along the associated torque directions [1712.07249].

A second mechanism is torque synthesis by convex optimization. In CLF-based walking control, the pointwise min-norm auxiliary input is written as
$$
\min_\mu \ \mu^T\mu
\quad\text{s.t.}\quad
\psi_0+\psi_1\,\mu\le 0,
$$
and torque saturation is added as linear constraints on \(\mu\), either with hard bounds or with slack variables \(d_1,d_2,d_3\) that trade off CLF decay against saturation compliance [1302.7314]. In constrained passive interaction control and safety-critical adaptive impedance control, the QP objective minimizes deviation from a nominal passive or impedance-based command while hard or soft constraints encode joint limits, collisions, singularities, and torque limits [2403.09853], [2605.28367].

A third mechanism is projection-based inverse dynamics under explicit constraints. For surgical RCM control, the constraint projector
$$
P=I-J_c^\dagger J_c
$$
splits the dynamics into free and constrained subspaces. The torque is then decomposed as
$$
\tau=\tau_\parallel \oplus \tau_\perp,
$$
with \(\tau_\parallel=P^\dagger P\,\tau_f\) for free-motion tasks and \(\tau_\perp=(I-P^\dagger P)\tau_c\) for constraint enforcement. In that construction, the RCM is treated as a rheonomic holonomic constraint embedded directly into inverse dynamics [2509.14075].

A fourth mechanism is explicit predictive or feedforward constrained optimization. For linear control systems with input and state constraints, flatness-based trajectory generation yields a finite-dimensional QP or LP whose solution generates a predictive torque controller for a permanent magnet synchronous motor [1211.5761]. For anisotropic synchronous machines, optimal feedforward torque control is reformulated as intersections of quadrics, and the solution is obtained analytically from a fourth-order polynomial in the Lagrange multiplier \(\lambda\) [1611.01629].

| Formulation family | Constraint representation | Representative paper |
|---|---|---|
| Probabilistic fusion | Gaussian torque distributions and precision-weighted fusion | [1712.07249] |
| CLF/CBF/NCBF QP | Linear inequalities, Lyapunov decay, barrier conditions, slack variables | [1302.7314], [2403.09853], [2605.28367] |
| Projection-based inverse dynamics | Constraint projector and orthogonal torque decomposition | [2509.14075] |
| Viability-preserving safe control | Acceleration-space inequalities mapped to torque-space | [2510.03367] |
| Predictive or analytic constrained control | Horizon-wise inequalities or quadric/quartic optimality conditions | [1211.5761], [1611.01629] |

## 3. Constraint classes and their encoding

Kinematic motion constraints are commonly encoded through task-space Jacobians. In the probabilistic fusion framework, a motion task is written as
$$
\tau_i^{\text{kin}}=J_i(q)^T\,F_i(x,\dot x),
$$
with \(\mu_i=J_i^T F_i\) and covariance chosen through
$$
W_i=J_i(q)J_i(q)^T+\lambda_i I,
\qquad
\Sigma_i=W_i^{-1}.
$$
This assigns low priority to torque directions that do not affect task \(i\) and high priority to those that do [1712.07249].

Force constraints are encoded similarly. For contact-force maintenance,
$$
\mu_i^{\text{force}}=J_{f,i}(q)^T\,f_d,
\qquad
\Sigma_i^{\text{force}}=\bigl(J_{f,i}(q)^T\,\Sigma_f\,J_{f,i}(q)\bigr)^{-1}.
$$
Smaller entries in \(\Sigma_f\) tighten tracking of the desired force \(f_d\) [1712.07249]. In whole-body control of humanoids, desired contact wrenches are optimized under unilateral-contact and Coulomb-friction constraints,
$$
\lambda_n^c\ge 0,
\qquad
\|\lambda_t^c\|\le \mu\,\lambda_n^c,
$$
and are then mapped into torques through inverse dynamics [1705.10635].

State and actuator limits are handled in several distinct ways. One approach is direct saturation in the torque-synthesis QP:
$$
u_{\min}\le u\le u_{\max},
$$
possibly with soft relaxations [1302.7314]. Another is state transformation. In “Torque Control with Joints Position and Velocity Limits Avoidance,” hard bounds are enforced by introducing exogenous states \(\zeta,\psi\) through
$$
q=q_0+\delta_q\,\tanh(\zeta),
\qquad
\dot q=\dot q_0+\delta_{\dot q}\,\tanh(\psi),
$$
so bounded exogenous states imply that joint positions and velocities remain strictly inside the feasible open intervals [2303.17252]. A third approach is barrier-based: position and velocity limits are encoded as relative-degree-two CBFs or as a composed position-velocity nonsmooth CBF yielding explicit acceleration bounds
$$
\alpha_{A,i}(x)\le \ddot q_i \le \alpha_{B,i}(x)
$$
for each joint [2403.09853], [2605.28367].

Holonomic and rheonomic constraints form another important class. In surgical robotics, the RCM constraint is written in local tool coordinates as
$$
x_{p,\mathrm{rcm},3D}(q,t)=R_r(q)^T\bigl(p_r(q)-p_c(t)\bigr),
$$
with acceleration-level condition
$$
J_c\,\ddot q=ẍ_c(t)-b_c(q,\dot q,t).
$$
The corresponding torque controller enforces tool-tip tracking while maintaining the trocar constraint in a dynamically consistent manner [2509.14075].

Safety constraints are often encoded as affine inequalities in acceleration and then mapped to torque space. In viability-preserving passive torque control,
$$
A(q,\dot q)\,\ddot q\le b(q,\dot q)
$$
is transformed using
$$
\ddot q=M(q)^{-1}\bigl(\tau-C(q,\dot q)\dot q-g(q)\bigr)
$$
into
$$
A_\tau(q,\dot q)\,\tau\le b_\tau(q,\dot q).
$$
This construction is used for joint-position limits, joint-velocity limits, self-collision avoidance, external-obstacle avoidance, and hardware acceleration limits [2510.03367].

## 4. Learning, adaptation, and model dependence

Learning from demonstrations provides one route to torque consistency when the relevant task representation is not known in advance. In the Gaussian-fusion framework, demonstrations of \(q_t\), \(\dot q_t\), and \(\tau_t\) are modeled by a mixture of \(N\) probabilistic controllers with priors \(\pi_i\). Responsibilities
$$
\gamma_{t,i}=\Pr(i\mid \tau_t)
$$
are computed in the E-step, and the M-step yields maximum-likelihood estimates of \(\mu_i\), \(\Sigma_i\), and \(\pi_i\). The paper states that this automatically discovers which controller is active in which region of the state space [1712.07249].

Adaptive and gray-box formulations retain explicit structure while learning uncertain parameters. In “Gray-Box Computed Torque Control for Differential-Drive Mobile Robot Tracking,” the actor is the gray-box computed-torque law itself rather than an arbitrary black-box policy network. Uncertain model and friction parameters are constrained to physically plausible ranges through tanh reparameterizations such as
$$
O_i=O_{c,i}+O_{r,i}\,\tanh z_i,
$$
and critically damped closed-loop poles are enforced by parameterizing PID gains through \(\alpha\), \(\beta\), and \(\epsilon\) so that
$$
(\lambda+(\alpha^2+\epsilon))^3=0.
$$
TD3 is then used to tune the parameter vector \(\theta=[z_1,z_2,z_3,z_4,z_y,z_p,\alpha,\beta]^T\) [2509.00571].

Safety-critical adaptive impedance control introduces online compensation for uncertain dynamics. Unknown structured dynamics are approximated by an interval type-2 fuzzy logic system,
$$
f(\xi)\approx \hat f(\xi;\theta)=\zeta(\xi)^T\theta,
$$
with adaptation law
$$
\dot\theta=\operatorname{Proj}_{\Gamma_\theta}\!\bigl(\theta,-\zeta(\xi)\,r,f(\theta)\bigr),
$$
while disturbance observers and a smooth sliding-mode term provide additional robustness [2605.28367].

Several safe torque controllers also rely on learned geometric constraint models. Constrained passive interaction control employs a tanh-MLP \(\Gamma_{SCA}(q)\) for self-collision boundaries and a Neural-JSDF \(\Gamma_{SDF}^{(i)}(q,x_0)\) per link for obstacle distances [2403.09853]. Viability-preserving passive torque control uses braking-rollout data to train a classifier \(\Gamma(q,\dot q)\) for self-collision viability and learns per-link signed-distance functions via Bernstein-polynomials for external-collision viability [2510.03367]. This suggests that modern constraint-consistent torque control increasingly combines analytical dynamics with learned constraint geometry.

## 5. Real-time implementations and empirical behavior

The literature contains both high-rate embedded implementations and comparatively slower but still real-time constrained controllers. For linear predictive torque control of a permanent magnet synchronous motor, the LP solve time is reported as worst-case \(\sim 20\,\mu s\) per control cycle, compared with \(\sim 100\,\mu s\) for the QP, with prediction horizon \(T=2\,\mathrm{ms}\), sampling rate \(10\,\mathrm{kHz}\), and overall control-loop latency \(<50\,\mu s\) for trajectory generation plus \(<10\,\mu s\) for evaluation [1211.5761]. In CLF-QP walking control on MABEL, a custom QP solver generated by CVXGEN solves the small problem in a few hundred \(\mu s\) inside a \(1\,\mathrm{kHz}\) loop, and the experimental summary reports 169 steps for the soft-saturation controller and 70 steps for the hard-saturation controller [1302.7314].

For humanoid stepping on iCub, the predictive momentum controller uses sampling time \(\Delta t=20\,\mathrm{ms}\), horizon \(N=15\), an MPC QP solved online in \(\approx 0.5\)–\(1\,\mathrm{ms}\), and a lower-level inverse-dynamics torque-mapping QP at \(1\,\mathrm{kHz}\) in \(\approx 200\,\mu s\) [1705.10635]. In Franka-based safe manipulation, viability-preserving passive control runs at \(\approx 170\)–\(200\,\mathrm{Hz}\) using CVXGEN on an Intel NUC, with solver warm-starting and problem-structure exploitation keeping latencies below \(5\,\mathrm{ms}\); in PyBullet simulation it reaches \(\approx 150\,\mathrm{Hz}\) with CVXPY [2510.03367]. Constrained passive interaction control reports neural-network boundary evaluations at \(\sim 300\,\mathrm{Hz}\), QP solves at \(\sim 200\,\mathrm{Hz}\), and a torque loop at \(1\,\mathrm{kHz}\) on a 7-DoF Franka Research 3 [2403.09853].

Performance outcomes vary by domain but follow a common pattern: the constrained synthesis improves feasibility, smoothness, or safety relative to unconstrained or naively switched baselines. In probabilistic torque fusion on 7-DoF torque-controlled manipulators, the fused controller \(\tau^*\) is reported to consistently achieve lower tracking error than any single controller alone; force-compliance tasks maintain the desired contact force within \(5\,\mathrm{N}\) RMS, whereas naively switching controllers leads to oscillations up to \(15\,\mathrm{N}\), and transitions between motion and force tasks occur seamlessly, with no large spikes in torque or force [1712.07249]. In surgical RCM control, the projection-based “P-approach” yields mean \(|\tau|\approx 0.53\,\mathrm{Nm}\), peak \(\approx 0.99\,\mathrm{Nm}\), RCM residuals \(\sim 0.5\,\mathrm{mm}\) versus \(\sim 0.8\,\mathrm{mm}\) on a Franka-Emika experiment, and residuals within \(1\,\mathrm{mm}\) under \(0.2\,\mathrm{Hz}\), \(\pm 4\,\mathrm{cm}\) trocar motion [2509.14075].

## 6. Guarantees, misconceptions, and open problems

The strongest claims in this literature are usually conditional rather than unconditional. Forward invariance is proved for CBF- and viability-based constructions when the corresponding hard constraints are feasible [2403.09853], [2510.03367], and the main theorem in the adaptive impedance framework states forward invariance of the CBF safe set \(\mathcal C^*\), torque admissibility when the hard problem is feasible, and uniform ultimate boundedness of the impedance-tracking error [2605.28367]. In CLF-QP walking control, the Lyapunov function \(V_\epsilon\) decays rapidly between impacts and the zero dynamics limit cycle remains stable and close to its nominal trajectory, but exact torque saturation may require hard constraints and occasional solver timeouts are explicitly reported for the hard-saturation implementation [1302.7314].

A common misconception is that constraint consistency is synonymous with strict task hierarchy or with passivity. The surveyed works show otherwise. Some methods are probabilistic and blend controllers rather than impose a strict priority order [1712.07249]; some use orthogonal decomposition in projected inverse dynamics [2509.14075]; some enforce safety through barrier inequalities while staying passive only when feasible [2403.09853]; and some begin from a passive nominal controller and project it into a safe torque set while arguing that the projection does not inject energy [2510.03367]. This suggests that “constraint-consistent” names a consistency property between torque synthesis and constraints, not a single stability doctrine.

The limitations are similarly formulation-specific. Reported assumptions include linear-Gaussian elementary torque laws, full-rank task Jacobians when needed, and quasi-static contact dynamics without high-frequency impacts [1712.07249]. Failure modes include strong model mismatch under highly nonlinear dynamics or intermittent contact, ill-conditioned covariance matrices for underactuated tasks, numerical sensitivity of projection operators when \(J_c\) is ill-conditioned, depth dependence in surgical RCM control, coupled gain tuning, oscillatory torques and occasional small velocity-limit violations under discretization, and feasibility loss handled only through slack on selected constraints [1712.07249], [2509.14075], [2303.17252], [2605.28367].

The extension agenda is broad but technically coherent. The papers explicitly propose non-Gaussian controllers such as mixture-of-student-\(t\), time-varying covariances \(\Sigma_i(q,\dot q)\), hierarchical or deep-neural networks for \(\mu_i,\Sigma_i\), passivity-preserving energy tanks, adaptive filtering, depth-adaptive gain scheduling, direct tip feedback, sparse or proximal multi-constraint resolutions, and reformulations that reduce discretization sensitivity [1712.07249], [2509.14075], [2303.17252]. A plausible implication is that future constraint-consistent torque controllers will increasingly combine analytical dynamics, convex safety filtering, learned geometry, and adaptive uncertainty compensation within a single torque-level architecture.

Source: https://www.emergentmind.com/topics/constraint-consistent-torque-controller