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