Chen Xiaohong, Huang Zhipeng, Sun Yuanxi, Zhong Yuanhong, Gu Rui, Bai Long
State Key Laboratory of Mechanical Transmission, College of Mechanical and Vehicle Engineering, Chongqing University, Chongqing, 400044 China.
Chongqing Key Laboratory of Metal Additive Manufacturing (3D Printing), Chongqing University, Chongqing, 400044 China.
J Intell Robot Syst. 2022;105(1):7. doi: 10.1007/s10846-022-01620-5. Epub 2022 Apr 21.
The application of Middle-sized Car-like Robots (MCRs) in indoor and outdoor road scenarios is becoming broader and broader. To achieve the goal of stable and efficient movement of the MCRs on the road, a motion planning algorithm based on the Hybrid Potential Field Model (HPFM) is proposed in this paper. Firstly, the artificial potential field model improved with the eye model is used to generate a safe and smooth initial path that meets the road constraints. Then, the path constraints such as curvatures and obstacle avoidance are converted into an unconstrained weighted objective function. The efficient least-squares & quasi-Newton fusion algorithm is used to optimize the initial path to obtain a smooth path curve suitable for the MCR. Finally, the speed constraints are converted into a weighted objective function based on the path curve to get the best speed profile. Numerical simulation and practical prototype experiments are carried out on different road scenes to verify the performance of the proposed algorithm. The results show that re-planned trajectories can satisfy the path constraints and speed constraints. The real-time re-planning period is 184 ms, which demonstrates the proposed approach's effectiveness and feasibility.
中型类汽车机器人(MCR)在室内外道路场景中的应用越来越广泛。为实现MCR在道路上稳定高效运动的目标,本文提出了一种基于混合势场模型(HPFM)的运动规划算法。首先,利用改进的基于眼模型的人工势场模型生成满足道路约束的安全平滑初始路径。然后,将曲率和避障等路径约束转化为无约束加权目标函数。采用高效的最小二乘法和拟牛顿法融合算法对初始路径进行优化,得到适合MCR的平滑路径曲线。最后,基于路径曲线将速度约束转化为加权目标函数,以获得最佳速度曲线。在不同道路场景下进行了数值模拟和实际原型实验,验证了所提算法的性能。结果表明,重新规划的轨迹能够满足路径约束和速度约束。实时重新规划周期为184毫秒,证明了所提方法的有效性和可行性。