Previous attempts failed:
- v1 (all 4 frames = measured): zero velocity → slow then jerky
- v2 (frame 0 override): 26deg discontinuity → instant chaos
New approach: fill all 4 frames from planner trajectory first, then
blend ONLY joint positions toward measured values uniformly (alpha=0.5).
Position/quaternion stay from planner. Uniform blending preserves
inter-frame velocity (scaled by 0.5) with no discontinuities.
Co-Authored-By: Claude Opus 4.6 <noreply@anthropic.com>