Policy-feasible kinesthetic teaching Operator-applied forces are routed through constrained admittance control, allowing direct physical guidance while shaping demonstrations with the same action parameterization and motion limits used during autonomous rollout.
High-frequency execution stack Cartesian delta commands are issued at policy rate, shaped by a third-order reference generator, and tracked by a compensated 1 kHz Cartesian impedance controller.
Real-world ablation and evaluation The evaluation separates controller-stack effects from kinesthetic-guidance effects across four contact-rich insertion and industrial assembly tasks.
Admittance Controller Admittance controller x¨ ad = Ma -1 ( fext - Da x˙ ad - Ka x˜ ad ) ead = Log ( Tad T EE -1 ) x˙ ad = ∫ x¨ ad dt , Tad = exp ( V^ Δt ) T ad prev , V^ = [ [ ω ] x v 0 0 ] Paper notation: K_a is set to 0 for free Cartesian guiding. Admittance mass Admittance damping Admittance stiffness
Reference Generator Reference generator Tπ = TEE Ta , x˙ π = kv Log ( Tπ T EE -1 ) , x¨ π = 0 ( Tref,d , x˙ ref,d , x¨ ref,d ) = { ( Tad , x˙ ad , x¨ ad ) σ=1 ( Tπ , x˙ π , x¨ π ) σ=0 x⃛ ref = a2 ( x¨ ref,d - x¨ ref ) + a1 ( x˙ ref,d - x˙ ref ) + a0 Log ( Tref,d T ref -1 ) x⃛ ref = ω3 Log ( Tref,d T ref -1 ) + 3ω2 ( x˙ ref,d - x˙ ref ) + 3ω ( x¨ ref,d - x¨ ref ) x⃛ ref = clip ( x⃛ ref , x⃛ lim ) , x¨ ref = clip ( x¨ ref , x¨ lim ) , x˙ ref = clip ( x˙ ref , x˙ lim ) The paper chooses a triple pole at -omega for this critically damped filter. Bandwidth ω Velocity limit Acceleration limit Jerk limit
Impedance Controller Impedance controller τimp = J ( q ) T ( Λ x¨ ref + Dx ( Λ , Kx ) x˙ ˜ + Kx x˜ - Λ J˙ ( q˙ ) q˙ + 0.5 Λ˙ x˙ ˜ ) τnull = N ( Dnull q˙˜ + Knull q˜ ) τd = τimp + τnull + C ( q , q˙ ) q˙ + g ( q ) C2 fimp = Dx (M,J) x˙ + Kx e C3 fimp = Dx x˙ + Kx e C4 fimp = Dx x˙ + Kx e + ∫ ki e dt C5 fimp = Dx x˙ + Kx clip ( e , elim ) Here x tilde = Log(T_ref T_EE^-1), matching the paper's Cartesian pose error. Inertia scale Stiffness Kx Damping ζ