Current child-relative joint rotation.
OptionalfeedOptional joint-frame torque feed-forward, N m, scaled by strength.
Joint whose declared axes, gains and caps are commanded.
Tracking fraction in [0, 1].
Target child-relative joint rotation.
Target relative angular velocity in the joint frame, rad/s.
Native substep, seconds; positive.
Current relative angular velocity in the joint frame, rad/s.
The bounded quaternion PD command of one joint for the native implicit velocity motors.
A native positional motor measures 2 asin(qi) while using the plain joint axis as its Jacobian, which disagrees under compound rotations. The error is therefore the geodesic rotation vector of target times inverse current, on the short arc. Each axis drives an implicit velocity motor with damping d = (c + k dt) strength-scaled plus passive damping and target speed (k e + c_active w_target + f strength) / d_active+passive, the backward-Euler form of PD with stiffness k = stiffness strength. With positive strength the requested velocity is projected into the joint's twist-limit box for the next substep. The cap is the axis torque when any gain is active and zero otherwise. Saturation is a demand forecast |d (speed - velocity)| > cap, because the native SDK exposes no solved motor impulse.