4TM00 (2025-GS2) Robot motion planning and control