From Multi-Modal Paths to Executable Trajectories: A Trajectory Planning Framework for 4WIS Robots
Organizations: Department of Mechanical and Automation Engineering, The Chinese University of Hong Kong, Shatin, N.T., Hong Kong SAR, China · School of Automation, Beijing Institute of Technology, Beijing 100081, China · Institute of Intelligence Technology and Robotic Systems, Shenzhen Research Institute of Nankai University, Shenzhen 518000, China
Abstract
Four-wheel independent steering (4WIS) mobile robots support multiple motion modes, offering high maneuverability in narrow and complex environments. However, existing planning methods often fail to fully exploit these capabilities, leading to suboptimal trajectory quality. To address this limitation, this paper proposes a multi-modal global trajectory planning framework that couples mode-augmented front-end search with mode-consistent segment-wise trajectory optimization. In the front-end stage, Hybrid A* is extended to a four-dimensional state space incorporating motion modes, while mode-switching-aware cost and heuristic functions embed mode decisions into the global search process. Multi-modal Reeds-Shepp curves and an intelligent terminal connection strategy are further designed to improve search efficiency. In the back-end stage, a segment-wise trajectory optimization framework based on an improved iterative safe corridor scheme is developed to convert discrete multi-modal paths into smooth, kinematically feasible trajectories with stationary mode transitions. Experimental results show that the proposed method achieves the best overall performance in safety, arrival time, terminal accuracy and computation time. Real-world experiments on a physical 4WIS robot further validate the practical effectiveness and executability of the generated trajectories, providing a flexible and high-performance solution for multi-modal mobile robot trajectory planning.
Figures & tables
| Parameter | Value | Parameter | Value |
| 1. Robot Physical and Kinematic Parameters | |||
| Length ( ) | 1.00 m | Width ( ) | 0.62 m |
| Wheelbase ( ) | 0.68 m | Track width ( ) | 0.52 m |
| Max steering angle ( ) | Max steering rate ( ) | /s | |
| Mode switch time ( ) | 0.4 s | Max acceleration ( ) | 5.0 m/s 2 |
| Reference velocity ( ) | 1.0 m/s | Max velocity ( ) | 1.0 m/s |
| Scenario | Method | Experimental Metrics | ||||||||
|---|---|---|---|---|---|---|---|---|---|---|
| SF | TL (m) | AT (s) | AC (m -1 ) | MC (m -1 ) | TPE (m) | TYE (rad) | SMR | CT (ms) | ||
| Env1 | ICR | ✗ | 43.623 | 55.008 | 0.256 | 1.511 | 0.000 | 0.000 | 0.728 | 31293 |
| MPPI | ✓ | 43.587 | 58.550 | 0.202 | 2.082 | 0.095 | 0.087 | 0.904 | 26097 | |
| Single-SC | ✓ | 48.396 | 49.592 | 0.186 | 1.695 | 0.000 | 0.000 | 1.000 | 9074.1 | |
| Multi-SC | ✓ | 45.790 | 46.387 | 0.193 | 1.695 | 0.000 | 0.000 | 1.000 | 5526.0 | |
| Env2 | ICR | ✗ | 15.146 | 19.759 | 0.310 | 1.616 | 0.000 | 0.000 | 0.715 | 2881.8 |
| Method | Experimental Metrics | ||||
|---|---|---|---|---|---|
| SF | TL (m) | TPE (m) | TYE (rad) | CT (ms) | |
| Only MP | ✓ | 18.700 | 0.202 | 0.003 | 116.8 |
| MP+RS | ✓ | 18.745 | 0.000 | 0.000 | 185.0 |
| MP+SCH | ✓ | 15.500 | 0.195 | 0.003 | 131.8 |
| Full | ✓ | 15.235 | 0.000 | 0.000 | 35.44 |
Robot Motion Planning
Robot motion planning finds safe, feasible paths and trajectories for robots moving through constrained, changing environments.
See all 274 papers