Literature
Display
← All papers

Constraint-Decomposed Impedance Control from Generative Policy for Articulated Object Manipulation

Kyungseo Park · Byeongdo Lim · Jungbin Lim · Minseok Choi · Frank C. Park

Preprint posted · CoRL 2026 (accepted) ↗

Robotics20 min text · CondensedOriginal paper ↗
Contents

Overview

Read this as a method for shaping impedance after a successful grasp. It estimates motion directions from a generative policy and preserves compliance in their complement. All five figures, 14 numbered tables, 56 numbered equations and the complete algorithm remain; the extensive appendices define the controller’s local theoretical scope and experimental qualifications.

At a glance

Sample multiple end-effector trajectories at the same observation, convert them to body twists and estimate their dominant linear subspace with weighted, uncentered PCA. Fixed impedance gains track that subspace stiffly and soften its complement. For many single-joint mechanisms the feasible subspace is configuration-independent; for other mechanisms the method instead estimates a larger fixed envelope that can contain instantaneously infeasible directions. Simulation and physical tests usually reduce measured complementary loads, but the real crank’s force impulse increases 14%. The passivity result applies only to a local, frozen-inertia error model with fixed gains; it is not a general physical contact-safety guarantee.

1 Introduction

Small policy trajectory errors can create large forces when a rigidly grasped object cannot move in the commanded direction. Uniformly lowering stiffness also weakens useful motion. The proposed solution estimates the articulation’s directional structure from diverse policy samples and keeps high gains along supported motions. No separate perception model, physical probing or known screw axes enter the estimator. Its central assumption is that policy outputs collectively cover the relevant feasible directions. Gains are estimated once at grasp closure and held fixed during articulation, avoiding continuous geometry estimation at the cost of limited adaptation.

Refer to caption
Figure 1: Overview of the proposed constraint-decomposed impedance control. Top: (1) At grasp closure, the generative policy πθ​(a|O;z)\pi_{\theta}(a|O;z) samples multiple trajectories from the same observation OO. (2) The trajectories are converted to end-effector body twists and stacked into a data matrix W∈ℝ6×N​HW\in\mathbb{R}^{6\times NH}. (3) A weighted PCA recovers the feasible twist subspace U∥U_{\parallel} and its complementary constrained subspace U⟂U_{\perp}, (4) which define the constraint-decomposed impedance gains Kv,DvK_{v},D_{v} that are stiff along U∥U_{\parallel} and compliant along U⟂U_{\perp}. Bottom: the articulated objects used in our real-world experiments, spanning revolute, prismatic, helical, cylindrical, and crank mechanisms.

2 Related Work

The method differs from explicit articulation estimation and from rules that directly map positional variance or measured force to stiffness. Its geometry is the span of body twists generated by the policy.

Explicit articulation estimation.

Vision, interaction and demonstration methods can estimate joint axes or articulation models, but their results must be transformed into the grasp/controller frame. Here sampled end-effector trajectories already reflect the current grasp. Avoiding a separate estimator does not remove the need for informative demonstrations or correct body-frame conventions.

Variance-based impedance and direction-wise control.

Earlier variance-based control makes low positional variance stiff. This work uses twist variation differently: little motion in a direction suggests a constraint, so that direction becomes compliant. Subspace-wise hybrid control supplies the split as prior knowledge, while force-directed compliance uses a measured-force rule. The proposed split instead comes from policy-implied articulation geometry.

3 Preliminaries

Operational-space dynamics explain how pose/twist errors become commanded wrenches. Articulated-object kinematics explain which body twists belong to a local feasible subspace and when a fixed global subspace can represent them.

3.1 Operational-Space Impedance Control

The virtual mass–damper–spring relation links pose/twist errors to external wrench. Matching virtual inertia to operational-space robot inertia permits model-based acceleration/Coriolis/gravity feedforward plus stiffness/damping feedback, mapped to joint torques by the Jacobian transpose. High gains enforce tracking; low gains permit displacement under contact. The method changes directional gains, retaining the nominal operational-space implementation and its modeling assumptions.

Equations 1–2
Mv​e˙V+Dv​eV+Kv​eT=Fext,M_{v}\dot{e}_{V}+D_{v}e_{V}+K_{v}e_{T}=F_{\rm ext}, (1)
Fcmd=Fff+Ffb,Ffb=Kv​eT+Dv​eV,F_{\mathrm{cmd}}=F_{\mathrm{ff}}+F_{\mathrm{fb}},\quad F_{\mathrm{fb}}=K_{v}e_{T}+D_{v}e_{V}, (2)

3.2 Kinematics of Articulated Objects

Model a fixed-base open chain with a rigidly grasped distal link. The range of its body Jacobian is the local feasible twist subspace. A laptop hinge has a fixed one-dimensional body-twist span; a two-joint coffee-grinder crank changes its local span with configuration. Define the global envelope as the smallest linear subspace containing all local spans. Membership is equivalent to feasibility only when the local span is constant; otherwise membership is necessary but insufficient. Singular configurations and grasp-frame transformations remain relevant.

Equation 3
𝒮⁡(q):=span⁡{B1​(q),…,Bk​(q)}⊂ℝ6,\mathcal{S}(q):=\operatorname{span}\{B_{1}(q),\ldots,B_{k}(q)\}\subset\mathbb{R}^{6}, (3)
Refer to caption
Figure 2: Articulated object examples. Visualization of the body frame and feasible body twist Vb=(ω,v)V_{b}=(\omega,v), with joint axes (yellow dashed). (a) For a laptop with a revolute joint, ω\omega always aligns with +x+x and vv with +y+y (configuration-independent). (b) For a coffee-grinder crank, vv aligns with −y-y in solid case, but with +x+x in translucent case (configuration-dependent).
Equation 4
𝒮env:=span⁡(⋃q∈ℝk𝒮⁡(q))⊂ℝ6,\mathcal{S}_{\rm env}:=\operatorname{span}\!\left(\bigcup_{q\in\mathbb{R}^{k}}\mathcal{S}(q)\right)\subset\mathbb{R}^{6}, (4)

4 Method

Given a generative manipulation policy, estimate a body-twist envelope from its outputs and convert that estimate into inertia-weighted gains. No retraining or supplied articulation parameters are required at deployment. Algorithm 1 preserves the exact sampling, finite-difference, rank-selection and gain computations.

Algorithm 1 Constraint-Decomposed Impedance Gains from Generative Policy
Original Algorithm 1, given/hyperparameters/input/output and all 11 numbered steps, with exact equations and comments.

4.1 Constraint Estimation from a Trajectory Ensemble

Each action is an H-step desired end-effector pose trajectory. At one visual/proprioceptive observation, sample an ensemble and infer the origin-passing subspace spanned by the resulting body motions.

Body twist extraction.

Finite differences on each SE(3) trajectory produce body twists, stacked into a 6×NH matrix. Multiple trajectories can suppress individual off-constraint errors and expose independent motions missing from a single rollout. This relies on diversity representing valid articulation alternatives rather than arbitrary policy noise.

Weighted PCA in twist space.

Choose a positive-definite twist metric G, factor it as LᵀL and apply SVD to LW; transform left singular vectors back by L⁻¹. The eigenvalues λk=σk²/(NH) are squared RMS speeds in the scaled metric. Keep leading directions whose square-root speeds exceed both an absolute floor and κrel times the least-excited square-root speed. The absolute test targets policy/sampler residual motion; the relative test addresses spectrum-wide grasp-chain deviations. Both are calibrated hyperparameters, not automatically known noise bounds.

Equations 5–7
⟨V1,V2⟩G:=V1⊤​G​V2,‖V‖G2:=V⊤​G​V.\langle V_{1},V_{2}\rangle_{G}:=V_{1}^{\top}GV_{2},\qquad\|V\|_{G}^{2}:=V^{\top}GV. (5)
L​W=U~​Σ~​V~⊤,U=L−1​U~,LW=\widetilde{U}\widetilde{\Sigma}\widetilde{V}^{\top},\qquad U=L^{-1}\widetilde{U}, (6)
𝒮^env:=span{u1,…,um},U∥=[u1⋯um].\widehat{\mathcal{S}}_{\rm env}:=\operatorname{span}\{u_{1},\ldots,u_{m}\},\qquad U_{\parallel}=[\,u_{1}\cdots u_{m}\,]. (7)

Choice of the inner product.

Use G=diag(α²I, I), converting angular velocity into a linear-velocity scale. Estimate α from the translation/rotation norm ratio of the leading unweighted singular vector and clip it to a fixed range. This data-derived length sets PCA geometry; it is not the separate nominal-inertia length used to construct controller gains.

4.2 Impedance Gain Decomposition

A constant positive-definite block-isotropic inertia metric defines the feasible/complement projectors. The full Gram inverse is necessary because the PCA basis is orthonormal in G, not necessarily in this control metric. Body-frame double-geodesic pose error and adjoint-transported twist error feed inertia-weighted stiffness/damping maps. With fixed projectors and nonnegative gains, those maps are symmetric positive semidefinite; positive modal gains make them definite. The associated quadratic energy argument is local and first-order, with the precise limits given in AppendixF.

Equations 8–10
P∥Λ¯=U∥​(U∥⊤​Λ¯​U∥)−1​U∥⊤​Λ¯,P⟂Λ¯=I−P∥Λ¯.P_{\parallel}^{\bar{\Lambda}}=U_{\parallel}\left(U_{\parallel}^{\top}\bar{\Lambda}U_{\parallel}\right)^{-1}U_{\parallel}^{\top}\bar{\Lambda},\qquad P_{\perp}^{\bar{\Lambda}}=I-P_{\parallel}^{\bar{\Lambda}}. (8)
eT=[log⁡(Rb⊤​Rd)∨Rb⊤​(pd−pb)],eV=AdTb−1​Td​Vd−Vb,e_{T}=\begin{bmatrix}\log(R_{b}^{\top}R_{d})^{\vee}\\[2.0pt] R_{b}^{\top}(p_{d}-p_{b})\end{bmatrix},\qquad e_{V}=\mathrm{Ad}_{T_{b}^{-1}T_{d}}\,V_{d}-V_{b}, (9)
Kv=Λ¯​(k∥​P∥Λ¯+k⟂​P⟂Λ¯),Dv=Λ¯​(d∥​P∥Λ¯+d⟂​P⟂Λ¯).K_{v}=\bar{\Lambda}\left(k_{\parallel}P_{\parallel}^{\bar{\Lambda}}+k_{\perp}P_{\perp}^{\bar{\Lambda}}\right),\qquad D_{v}=\bar{\Lambda}\left(d_{\parallel}P_{\parallel}^{\bar{\Lambda}}+d_{\perp}P_{\perp}^{\bar{\Lambda}}\right). (10)

5 Experiments

Experiments test both estimation quality and contact loads under matched policies. Simulation includes an analytic-subspace oracle; hardware compares estimated decomposition against isotropic impedance.

Evaluation metrics.

Force and moment are projected separately onto complements of the analytic reference’s linear/angular spans. Impulse integrates magnitude; the reported “peak” is the 95th percentile, not the maximum. For configuration-dependent objects the reference is the fixed envelope, so these diagnostics omit local constraints inside it. Subspace error is a largest principal angle; simulation success counts completion of a common articulation range. AppendixH fixes the scoring metric and trial inclusion rules.

Compared controllers.

Iso uses equal normalized gains in all directions. Ours keeps the same feasible gains and reduces complementary stiffness; Oracle applies the same rule with an analytic grasp-conditioned subspace. Every comparison shares the same Diffusion Policy checkpoint. This isolates the chosen gain split within the experiment rather than comparing different learned policies.

Refer to caption
Figure 3: Simulated articulated objects. Revolute, cylindrical, planar, and universal joints in Isaac Sim, manipulated by a flying gripper.

5.1 Simulation Experiments

Four simulated mechanisms test one-, two- and three-dimensional motion spans, including a locally two-dimensional universal joint whose fixed envelope has dimension three.

Setup.

Isaac Sim uses a flying gripper on revolute, cylindrical, planar and universal joints. The policy predicts 24 poses at 0.1-second intervals; impedance runs 150 Hz. At grasp closure, sample 128 trajectories with ten DDIM steps, use 5 mm/s and relative threshold 4, and reduce complement stiffness to 0.1 of the feasible value. Evaluate 100 initial configurations per controller/object. Oracle supplies only the gain subspace, not a different tracking policy.

Results.

Force impulse falls to 0.13–0.37 of Iso and 95th-percentile force to 0.18–0.46, recovering at least 90% of the Oracle reduction in these metrics. Mean subspace errors are 1.64–4.36°. Success remains approximately 97–100%, with the complete counts preserved in Table 1. Wrench comparisons use the shared-success episodes, whereas success rates count every attempt. Moment components are small and the universal-joint angular complement is structurally empty. Multi-task results show similar force reductions.

Table 1: Simulation results. Entries are Iso / Ours / Oracle; SE reports Ours only, and boldface marks the better of Iso and Ours. Dashes indicate structurally empty complement components.
Task SR (%) SE (°) ICF (N⋅\cdots) PCF (N) ICM (N⋅\cdotm⋅\cdots) PCM (N⋅\cdotm)
Revolute 099 / 099 / 099 1.64 7.18 / 2.62 / 2.13 3.38 / 1.56 / 1.48 .29 / .22 / .22 .19 / .18 / .17
Cylindrical 099 / 100 / 100 1.73 5.31 / 0.83 / 0.53 1.96 / 0.36 / 0.31 .32 / .22 / .21 .16 / .14 / .14
Planar 099 / 099 / 099 2.78 15.3 / 1.93 / 2.20 4.03 / 1.18 / 1.16 .74 / .48 / .34 .29 / .23 / .21
Universal 100 / 100 / 100 4.36 2.18 / 0.46 / 0.34 1.25 / 0.23 / 0.19 – / – / – – / – / –

5.2 Real-World Experiments

Five physical objects include revolute, prismatic, helical, cylindrical and parallel-axis crank mechanisms. The crank tests the limitation of a fixed envelope for configuration-dependent motion.

Setup.

An FR3 runs impedance at 1 kHz and the same 24-step/0.1-second policy horizon. Estimate from 32 trajectories with 100 DDPM steps, absolute threshold 3 mm/s and relative threshold 10, except 4 for the crank; complement stiffness ratio remains 0.1. Each object has ten trials/controller from fixed object/base configurations. Gains and collision thresholds are tuned so both controllers complete all trials, enabling matched-progress wrench comparisons. This protocol does not establish a hardware success advantage or robustness over randomized initial poses.

Results.

Mean object-wise force impulse/peak ratios are 0.72/0.70; moment impulse/peak ratios are 0.69/0.56 with prismatic excluded. All four configuration-independent objects improve across reported loads. Subspace error is 13.01° for revolute and 2.89–5.76° for the others. The crank reduces peak force and moments but increases force impulse to 1.14×Iso: its envelope permits some locally infeasible directions to remain stiff. Table 2 preserves this exception.

Table 2: Real-world results. Entries are Iso / Ours (Ours/Iso); SE reports Ours only, and boldface marks the better of Iso and Ours. Daggers mark full moments, as prismatic has no feasible rotation.
Task SE (°) ICF (N⋅\cdots) PCF (N) ICM (N⋅\cdotm⋅\cdots) PCM (N⋅\cdotm)
Revolute 13.01 46.6 / 25.2 (0.54) 8.54 / 3.62 (0.42) 5.00 / 3.34 (0.67) 0.93 / 0.37 (0.40)
Prismatic 04.74 12.3 / 8.79 (0.72) 4.63 / 3.51 (0.76) 1.84 / 1.46 (0.80)† 0.61 / 0.55 (0.90)†
Helical 02.89 6.96 / 6.50 (0.93) 4.56 / 4.40 (0.96) 1.82 / 0.60 (0.33) 1.08 / 0.45 (0.41)
Cylindrical 05.76 8.35 / 4.42 (0.53) 3.37 / 2.20 (0.65) 1.09 / 0.82 (0.75) 0.45 / 0.37 (0.81)
Crank 05.70 20.8 / 23.6 (1.14) 4.62 / 4.28 (0.93) 4.99 / 4.15 (0.83) 1.12 / 0.82 (0.74)

5.3 Analysis of Constraint Estimation

Post-hoc subset and perturbation studies separate ensemble count, sample diversity and noise effects. Many of these analyses hold the subspace dimension fixed, unlike deployment’s threshold-selected dimension.

Ensemble size and runtime.

With true dimension fixed, pooled 95th-percentile error falls from 78.9° at one sample to 23.1/8.59/7.23° at 2/4/8, reaching 6.61° at 128. Correct dimension on every trial requires at least 64 samples under one threshold setting. Batched 128-sample estimation and gain construction takes 70.1 ms median and 76.5 ms maximum on an RTX 5070 Ti; this one-time simulation sampler timing uses ten DDIM steps and is not the 100-step hardware sampler latency.

Sample diversity.

At equal subset size, high mean pairwise dynamic-time-warping diversity yields smaller errors than low diversity, especially at 2–8 samples. Mean per-object median error at k=2 is 5.91° versus 19.7°, approaching 2.34° for the full ensemble. By 32–64 samples the difference becomes small. Increasing N mitigates finite sampling gaps, but cannot reveal a feasible direction absent from the demonstrations or learned policy.

Robustness to noise.

A policy trained on noisy demonstrations attenuates some perturbations compared with adding the same noise directly to sampled trajectories. Five-degree orientation corruption still produces about 10.6° median subspace error. Tested image noise/blur/shifts barely change the clean 2.10° result; reducing denoising from 100 to 4 steps also changes little. The appendix’s two-step case collapses to 87.38°, so robustness does not extend to arbitrarily crude sampling.

6 Conclusion

Policy ensembles can identify useful motion directions for fixed impedance shaping, reducing complementary loads in the tested tasks without explicit online articulation estimation. The mechanism depends on body-twist coverage and appropriate metrics, not merely on producing more trajectories.

Limitations and future work.

Insufficient demonstration diversity or policy mode collapse can hide feasible directions at any ensemble size. A fixed envelope also leaves stiffness along some instantaneous constraints of configuration-dependent mechanisms. Local resampling and force/tactile refinement are future directions. The construction shapes gains under a nominal inertia metric; it does not fully decouple the real robot/object dynamics. Contact switches, large errors, online projector changes and true-inertia variation fall outside the provided passivity certificate.

Acknowledgments

The authors acknowledge Korean government research programs, Seoul National University institutes/programs, Hyundai Motor/Kia and Microsoft Research support. The listed grants and institutional acknowledgments remain attributable to the original paper.

Appendix A Operational-Space Dynamics and Block-Isotropic Inertia

AppendixA derives the feedforward/feedback wrench split, defines the fixed inertia surrogate and establishes body-coordinate tracking errors. It separates physical plant dynamics from the metrics used for estimation and gain design.

A.1 Commanded Wrench from the Virtual Impedance Model

Match virtual inertia to the body-frame operational inertia and equate the impedance target with the robot dynamics. Reference acceleration includes the derivative of adjoint transport. Under exact model matching, the resulting model-based acceleration/Coriolis/gravity terms plus spring/damper feedback recover the target relation. Contact wrench cancels from the command derivation, so measured force/torque is used for monitoring/evaluation, not controller feedback. Approximate models leave residual dynamics.

Equations 11–16
Λb​V˙b+Cb​Vb+gb=Fcmd−Fext,\Lambda_{b}\,\dot{V}_{b}+C_{b}\,V_{b}+g_{b}=F_{\rm cmd}-F_{\rm ext}, (11)
Mv​e˙V+Dv​eV+Kv​eT=Fext,M_{v}\dot{e}_{V}+D_{v}e_{V}+K_{v}e_{T}=F_{\rm ext}, (12)
Vref,b:=AdTb−1​Td​Vd,aref,b:=V˙ref,b=dd​t​(AdTb−1​Td​Vd),V_{\rm ref,b}:=\mathrm{Ad}_{T_{b}^{-1}T_{d}}V_{d},\qquad a_{\rm ref,b}:=\dot{V}_{\rm ref,b}=\tfrac{d}{dt}\!\left(\mathrm{Ad}_{T_{b}^{-1}T_{d}}V_{d}\right), (13)
Λb​V˙b=Λb​aref,b+Dv​eV+Kv​eT−Fext,\Lambda_{b}\dot{V}_{b}=\Lambda_{b}a_{\rm ref,b}+D_{v}e_{V}+K_{v}e_{T}-F_{\rm ext}, (14)
Fcmd=Λb​aref,b+Cb​Vb+gb+Kv​eT+Dv​eV.F_{\rm cmd}=\Lambda_{b}a_{\rm ref,b}+C_{b}V_{b}+g_{b}+K_{v}e_{T}+D_{v}e_{V}. (15)
Fff=Λ^b​aref,b+C^b​Vb+g^b,Ffb=Kv​eT+Dv​eV,Fcmd=Fff+Ffb.F_{\rm ff}=\hat{\Lambda}_{b}\,a_{\rm ref,b}+\hat{C}_{b}\,V_{b}+\hat{g}_{b},\qquad F_{\rm fb}=K_{v}e_{T}+D_{v}e_{V},\qquad F_{\rm cmd}=F_{\rm ff}+F_{\rm fb}. (16)

A.2 Block-Isotropic and Normalized Inertia

A configuration-dependent inertia could normalize dynamics but would make the directional metric vary online. Instead, use constant rotational/translational scalar blocks. This fixed gain metric differs from both the feedforward model inertia and the data-scaling PCA metric G. Its geometric role is to connect twist splitting and wrench generation; it does not eliminate physical angular/linear coupling.

Equations 17–20
Kv​(q)=Λb​(q)​Kdiag,Dv​(q)=Λb​(q)​Ddiag,K_{v}(q)=\Lambda_{b}(q)K_{\rm diag},\qquad D_{v}(q)=\Lambda_{b}(q)D_{\rm diag}, (17)
e˙V+Ddiag​eV+Kdiag​eT=Λb​(q)−1​Fext\dot{e}_{V}+D_{\rm diag}e_{V}+K_{\rm diag}e_{T}=\Lambda_{b}(q)^{-1}F_{\rm ext} (18)
Kv=blkdiag⁡(krot​I3,ktrans​I3),Dv=blkdiag⁡(drot​I3,dtrans​I3),K_{v}=\operatorname{blkdiag}(k_{\rm rot}I_{3},\ k_{\rm trans}I_{3}),\qquad D_{v}=\operatorname{blkdiag}(d_{\rm rot}I_{3},\ d_{\rm trans}I_{3}), (19)
Λ¯=blkdiag⁡(I¯​I3,m¯​I3)≻0,\bar{\Lambda}=\operatorname{blkdiag}(\bar{I}\,I_{3},\ \bar{m}\,I_{3})\succ 0, (20)

Computing Λ ¯ .

Take trace averages of the rotational and translational diagonal inertia blocks at the control origin, discarding anisotropy and cross-coupling in the metric only. Simulation uses flying-gripper inertia; hardware uses FR3 operational inertia at a nominal payload-bearing pose. The actual plant still contains the omitted coupling. Table 6 gives platform-specific snapshots.

Equation 21
I¯:=13​tr⁡(Λω​ω),m¯:=13​tr⁡(Λv​v),ℓΛ:=I¯/m¯,\bar{I}:=\tfrac{1}{3}\operatorname{tr}(\Lambda_{\omega\omega}),\qquad\bar{m}:=\tfrac{1}{3}\operatorname{tr}(\Lambda_{vv}),\qquad\ell_{\Lambda}:=\sqrt{\bar{I}/\bar{m}}, (21)

Scale normalization.

Multiplying the inertia metric by a positive scalar leaves its projectors unchanged and rescales wrench gains. Only the square-root inertia/mass length ratio changes projector geometry. Experiments normalize mass to 1 kg and absorb scale into scalar modal gains. These are not universal physical stiffness constants.

A.3 Body-Frame Tracking Error Definitions

Pose error combines the principal SO(3) logarithm with translation resolved in the current body frame, rather than the full SE(3) logarithm. Desired twist is adjoint-transported before subtracting current twist. The reference-minus-current sign produces restoring feedback. Near zero pose error, the pose-error derivative equals twist error to first order; finite errors require the exact chart relation derived later.

Equation 22
eT=[log⁡(Rb⊤​Rd)∨Rb⊤​(pd−pb)],eV=AdTb−1​Td​Vd−Vb,e_{T}=\begin{bmatrix}\log(R_{b}^{\top}R_{d})^{\vee}\\[2.0pt] R_{b}^{\top}(p_{d}-p_{b})\end{bmatrix},\qquad e_{V}=\mathrm{Ad}_{T_{b}^{-1}T_{d}}\,V_{d}-V_{b}, (22)

Appendix B Configuration Invariance from Lie Subalgebra

A sufficient configuration-invariance condition is that the span of home body screws form a Lie subalgebra. Each Jacobian column is an adjoint-transported home screw; the iterated-bracket expansion keeps it within a bracket-closed span. Equality with the local feasible subspace additionally requires full rank on the configuration range. At singularities only inclusion is guaranteed. Table 3 verifies common joint primitives; these analytic models are reference calculations, not estimator inputs.

Equations 23–24
[V1,V2]=[ω1×ω2ω1×v2−ω2×v1].[V_{1},V_{2}]=\begin{bmatrix}\omega_{1}\times\omega_{2}\\ \omega_{1}\times v_{2}-\omega_{2}\times v_{1}\end{bmatrix}. (23)
Bi(q)=Ade−Bk∧​qk⋯e−Bi+1∧​qi+1Bi,Bk(q)=Bk.B_{i}(q)=\mathrm{Ad}_{e^{-B_{k}^{\wedge}q_{k}}\cdots e^{-B_{i+1}^{\wedge}q_{i+1}}}\,B_{i},\qquad B_{k}(q)=B_{k}. (24)
Ade−Bj∧​qj​V∈𝒮for all ​V∈𝒮.(𝒮​ bracket-closed)\mathrm{Ad}_{e^{-B_{j}^{\wedge}q_{j}}}V\in\mathcal{S}\qquad\text{for all }V\in\mathcal{S}.\qquad(\mathcal{S}\text{ bracket-closed})
Table 3: Configuration-independent primitives and their Lie-subalgebra verification. Body screws B=(ω,v)B=(\omega;v) in the home frame: unit axes n^,d^\hat{n},\hat{d}, axis point pp, helical pitch hh, in-plane unit vectors t^1,t^2⟂n^\hat{t}_{1},\hat{t}_{2}\perp\hat{n}. Every generator bracket lies in the span, so each is a Lie subalgebra and, by Proposition B.1, configuration-independent on its regular set.
Primitive DoF Generators Structure
Revolute (R) 11 (n^;−n^×p)(\hat{n};\,-\hat{n}\times p) Abelian
Prismatic (P) 11 (0;d^)(0;\,\hat{d}) Abelian (any dim)
Helical (H) 11 (n^,h​n^−n^×p)(\hat{n};\,h\hat{n}-\hat{n}\times p) Abelian
Cylindrical (C) 22 (n^;−n^×p),(0;n^)(\hat{n};\,-\hat{n}\times p),\ (0;\,\hat{n}) Abelian
Spherical (S) 33 (e^i;−e^i×p)i=1,2,3(\hat{e}_{i};\,-\hat{e}_{i}\times p)_{i=1,2,3} so⁡(3)\mathrm{so}(3)
Planar (E) 33 (n^; 0),(0;t^1),(0;t^2)(\hat{n};\,0),\ (0;\,\hat{t}_{1}),\ (0;\,\hat{t}_{2}) se⁡(2)\mathrm{se}(2)

Spherical (S), worked.

For three rotations about a common point, the bracket of two generators yields the third; the span is isomorphic to so(3). Planar motion closes similarly as se(2), and shifting the origin changes the basis within the span. One-dimensional screws and the coaxial cylindrical pair commute. Mechanisms lacking this closure can have configuration-dependent body spans.

Equation 25
[B1,B2]=[e^1×e^2e^1×(−e^2×p)−e^2×(−e^1×p)]=[e^3−e^2​p1+e^1​p2]=[e^3−e^3×p]=B3∈𝒮S.[B_{1},B_{2}]=\begin{bmatrix}\hat{e}_{1}\times\hat{e}_{2}\\ \hat{e}_{1}\times(-\hat{e}_{2}\times p)-\hat{e}_{2}\times(-\hat{e}_{1}\times p)\end{bmatrix}=\begin{bmatrix}\hat{e}_{3}\\ -\hat{e}_{2}p_{1}+\hat{e}_{1}p_{2}\end{bmatrix}=\begin{bmatrix}\hat{e}_{3}\\ -\hat{e}_{3}\times p\end{bmatrix}=B_{3}\in\mathcal{S}_{S}. (25)

Appendix C Configuration Dependence and the Global Envelope

Three two-revolute-joint examples show how local dimension two can generate a larger fixed envelope. A distal-axis frame simplifies the screws; a different rigid grasp frame applies one adjoint to all of them. Claims assume nondegenerate axes/offsets and a nonempty interval of distal angles.

U-joint (worked example).

For intersecting perpendicular axes, the rotating proximal screw sweeps two angular directions; the constant distal screw supplies the third. The universal-joint envelope is all three-dimensional rotation, although only two directions are instantaneously feasible.

Equation 26
B2=(e^x; 0),B1​(q2)=(Rx​(−q2)​e^y; 0),𝒮env=span⁡{ωx,ωy,ωz}.B_{2}=(\hat{e}_{x};\,0),\qquad B_{1}(q_{2})=\big(R_{x}(-q_{2})\,\hat{e}_{y};\;0\big),\qquad\mathcal{S}_{\rm env}=\operatorname{span}\{\omega_{x},\,\omega_{y},\,\omega_{z}\}. (26)

Parallel-offset crank (worked example).

For parallel offset axes, subtracting the distal screw leaves translation sweeping the plane. The crank envelope combines z-rotation with x/y translation, dimension three. The off-axis orthogonal door/lever example has envelope dimension four and is a theoretical example rather than an experimental object.

Equations 27–28
B2=(e^z; 0),B1(q2)=(e^z;−Lsinq2e^x−Lcosq2e^y),B_{2}=(\hat{e}_{z};\,0),\qquad B_{1}(q_{2})=\big(\hat{e}_{z};\;-L\sin q_{2}\,\hat{e}_{x}-L\cos q_{2}\,\hat{e}_{y}\big), (27)
𝒮env=span{ωz,vx,vy},dim𝒮env=3(dim𝒮(q)=2).\mathcal{S}_{\rm env}=\operatorname{span}\{\omega_{z},\,v_{x},\,v_{y}\},\qquad\dim\mathcal{S}_{\rm env}=3\quad(\dim\mathcal{S}(q)=2). (28)
Table 4: Global envelope for the three nondegenerate configuration-dependent 22R examples. Screws are expressed in the distal frame {c}\{c\} with origin on the distal joint axis, so B2B_{2} is constant and B1​(q2)=Ade−B2∧​q2​B1B_{1}(q_{2})=\mathrm{Ad}_{e^{-B_{2}^{\wedge}q_{2}}}B_{1}. At every fixed qq the local feasible subspace has dim𝒮⁡(q)=2\dim\mathcal{S}(q)=2; sweeping q2q_{2} over an interval with nonempty interior enlarges the envelope to the listed dimension. Shorthand: ωi=(e^i;0)\omega_{i}=(\hat{e}_{i};0), vi=(0;e^i)v_{i}=(0;\hat{e}_{i}); “≥k\geq k phases” means kk distinct distal angles q2q_{2}.
Mechanism B2B_{2} B1​(q2)B_{1}(q_{2}) 𝒮env\mathcal{S}_{\rm env} dim𝒮env\dim\mathcal{S}_{\rm env} Excitation for full 𝒮env\mathcal{S}_{\rm env}
U-joint (intersecting 2R) (e^x;0)(\hat{e}_{x};0) (Rx​(−q2)​e^y; 0)(R_{x}(-q_{2})\hat{e}_{y};\,0) span⁡{ωx,ωy,ωz}\operatorname{span}\{\omega_{x},\omega_{y},\omega_{z}\} 33 B2B_{2} excited, ≥2\geq 2 phases
Parallel-offset crank (parallel 2R) (e^z;0)(\hat{e}_{z};0) (e^z;−Lsinq2e^x−Lcosq2e^y)(\hat{e}_{z};\,-L\sin q_{2}\,\hat{e}_{x}-L\cos q_{2}\,\hat{e}_{y}) span⁡{ωz,vx,vy}\operatorname{span}\{\omega_{z},v_{x},v_{y}\} 33 ≥3\geq 3 B1B_{1} phases (B2B_{2} redundant)
Door hinge ++ lever (off-axis orthogonal 2R) (e^x;0)(\hat{e}_{x};0) (Rx​(−q2)​e^z,−L​e^x)(R_{x}(-q_{2})\hat{e}_{z};\,-L\,\hat{e}_{x}) span⁡{ωx,ωy,ωz,vx}\operatorname{span}\{\omega_{x},\omega_{y},\omega_{z},v_{x}\} 44 B2B_{2} excited, ≥3\geq 3 phases

Excitation.

A continuous angle sweep spans the sine/cosine-dependent screw components; a finite ensemble needs enough distinct phases and independent joint-velocity excitation to attain the envelope rank. A narrow range or nearly one-dimensional velocity pattern can underrepresent it even when the mechanism has more freedom.

Feasibility versus envelope membership.

The envelope is an outer bound: it contains every feasible twist but may also contain motions impossible at the current configuration. For the crank, both planar translations belong to the envelope while only one is feasible locally. Treating the whole envelope as stiff therefore leaves residual constraint loads, explaining an important experimental limitation.

Appendix D Trajectory-Ensemble Subspace Estimation in the PCA Metric

Because the desired subspace passes through zero, the estimator uses an uncentered second moment. Choosing a twist metric and its characteristic length is necessary before comparing angular and linear motion magnitudes.

D.1 Why a PCA Metric Is Required

Ordinary Euclidean PCA implicitly equates incompatible angular/linear units. G defines the meaningful norm; transformed SVD yields G-orthonormal directions and squared RMS eigenvalues. Rank selection gates square-root eigenvalues against absolute and relative speeds. The floor remains meaningful when the least mode is tiny; the relative gate tracks broader grasp-chain residuals. Threshold success in these calibrated experiments is not a universal rank-identification theorem.

Equations 29–32
⟨V1,V2⟩G:=V1⊤​G​V2,u1=arg⁡maxu⊤​G​u=1​1M​∑ℓ=1M⟨u,Vℓ⟩G2,\langle V_{1},V_{2}\rangle_{G}:=V_{1}^{\top}GV_{2},\qquad u_{1}=\arg\max_{u^{\top}Gu=1}\frac{1}{M}\sum_{\ell=1}^{M}\langle u,V_{\ell}\rangle_{G}^{2}, (29)
L​W\displaystyle LW =U~​Σ~​V~⊤,\displaystyle=\widetilde{U}\,\widetilde{\Sigma}\,\widetilde{V}^{\top}, (SVD of metric-transformed twists) (30)
U\displaystyle U =L−1​U~,\displaystyle=L^{-1}\widetilde{U}, (back-transform to ​se​(3)​)\displaystyle\text{(back-transform to }\mathrm{se}(3)\text{)} (31)
m=#⁡{k:λk>max⁡(κrel​λ6,vabs)},𝒮^env=span⁡{u1,…,um}=range⁡U∥.m=\#\bigl\{k:\sqrt{\lambda_{k}}>\max(\kappa_{\rm rel}\sqrt{\lambda_{6}},\,v_{\rm abs})\bigr\},\qquad\widehat{\mathcal{S}}_{\rm env}=\operatorname{span}\{u_{1},\ldots,u_{m}\}=\operatorname{range}U_{\parallel}. (32)

D.2 Meaning of the Characteristic Length α

The characteristic length converts angular velocity to an equivalent linear scale. Its leading-mode norm ratio is computed in control-frame SI coordinates and clipped; pure translation saturates the upper bound. α is a data-dependent convention, not an invariant object property or the separate inertia length.

Equations 33–34
G=blkdiag⁡(α2​I3,I3),Lα=blkdiag⁡(α​I3,I3),Lα​V=(α​ω,v),G=\operatorname{blkdiag}(\alpha^{2}I_{3},I_{3}),\qquad L_{\alpha}=\operatorname{blkdiag}(\alpha I_{3},I_{3}),\qquad L_{\alpha}V=(\alpha\omega,v), (33)
α=clip⁡(‖uv‖/‖uω‖,αmin,αmax).\alpha=\operatorname{clip}\!\big(\|u_{v}\|/\|u_{\omega}\|,\ \alpha_{\min},\ \alpha_{\max}\big). (34)

D.3 Why the PCA Is Uncentered

Centering removes the outer product of the mean twist, potentially deleting the main task-progress direction. For nearly constant one-DoF motion, uncentered PCA recovers the signal while centered PCA emphasizes residual noise. Exact noiseless recovery requires excitation rank equal to the envelope dimension; noisy recovery further depends on the spectral gap.

Equation 35
M^0=1M​Lα​W​W⊤​Lα⊤,M^c=1M​Lα​Wc​Wc⊤​Lα⊤,M^0−M^c=Lα​V¯​V¯⊤​Lα⊤,\widehat{M}_{0}=\tfrac{1}{M}L_{\alpha}WW^{\top}L_{\alpha}^{\top},\quad\widehat{M}_{c}=\tfrac{1}{M}L_{\alpha}W_{c}W_{c}^{\top}L_{\alpha}^{\top},\quad\widehat{M}_{0}-\widehat{M}_{c}=L_{\alpha}\bar{V}\bar{V}^{\top}L_{\alpha}^{\top}, (35)

Appendix E Inertia-Metric Projectors and Energy-Consistent Gains

The appendix verifies metric-projector algebra and derives gains as local quadratic energy/dissipation Hessians. These algebraic properties alone do not establish global contact stability.

E.1 Λ ¯ -Orthogonal Twist Projectors

For any full-rank estimated basis, its inertia-weighted Gram matrix is positive definite. The resulting projectors are idempotent, complementary and self-adjoint in that metric; they preserve their subspace, annihilate the complement and have zero cross quadratic terms. Inertia-weighted projectors are symmetric positive semidefinite. The Gram inverse is essential when the basis comes from another metric.

Equations 36–39
P∥Λ¯=U∥​A−1​U∥⊤​Λ¯,P⟂Λ¯=I−P∥Λ¯.P_{\parallel}^{\bar{\Lambda}}=U_{\parallel}A^{-1}U_{\parallel}^{\top}\bar{\Lambda},\qquad P_{\perp}^{\bar{\Lambda}}=I-P_{\parallel}^{\bar{\Lambda}}. (36)
Pi⊤​Λ¯​Pi\displaystyle P_{i}^{\top}\bar{\Lambda}P_{i} =(Λ¯​Pi)​Pi=Λ¯​Pi2=Λ¯​Pi,\displaystyle=(\bar{\Lambda}P_{i})P_{i}=\bar{\Lambda}P_{i}^{2}=\bar{\Lambda}P_{i}, (self-adjointness + idempotency) (37)
Pi⊤​Λ¯​Pj\displaystyle P_{i}^{\top}\bar{\Lambda}P_{j} =Λ¯PiPj=0(i≠j),\displaystyle=\bar{\Lambda}P_{i}P_{j}=0\quad(i\neq j), (P∥​P⟂=P∥​(I−P∥)=0P_{\parallel}P_{\perp}=P_{\parallel}(I-P_{\parallel})=0) (38)
x⊤​Λ¯​Pi​x=(37)x⊤​Pi⊤​Λ¯​Pi​x=‖Pi​x‖Λ¯2≥0,x^{\top}\bar{\Lambda}P_{i}x\stackrel{{\scriptstyle\eqref{eq:appE:keyid}}}{{=}}x^{\top}P_{i}^{\top}\bar{\Lambda}P_{i}x=\|P_{i}x\|_{\bar{\Lambda}}^{2}\geq 0, (39)

Dual (wrench) projector.

Wrench projection is the transpose dual of twist projection under the power pairing. A complementary projected wrench does no work on an exactly estimated feasible twist. With subspace estimation error, that ideal reciprocity no longer holds exactly.

E.2 Energy/Rayleigh-Based Gain Derivation

Assign separate quadratic elastic and Rayleigh costs to feasible and complementary errors. Projector identities reduce their Hessians to the proposed stiffness/damping maps. This is a conservative potential for the linearized pose-error dynamics; it is not a globally conservative SE(3) spring for arbitrary finite error.

Equations 40–41
ET(eT)=12∑i∈{∥,⟂}ki∥PiΛ¯eT∥Λ¯2,ℛ(eV)=12∑i∈{∥,⟂}di∥PiΛ¯eV∥Λ¯2.E_{T}(e_{T})=\tfrac{1}{2}\sum_{i\in\{\parallel,\perp\}}k_{i}\,\|P_{i}^{\bar{\Lambda}}e_{T}\|_{\bar{\Lambda}}^{2},\qquad\mathcal{R}(e_{V})=\tfrac{1}{2}\sum_{i\in\{\parallel,\perp\}}d_{i}\,\|P_{i}^{\bar{\Lambda}}e_{V}\|_{\bar{\Lambda}}^{2}. (40)
Kv\displaystyle K_{v} =∇eT2ET=∑iki​Λ¯​PiΛ¯=Λ¯​(k∥​P∥Λ¯+k⟂​P⟂Λ¯),\displaystyle=\nabla^{2}_{e_{T}}E_{T}=\sum_{i}k_{i}\,\bar{\Lambda}P_{i}^{\bar{\Lambda}}=\bar{\Lambda}\bigl(k_{\parallel}P_{\parallel}^{\bar{\Lambda}}+k_{\perp}P_{\perp}^{\bar{\Lambda}}\bigr),
Dv\displaystyle D_{v} =∇eV2ℛ=∑idi​Λ¯​PiΛ¯=Λ¯​(d∥​P∥Λ¯+d⟂​P⟂Λ¯),\displaystyle=\nabla^{2}_{e_{V}}\mathcal{R}=\sum_{i}d_{i}\,\bar{\Lambda}P_{i}^{\bar{\Lambda}}=\bar{\Lambda}\bigl(d_{\parallel}P_{\parallel}^{\bar{\Lambda}}+d_{\perp}P_{\perp}^{\bar{\Lambda}}\bigr), (41)

E.3 Symmetry, PSD, and SPD

Nonnegative modal gains yield symmetric positive-semidefinite maps. Strictly positive gains on both complementary components make stiffness and damping positive definite by the metric Pythagorean identity. The experiments retain small positive complement gains, avoiding unregulated zero-gain error directions.

Equation 42
x⊤​Kv​x=k∥​‖P∥Λ¯​x‖Λ¯2+k⟂​‖P⟂Λ¯​x‖Λ¯2≥min⁡(k∥,k⟂)​‖x‖Λ¯2>0,x^{\top}K_{v}x=k_{\parallel}\|P_{\parallel}^{\bar{\Lambda}}x\|_{\bar{\Lambda}}^{2}+k_{\perp}\|P_{\perp}^{\bar{\Lambda}}x\|_{\bar{\Lambda}}^{2}\geq\min(k_{\parallel},k_{\perp})\,\|x\|_{\bar{\Lambda}}^{2}>0, (42)

Appendix F Closed-Loop Error Dynamics and Local Passivity

The proof studies constant gains, first-order error kinematics and plant inertia frozen at an operating point. It establishes an error-coordinate dissipation inequality for that nominal model, with explicit residual terms explaining why broader claims do not follow.

F.1 Local Error Dynamics

First derive exact local pose-error kinematics within a single rotation-log chart, then linearize and freeze the compensated plant. The gain metric and actual frozen plant inertia remain distinct.

Local error chart.

Relative rotation and body translation errors yield an exact chart matrix using the inverse SO(3) left Jacobian and a translation cross-product block. That matrix becomes identity near zero error, giving the first-order relation. The derivation requires smooth references and a single-valued principal rotation logarithm, away from its cut locus.

Equations 43–44
e˙T=A⁡(eT)​eV,A⁡(eT)=[Jl​(ϕ)−10−ρ∧I3].\dot{e}_{T}=A(e_{T})\,e_{V},\qquad A(e_{T})=\begin{bmatrix}J_{l}(\phi)^{-1}&0\\ -\rho^{\wedge}&I_{3}\end{bmatrix}. (43)
e˙T=eV\dot{e}_{T}=e_{V} (44)

Frozen nominal model.

Substitute modeled feedforward plus spring/damper feedback into the true body dynamics. Freeze the inertia at a positive-definite operating-point value and omit remaining inertia variation, higher-order geometry and model errors. The resulting constant-coefficient impedance equation is the plant used by the certificate, not the full nonlinear robot/object dynamics.

Equation 45
Λ0​e˙V+Dv​eV+Kv​eT=Fext,\Lambda_{0}\,\dot{e}_{V}+D_{v}\,e_{V}+K_{v}\,e_{T}=F_{\rm ext}, (45)

F.2 Storage Function and Local Passivity

Kinetic error energy plus quadratic elastic energy has derivative equal to negative damping dissipation plus the error-twist/contact-wrench supply. Positive stiffness and damping imply exponential stability of the unforced linear frozen model; semidefinite gains imply only the dissipation bound. The supply uses error velocity, so it is not automatically physical contact-port passivity under a moving reference.

Equations 46–49
Kv=∑i∈{∥,⟂}kiΛ¯PiΛ¯,Dv=∑i∈{∥,⟂}diΛ¯PiΛ¯,ki,di≥0,K_{v}=\sum_{i\in\{\parallel,\perp\}}k_{i}\bar{\Lambda}P_{i}^{\bar{\Lambda}},\qquad D_{v}=\sum_{i\in\{\parallel,\perp\}}d_{i}\bar{\Lambda}P_{i}^{\bar{\Lambda}},\qquad k_{i},d_{i}\geq 0, (46)
𝒱⁡(eT,eV)=12​eV⊤​Λ0​eV+ET​(eT),ET​(eT)=12​eT⊤​Kv​eT,\mathcal{V}(e_{T},e_{V})=\tfrac{1}{2}\,e_{V}^{\top}\Lambda_{0}\,e_{V}+E_{T}(e_{T}),\qquad E_{T}(e_{T})=\tfrac{1}{2}e_{T}^{\top}K_{v}e_{T}, (47)
𝒱˙=−eV⊤​Dv​eV+eV⊤​Fext≤eV⊤​Fext.\dot{\mathcal{V}}=-\,e_{V}^{\top}D_{v}\,e_{V}+e_{V}^{\top}F_{\rm ext}\ \leq\ e_{V}^{\top}F_{\rm ext}. (48)
𝒱˙\displaystyle\dot{\mathcal{V}} =eV⊤​Λ0​e˙V+eT⊤​Kv​e˙T\displaystyle=e_{V}^{\top}\Lambda_{0}\,\dot{e}_{V}+e_{T}^{\top}K_{v}\,\dot{e}_{T} (chain rule, KvK_{v} fixed)
=eV⊤​Λ0​e˙V+eV⊤​Kv​eT\displaystyle=e_{V}^{\top}\Lambda_{0}\,\dot{e}_{V}+e_{V}^{\top}K_{v}\,e_{T} (first-order kinematics; Kv=Kv⊤K_{v}=K_{v}^{\top})
=eV⊤​(Fext−Dv​eV−Kv​eT)+eV⊤​Kv​eT\displaystyle=e_{V}^{\top}\!\left(F_{\rm ext}-D_{v}e_{V}-K_{v}e_{T}\right)+e_{V}^{\top}K_{v}\,e_{T} (Eq. (45))
=−eV⊤​Dv​eV+eV⊤​Fext.\displaystyle=-\,e_{V}^{\top}D_{v}\,e_{V}+e_{V}^{\top}F_{\rm ext}. (cancel KvK_{v} terms) (49)

Scope.

The inequality assumes modeled feedforward cancellation, fixed projectors, first-order pose kinematics and frozen plant inertia. Exact geometry adds a higher-order term without fixed sign; changing gains adds an energy-variation term; changing plant inertia and model error add further residual power. Large errors, contact switches or online projector updates can invalidate the bound. No global manipulation stability or exact inertial decoupling is proved.

Appendix G Gain Construction and Scaling

Scalar gains are chosen through natural-frequency/damping-ratio design targets, then multiplied by the normalized inertia metric. The formulas describe the gain convention, while numerical platform settings are separately reported.

G.1 Second-Order Gain Rule

Replacing the frozen plant inertia by the surrogate produces a normalized modal design equation. Match its stiffness to squared natural frequency and damping to twice damping ratio times natural frequency. This decoupled scalar design model is not a claim that the real coupled plant has the same modes or damping ratio.

Equations 50–52
Λ¯​e˙V+Dv​eV+Kv​eT=Fext,e˙T=eV,\bar{\Lambda}\dot{e}_{V}+D_{v}e_{V}+K_{v}e_{T}=F_{\rm ext},\qquad\dot{e}_{T}=e_{V}, (50)
z¨+d​z˙+k​z=fz,(k,d)∈{(k∥,d∥),(k⟂,d⟂)}.\ddot{z}+d\,\dot{z}+k\,z=f_{z},\qquad(k,d)\in\{(k_{\parallel},d_{\parallel}),(k_{\perp},d_{\perp})\}. (51)
k=ωn2,d=2​ζ​k=2​ζ​ωn,k=\omega_{n}^{2},\qquad d=2\zeta\sqrt{k}=2\zeta\omega_{n}, (52)

G.2 Iso, Ours, and Oracle Gains

Iso, Ours and Oracle share the same feasible stiffness and damping targets. A single complement stiffness ratio r changes only the constrained side; r=1 recovers Iso.

Iso.

Equal gains collapse the projector split into block-isotropic inertia-weighted stiffness/damping. Iso therefore needs no subspace estimate and provides the reference load baseline.

Equation 53
k∥=k⟂=k0,d∥=d⟂=d0=2​ζ​k0,k_{\parallel}=k_{\perp}=k_{0},\qquad d_{\parallel}=d_{\perp}=d_{0}=2\zeta\sqrt{k_{0}}, (53)

Ours.

Ours sets complement stiffness to r times the reference and complement damping to √r times reference damping, preserving the normalized damping ratio. At r=0.1, damping is not reduced by the same 0.1 factor. Feasible gains remain identical to Iso.

Equation 54
d⟂\displaystyle d_{\perp} =2​ζ​k⟂\displaystyle=2\zeta\sqrt{k_{\perp}} (inversion (52) at fixed ζ\zeta)
=2​ζ​r​k0=r​d0.\displaystyle=2\zeta\sqrt{r\,k_{0}}=\sqrt{r}\,d_{0}. (r\sqrt{r} damping factor) (54)

Oracle.

Oracle uses the identical scalar rule and analytic grasp-conditioned reference subspace. In simulation its difference from Ours isolates subspace estimation within this setup, rather than a different compliance magnitude.

Appendix H Experimental Configuration

Implementation details specify estimator thresholds, inertia/gain values, policy training, demonstration coverage, sensing and trial scoring. These details are necessary to interpret both the load reductions and the theoretical assumptions.

H.1 Hyperparameters

Table 5 preserves common horizon, ensemble, sampling, characteristic-length clipping and threshold settings. Platform-specific gains are in Table 6.

Table 5: Common configuration. Estimation and control hyperparameters shared across all simulated and real-world mechanisms. The reduction ratio rr and damping ratio ζ\zeta define the complement gains via Appendix G.2; per-platform numerical gain values are in Table 6.
Group Symbol Value
Estimation Ensemble size NN 128128 (simulation); 3232 (real)
Trajectory horizon HH 2424
Absolute threshold vabsv_{\rm abs} 55 mm/s (simulation); 33 mm/s (real).
Relative threshold κrel\kappa_{\rm rel} 44 (simulation); 1010 for revolute, prismatic, helical, and cylindrical objects and 44 for the crank (real).
Sampler at grasp closure DDIM, 1010 steps (simulation); DDPM, 100100 steps (real).
Characteristic-length clip [αmin,αmax][\alpha_{\min},\alpha_{\max}] [0.03, 0.5][0.03,\,0.5]
Finite-difference timestep Δ​t\Delta t (s) 0.10.1
Control Modal gains k∥,k⟂,d∥,d⟂k_{\parallel},k_{\perp},d_{\parallel},d_{\perp} Per-platform; see Table 6.
Reduction ratio rr 0.100.10 (Ours, Oracle); 1.01.0 (Iso).

Dimension-selection thresholds.

Calibrate the absolute gate from residual speed on known constraint-consistent training examples and the relative gate from intended grasp-chain compliance/clearance. The absolute gate alone selects correct dimension in all 398 successfully grasped simulation trials; the relative gate alone does so in all 50 hardware trials using the crank-specific value 4. These thresholds use prior calibration and an object-specific exception despite requiring no articulation model online.

Sensitivity to the characteristic length.

One representative real rollout per object varies α by factors 0.25, 0.5, 2, 4 at fixed dimension. The largest subspace change is 1.7° under the inertia metric. Figure 4 retains all 25 stiffness matrices: changing α rotates the estimated split but does not rescale the fixed modal gains. This small sample sensitivity study is not a full robustness guarantee.

Refer to caption
Figure 4: Stiffness-gain matrices over the real FR3 α\alpha sweep. Each panel shows the decomposed stiffness matrix Kv=Λ¯​(k∥​P∥Λ¯+k⟂​P⟂Λ¯)K_{v}=\bar{\Lambda}(k_{\parallel}P_{\parallel}^{\bar{\Lambda}}+k_{\perp}P_{\perp}^{\bar{\Lambda}}) in body-twist order (ωx,ωy,ωz,vx,vy,vz)(\omega_{x},\omega_{y},\omega_{z},v_{x},v_{y},v_{z}). Rows correspond to real tasks, one rollout each (the one with the median SE), and columns to α/α0∈{0.25,0.5,1,2,4}\alpha/\alpha_{0}\in\{0.25,0.5,1,2,4\}, with α0\alpha_{0} the clipped estimate of Eq. (34). Printed numbers are the physical matrix entries; cell color encodes the signed, per-task-normalized value (blue <0<0, red >0>0). All five tasks vary little across the sweep.

H.2 Numerical Gain Values

Table 6 gives flying-gripper and FR3 inertia snapshots and gains. The mass-normalized convention uses 1 kg; the chosen damping ratio critically damps the surrogate design model, not a measured robot/object system. Ours/Oracle reduce complement stiffness by 0.1 while Iso uses 1.

Table 6: Numerical inertia and gain values. Per-platform inertia-metric parameters and the decomposed scalar gains under the construction of Appendix G.2. The inertia columns use kg, kg⋅\cdotm2, and m for m¯\bar{m}, I¯\bar{I}, and ℓΛ\ell_{\Lambda}, respectively. The scalar gains k∥,k⟂k_{\parallel},k_{\perp} and d∥,d⟂d_{\parallel},d_{\perp} are normalized modal gains with units s-2 and s-1; physical wrench-level stiffness and damping units arise only after forming KvK_{v} and DvD_{v} with the normalized metric of Appendix A.2. The damping ratio ζ=m¯/mref\zeta=\sqrt{\bar{m}/m_{\rm ref}} of this normalized design model makes every mode critically damped for the physical surrogate inertia; it is not a measured damping ratio of the robot–object system. Iso uses r=1r=1.
Platform m¯\bar{m} I¯\bar{I} ℓΛ\ell_{\Lambda} k0k_{0} rr ζ\zeta k∥k_{\parallel} k⟂k_{\perp} d∥d_{\parallel} d⟂d_{\perp}
Flying gripper (sim) 0.5860.586 0.006220.00622 0.1030.103 250250 0.100.10 0.7660.766 250250 2525 24.2124.21 7.667.66
FR3 (real) 7.707.70 0.7240.724 0.3070.307 400400 0.100.10 2.7752.775 400400 4040 111111 35.135.1

H.3 Implementation Details

All comparisons share policy interfaces and training checkpoints. Simulation and real control have different feedforward, rate and data details, preserved below.

Policy.

Object-specific Diffusion Policies train from scratch. A separate simulation policy trains equally on all four objects without a task identifier. Table 7 preserves the CNN/diffusion training recipe, relative pose-action interface and checkpoint-selection rules; diversity is inherited from the demonstrations rather than enforced by the controller.

Table 7: Diffusion Policy training configuration. Common policy interface and training recipe used for the per-object checkpoints and the simulated multi-task checkpoint.
Setting Value
Backbone Diffusion Policy [21]
Observation history 11 step
Predicted / executed action horizon 2424 / 1616 steps
Policy sampling period 0.10.1 s (1010 Hz)
Observation 224×224224\times 224 wrist RGB, end-effector pose (position ++ 66-D rotation), and gripper opening (ℝ10\mathbb{R}^{10})
Action Per-step ℝ10\mathbb{R}^{10} relative pose chunk in the current EE frame: pose (99) and gripper command (11)
Visual encoder ResNet-18 + spatial softmax
Denoising steps (train / infer) 100100 / 1010 DDIM (simulation), 100100 DDPM (real)
Optimizer AdamW, β=(0.95,0.999)\beta=(0.95,0.999), weight decay 10−610^{-6}
Learning rate 10−410^{-4}, cosine decay
Batch size 6464
Training length / checkpoint Sim: 500500 steps/epoch; the first checkpoint (saved every 5050 epochs) after the validation-loss minimum, epoch 250250/150150/100100/150150 for revolute/cylindrical/planar/universal; multi-task: epoch 400400, the validation minimum. Real: 4040 steps/epoch, 600600 epochs; epoch-150150 (66k steps)

Platforms.

Simulation uses a gravity-free flying gripper at 150 Hz with zero desired twist and feedforward, omitting Coriolis/reference-acceleration terms. Hardware uses torque-controlled FR3 with dense desired poses at 1 kHz and aligned evaluation recording at 100 Hz. Thus the full nominal dynamic cancellation proof is not a claim that every experimental implementation exactly realizes those assumptions.

Simulation demonstration data.

Collect 400 scripted demonstrations per simulated object using analytic handle kinematics, withheld from the policy/estimator/controller at evaluation. Randomized object poses and independently timed smooth joint-coordinate profiles span synchronous through sequential multi-DoF motions. A fixed schedule would undermine the motion coverage needed for subspace recovery. Table 8 preserves placement ranges and grasp setup.

Table 8: Simulation policy data. Demonstration collection details for the four simulated objects (interface as in Table 7). Stored actions are absolute end-effector poses, converted to relative pose chunks for training. Placement is in the simulator world frame relative to the object origin (0.5,0,0.5)(0.5,0,0.5) m.
Item Value
Demonstrations 400400 scripted rollouts per object
Object placement Uniform x∈[−0.15,0.15]x\in[-0.15,0.15], y∈[−0.20,0.20]y\in[-0.20,0.20], z∈[−0.10,0.10]z\in[-0.10,0.10] m, yaw ∈[−15∘,15∘]\in[-15^{\circ},15^{\circ}]
Gripper start Fixed at (−0.1,0,0.5)(-0.1,0,0.5) m before approach and grasp
Waypoint generation Object progress mapped to handle poses by analytic forward kinematics, interpolated on SE⁡(3)\mathrm{SE}(3)

Real-world demonstration data.

Leader–follower teleoperation supplies 20 demonstrations each for revolute/prismatic/helical and 32 each for cylindrical/crank. Train on the follower’s actual constrained end-effector poses, not leader commands. This makes observed actions approximately feasible despite imperfect commands and is central to the estimator’s validity. Data are recorded at 10 Hz.

Contact and force sensing.

Simulation contact wrenches and an ATI Axia 80 wrist sensor supply evaluation and safety monitoring. No wrench feedback enters the proposed estimator or impedance law. Both hardware controllers share tuned safety thresholds and a common articulation interval.

Evaluation metrics.

Project force and moment separately using linear/angular blocks of the analytic reference; these marginal diagnostics are not a full screw-coupled reciprocal-wrench norm. Load fractions λ measure complementary measured impulse, whereas feedback fractions β measure reference-parallel commanded feedback, excluding feedforward. Structural empty blocks produce predetermined fractions. Evaluate principal-angle error with a fixed geometry-derived length per object, not each estimator’s chosen α. Simulation success counts grasp/target failures, while wrench means use the common-success set. All ten physical trials are retained and compared over the same absolute articulation target.

Equations 55–56
ICF =∫‖f⟂‖​𝑑t,\displaystyle=\!\int\!\|f_{\perp}\|\,\mathrm{d}t, ICM =∫‖τ⟂‖​𝑑t,\displaystyle=\!\int\!\|\tau_{\perp}\|\,\mathrm{d}t, (N⋅\cdots, N⋅\cdotm⋅\cdots) (55)
PCF =Q95​(‖f⟂‖),\displaystyle=Q_{95}(\|f_{\perp}\|), PCM =Q95​(‖τ⟂‖),\displaystyle=Q_{95}(\|\tau_{\perp}\|), (N, N⋅\cdotm) (56)

Evaluation sampling.

Use 100 trials per simulated controller/object for both policy types and ten per physical pair, with the hardware epoch 150 checkpoint. Estimate gains once at completed grasp; simulation blends from isotropic gains over 50 control steps (about 0.33 s) before holding them fixed. The transient blend is not included in the fixed-gain passivity proof.

End-to-end real-rollout visualization.

Figure 5 retains each real task’s 32-trajectory ensemble, singular spectrum/rank gate, weighted basis, inertia-projector matrix and final stiffness/damping entries. It demonstrates the full numerical pipeline rather than only final scalar load results.

Refer to caption
Figure 5: From trajectory ensemble to constraint-decomposed impedance on the real FR3. Each row is one real task, ordered by the estimated feasible dimension m^\hat{m} (revolute/prismatic/helical m^=1\hat{m}{=}1, cylindrical m^=2\hat{m}{=}2, crank m^=3\hat{m}{=}3); all matrices are in the gripper body frame at the grasp pose. The columns trace the pipeline of Algorithm 1: (1) the grasp-closure ensemble (N=32N=32) recentered on the grasp point and colored by sample index, with the selected tracking trajectory highlighted and the body frame (xb,yb,zb)(x_{b},y_{b},z_{b}) drawn as the red/green/blue triad; (2) the singular-value ratio σ~k2/σ~62\widetilde{\sigma}_{k}^{2}/\widetilde{\sigma}_{6}^{2} =λk/λ6=\lambda_{k}/\lambda_{6} and the dimension gate κrel2\kappa_{\rm rel}^{2} (dashed) selecting m^\hat{m}; (3) the retained PCA-scaled basis U~∥=Lα​U∥\widetilde{U}_{\parallel}=L_{\alpha}U_{\parallel}, rows ordered (ωx,ωy,ωz,vx,vy,vz)(\omega_{x},\omega_{y},\omega_{z},v_{x},v_{y},v_{z}); (4) the projector building block Λ¯​P∥Λ¯\bar{\Lambda}P_{\parallel}^{\bar{\Lambda}} (Appendix E.1); and (5) the resulting stiffness Kv=k⟂​Λ¯+(k∥−k⟂)​Λ¯​P∥Λ¯K_{v}=k_{\perp}\bar{\Lambda}+(k_{\parallel}-k_{\perp})\bar{\Lambda}P_{\parallel}^{\bar{\Lambda}}, with the damping entries DvD_{v} in parentheses. Printed numbers are the physical entries; cell color encodes the signed, per-task-normalized value (blue <0<0, red >0>0; as in Fig. 4).

Appendix I Simulation Experiments: Additional Results and Diagnostics

Table 9 reports force/moment fractions over matched three-controller successful episodes. Ours shifts feedback toward the reference-feasible block and generally lowers complementary measured load. The analytic reference and inclusion rules remain common across controllers.

Table 9: Simulation rollout diagnostics (auxiliary to Table 1 and Table 10). Entries are Iso / Ours / Oracle. ncn_{c} is the three-controller common-success count for wrench metrics. λf,λm\lambda_{f},\lambda_{m} are the force/moment complement load fractions, βf,βm\beta_{f},\beta_{m} the force/moment-side feedback feasible fractions (Appendix H.3; βm≡1\beta_{m}{\equiv}1 for the universal joint, whose angular complement is empty).
Task ncn_{c} λf\lambda_{f} λm\lambda_{m} βf\beta_{f} βm\beta_{m}
Single-task policies
Revolute 099 .26 / .12 / .10 .245 / .177 / .181 .75 / .92 / .95 .86 / .96 / .96
Cylindrical 099 .15 / .03 / .02 .122 / .086 / .084 .85 / .98 / .98 .94 / .98 / .98
Planar 099 .68 / .21 / .24 .114 / .077 / .057 .32 / .81 / .78 .90 / .95 / .98
Universal 100 .31 / .14 / .11 .000 / .000 / .000 .69 / .87 / .91 1.00 / 1.00 / 1.00
Multi-task policy
Revolute 099 .27 / .13 / .11 .242 / .197 / .190 .74 / .92 / .94 .86 / .96 / .95
Cylindrical 095 .13 / .04 / .02 .119 / .076 / .077 .87 / .96 / .98 .93 / .98 / .98
Planar 100 .68 / .22 / .24 .112 / .078 / .056 .32 / .81 / .78 .90 / .95 / .98
Universal 099 .29 / .14 / .11 .000 / .000 / .000 .72 / .88 / .92 1.00 / 1.00 / 1.00

Multi-task policy.

The shared four-object policy preserves the main effect: force impulse becomes 0.14–0.37 of Iso, recovering at least 80% of the Oracle force improvement. Table 10 retains all success counts and complementary moment results.

Table 10: Simulation results with one multi-task policy. Entries are Iso / Ours / Oracle. In Table 1 and here, SR counts all trials, and the other entries are means over the trials in which all three controllers succeed; SE reports Ours only, and boldface marks the better of Iso and Ours.
Task SR (%) SE (°) ICF (N⋅\cdots) PCF (N) ICM (N⋅\cdotm⋅\cdots) PCM (N⋅\cdotm)
Revolute 099 / 099 / 099 1.71 7.75 / 2.87 / 2.55 3.55 / 1.76 / 1.81 .31 / .26 / .26 .21 / .22 / .22
Cylindrical 096 / 097 / 096 2.39 4.61 / 1.36 / 0.64 1.74 / 0.67 / 0.51 .31 / .20 / .21 .15 / .13 / .15
Planar 100 / 100 / 100 2.76 14.4 / 2.02 / 2.21 3.85 / 1.13 / 1.13 .73 / .49 / .34 .29 / .24 / .22
Universal 099 / 100 / 100 3.83 1.98 / 0.45 / 0.33 1.17 / 0.23 / 0.19 – / – / – – / – / –

Ensemble size and runtime.

Table 11 shows errors decreasing sharply through four samples and more slowly afterward. Perfect dimension selection begins at 64 samples. The 70.1 ms runtime is the median of four per-object medians across 120 runs; 76.5 ms is the overall maximum, not a hardware control-loop period.

Table 11: Ensemble-size sweep in simulation. 95th-percentile SE with the dimension fixed to its true value, and the fraction of trials in which the dimension rule selects the true dimension, pooled over the four objects.
NN SE, 95th percentile (°) Correct dimension (%)
11 78.9578.95 64.764.7
22 23.1523.15 84.284.2
44 8.598.59 92.892.8
88 7.237.23 97.797.7
1616 6.926.92 99.499.4
3232 6.796.79 99.899.8
6464 6.686.68 100100
128128 6.616.61 100100

Sample diversity.

The diversity study selects extreme subsets among 4,012 candidate subsets of each ensemble. Benefits are largest up to 16 samples and nearly disappear at 32–64. This post-hoc selection study explains coverage; it is not the deployed collection algorithm.

Table 12: Sample-diversity study in simulation. Subspaces re-estimated from the kk most (DTW-max) or least (DTW-min) diverse samples of each 128128-sample ensemble; the last column uses all 128128 samples.
Statistic Selection k=2k{=}2 44 88 1616 3232 6464 128128
Mean of per-object DTW-max 5.915.91 3.323.32 2.742.74 2.612.61 2.482.48 2.492.49 2.342.34
median SE (°) DTW-min 19.7319.73 9.939.93 4.454.45 3.433.43 2.582.58 2.432.43 2.342.34
Grasps with DTW-max 16.016.0 8.88.8 2.82.8 2.32.3 1.81.8 1.01.0 1.01.0
SE >10∘>10^{\circ} (%) DTW-min 40.540.5 28.028.0 13.813.8 9.59.5 1.51.5 1.51.5 1.01.0

Robustness to noise.

Table 13 separates action-noise training/direct injection, image corruption and denoising-count effects. Five-degree demonstration noise still produces 10.59° median error even if policy validation loss/success appear acceptable. Two DDIM steps yield 87.38° error, a clear failure outside the reported 4–100-step robustness range.

Table 13: Robustness to noise in simulation. Pooled median SE (°) over the four objects at N=128N{=}128. (a) Noise of the same amplitude added directly to the sampled trajectories or to the demonstrations before training. (b) Image perturbations of the observation: Gaussian noise (σ=32/255\sigma{=}32/255), Gaussian blur (σ=2\sigma{=}2 px), and random shift (σ=4\sigma{=}4 px). (c) Number of DDIM steps at inference.

(a) Training data

Noise Direct Trained Ratio
None 2.142.14 2.022.02 –
Position 55 mm 11.9711.97 3.103.10 0.260.26
Orientation 5∘5^{\circ} 16.0516.05 10.5910.59 0.660.66

(b) Observations

Perturbation SE
None 2.102.10
Gaussian noise 2.212.21
Gaussian blur 2.122.12
Random shift 2.142.14

(c) Inference

DDIM steps SE
100100 2.162.16
1010 2.142.14
88 2.122.12
66 2.142.14
44 2.262.26
22 87.3887.38

Appendix J Real-World Experiments: Additional Results and Diagnostics

Table 14 preserves every real auxiliary load/feedback fraction. Mean complementary fractions decline, but force fraction rises slightly for helical and more for crank; the crank nevertheless improves moment alignment substantially. Prismatic moment fractions are structural because it has no feasible rotational component. These diagnostics complement, rather than replace, the matched-progress force/moment magnitudes.

Table 14: Real-world auxiliary diagnostics. Entries are Iso / Ours (Ours/Iso) arithmetic means over the same 1010 rollouts per task as Table 2. λf,λm\lambda_{f},\lambda_{m} are the measured force/moment load fractions and βf,βm\beta_{f},\beta_{m} the feedback feasible fractions of Appendix H.3. The rotational block of prismatic is structurally complementary (λm=1\lambda_{m}{=}1, βm=0\beta_{m}{=}0).
Task λf\lambda_{f} λm\lambda_{m} βf\beta_{f} βm\beta_{m}
Revolute .766 / .672 (.88) .734 / .522 (.71) .738 / .843 (1.14) .717 / .848 (1.18)
Prismatic .362 / .321 (.89) 1.000 / 1.000 (1.00) .848 / .918 (1.08) .000 / .000 (–)
Helical .412 / .424 (1.03) .724 / .569 (.79) .187 / .332 (1.78) .751 / .890 (1.18)
Cylindrical .244 / .126 (.52) .536 / .421 (.79) .708 / .894 (1.26) .572 / .680 (1.19)
Crank .425 / .469 (1.10) .926 / .850 (.92) .841 / .892 (1.06) .261 / .550 (2.11)
Concept demonstration

Open image ↗