Collision-aware joint stepping (physically plausible motion constraints) (INTERESTING)

[SaltyJoss]

Fixes:

• Gate joint angle updates: try-step -> FK -> collision check -> accept/reject ~ RESEARCH
• Add bisection/substepping for smooth movements ~ RESEARCH
• Integrate into command system (RotateBy, etc.) with clear failure states ~ RESEARCH