目的 针对码垛机器人在运动过程中存在的避障路径规划与运动效率不足的问题,开展码垛机器人避障路径规划与运动轨迹优化研究。方法 首先,采用五次B样条曲线构建码垛机器人运动轨迹,并提出一种两阶段RRT算法进行避障路径规划。该算法在探索阶段引入启发式采样策略和优先队列策略,以提高搜索效率;在优化阶段采用即时传播成本更新机制,以加速最优路径的收敛。在所得避障路径的基础上,以时间最优为目标,提出一种多策略改进粒子群算法,该算法融合了多模态自适应参数调整机制、量子行为增强策略和分层精英学习策略,对码垛机器人运动轨迹进行优化。结果 实验结果表明,两阶段RRT算法可使码垛机器人在无碰撞条件下从起点运动至目标点,其搜索效率和路径长度均优于传统RRT及其改进算法;经多策略改进粒子群算法优化后,码垛机器人运动时间为37.42 s,相比于自适应权重粒子群算法与标准粒子群算法,运动效率分别提高了23.29%和26.41%。结论 两阶段RRT*算法与多策略改进粒子群算法的协同作用,为码垛机器人规划出一条合理可行的作业路径,在确保避障安全的同时显著缩短了运动时间。
Abstract
The work aims to optimize both obstacle avoidance path planning and motion trajectory of palletizing robots so as to address the issues of insufficient obstacle avoidance path planning and motion efficiency in palletizing robots during operation. Firstly, the motion trajectory of a palletizing robot was constructed using quintic B-spline curves. A two-stage RRT* algorithm was proposed for obstacle avoidance path planning. In the exploration phase, a heuristic sampling strategy and a priority queue strategy were introduced to enhance search efficiency. In the optimization phase, an anytime cost updating mechanism was adopted to accelerate the convergence to the optimal path. Based on the obtained collision-free path and with the goal of time optimality, a multi-strategy improved particle swarm optimization (PSO) algorithm was proposed to optimize the motion trajectory. This enhanced algorithm integrated a multimodal adaptive parameter adjustment mechanism, a quantum-behaved enhancement strategy, and a hierarchical elite learning strategy to optimize the motion trajectory of the palletizing robot. Experimental results demonstrated that the two-stage RRT* algorithm successfully guided the palletizing robot from the start point to the target point without collision, outperforming both the traditional RRT and an improved RRT algorithm in terms of search efficiency and path length. After optimization by the multi-strategy improved PSO algorithm, the total motion time of the palletizing robot was reduced to 37.42 s. Compared with the adaptive weight PSO and the standard PSO algorithms, the motion efficiency was improved by 23.29% and 26.41%, respectively. In conclusion, the synergistic application of the two-stage RRT* algorithm and the multi-strategy improved PSO algorithm generates a feasible and efficient operational path for the palletizing robot, ensuring obstacle avoidance safety while significantly shortening the motion time.
关键词
码垛机器人 /
避障路径优化 /
轨迹优化 /
粒子群算法 /
RRT*
Key words
palletizing robot /
obstacle avoidance path optimization /
trajectory optimization /
particle swarm algorithm /
RRT*
{{custom_sec.title}}
{{custom_sec.title}}
{{custom_sec.content}}
参考文献
[1] 吕鸿昊, 诸正杰, 程宇航, 等. 工业机器人主动安全作业方法与应用[J]. 机械工程学报, 2025, 61(15): 174-184.
[2] LYU H H, ZHU Z J, CHENG Y H, et al.Proactive Safety Techniques and Applications for Industrial Robots[J]. Journal of Mechanical Engineering, 2025, 61(15): 174-184.
[3] 刘永奎, 王芊骥, 朱子璐, 等. 具身智能工业机器人: 体系架构、关键技术与案例研究[J]. 计算机集成制造系统, 2025, 31(12): 4513-4541.
[4] LIU Y K, WANG Q J, ZHU Z L, et al.Embodied Artificial Intelligent Industrial Robot: System Architecture, key Technologies and Case Study[J]. Computer Integrated Manufacturing Systems, 2025, 31(12): 4513-4541.
[5] LI J L, LIU X Q, WU X, et al.A Time and Frequency Convolutional Autoencoder for Anomaly Detection in Industrial Robots Based on Inertial Measurement Unit Error Calibration[J]. Engineering Applications of Artificial Intelligence, 2025, 162: 112269.
[6] PENG P M, ZHENG W B, PAN Y C, et al.Lightweight Design of Palletizing Robot Body Parts Based on Altair Inspire[J]. Journal of Physics: Conference Series, 2025, 3019(1): 012014.
[7] 王洪波, 姚嘉凌. 应用于圆饼工件分拣的码垛机器人自适应积分滑模控制[J]. 包装工程, 2022, 43(15): 281-288.
[8] WANG H B, YAO J L.Adaptive Integral Sliding Mode Control of Palletizing Robot System for Round Piece Sorting[J]. Packaging Engineering, 2022, 43(15): 281-288.
[9] ZHUANG C G, LI S F, DING H.Instance Segmentation Based 6D Pose Estimation of Industrial Objects Using Point Clouds for Robotic Bin-Picking[J]. Robotics and Computer-Integrated Manufacturing, 2023, 82: 102541.
[10] 李航, 李瑞琴, 张磊, 等. 面向酒盒生产线的多模式码垛机器人构型设计及尺度优化[J]. 包装工程, 2025, 46(3): 158-168.
[11] LI H, LI R Q, ZHANG L, et al.Configuration Design and Dimension Optimization of a Multi-Mode Palletizing Robot for Wine Box Production Line[J]. Packaging Engineering, 2025, 46(3): 158-168.
[12] 魏欣, 孙玥. 一种新型包装码垛机器人路径规划方法[J]. 包装工程, 2018, 39(15): 173-177.
[13] WEI X, SUN Y.A New Path Planning Method for Packaging Palletizing Robot[J]. Packaging Engineering, 2018, 39(15): 173-177.
[14] TAMIZI M G, YAGHOUBI M, NAJJARAN H.A Review of Recent Trend in Motion Planning of Industrial Robots[J]. International Journal of Intelligent Robotics and Applications, 2023, 7(2): 253-274.
[15] 刘金锋, 顾世民, 张占虎, 等. 基于多目标约束的狭小空间便携式机器人轨迹优化方法[J/OL].中国机械工程, 1-14[2025-10-26]. https://link.cnki.net/urlid/42.1294.th.20251011.
1532.004.
16 LIU J F, GU S M, ZHANG Z H, et al. Trajectory Optimization Method for Portable Robots in Confined Spaces Based on Multi-objective Constraints[J/OL]. China Mechanical Engineering, 1-14[2025-10-26]. https://link.cnki.net/urlid/42.1294.th.20251011.1532.004.
[16] PAN Q Q, WANG H B, FENG Y F, et al.RRT-Based CPC: A Configuration Planning Method for Continuum Robots Using Rapidly-Exploring Random Tree Algorithm[J]. Robotics and Autonomous Systems, 2026, 195: 105190.
[17] WANG Y L, KASAEI H.Fast Trajectory Planner with a Reinforcement Learning-Based Controller for Robotic Manipulators[J]. Engineering Applications of Artificial Intelligence, 2025, 162: 112341.
[18] WU M K, RUPENYAN A, CORVES B.Autogeneration and Optimization of Pick-and-Place Trajectories in Robotic Systems: A Data-Driven Approach[J]. Robotics and Computer-Integrated Manufacturing, 2026, 97: 103080.
[19] 于军琪, 陈易圣, 冯春勇, 等. 智能建造机器人局部路径规划研究综述[J]. 计算机工程与应用, 2024, 60(10): 16-29.
[20] YU J Q, CHEN Y S, FENG C Y, et al.Review of Research on Local Path Planning for Intelligent Construction Robots[J]. Computer Engineering and Applications, 2024, 60(10): 16-29.
[21] 孙宁, 胡云雷, 陈宇飞. 基于改进A*算法的轮式巡检机器人路径规划方法[J]. 湖南大学学报(自然科学版), 2025, 52(8): 103-110.
[22] SUN N, HU Y L, CHEN Y F.Path Planning Method for Wheeled Inspection Robot Based on Improved A* Algorithm[J]. Journal of Hunan University (Natural Sciences), 2025, 52(8): 103-110.
[23] 郭俊锋, 袁俊平, 朱红霞. 基于改进RRT算法的双臂服务机器人运动规划研究[J]. 仪器仪表学报, 2024, 45(12): 210-220.
[24] GUO J F, YUAN J P, ZHU H X.Research on Motion Planning of Dual-Arm Service Robot Based on Improved RRT Algorithm[J]. Chinese Journal of Scientific Instrument, 2024, 45(12): 210-220.
[25] 王晶, 高亚鹏, 李海芳. 基于A*与DWA算法的果园导航机器人研究[J/OL]. 电子测量技术, 1-16[2025-10-26]. https://link.cnki.net/urlid/11.2175.tn.20251022. 0935.006.
[26] WANG J, GAO Y P, LI H F.Research on orchard navigation robot based on A* and DWA algorithms[J/OL]. Electronic Measurement Technology, 1-16[2025-10-26].
[27] 张灿, 马志艳, 程源, 等. 融合贪心算法和改进RRT的机械臂避障路径规划[J]. 机械设计与研究, 2024, 40(3): 92-96.
[28] ZHANG C, MA Z Y, CHENG Y, et al.Obstacle Avoidance Path Planning of Manipulator Based on Greedy Algorithm and Improved RRT[J]. Machine Design & Research, 2024, 40(3): 92-96.
[29] CHEN Z L, ZHANG X M, ZHENG R D, et al.A Novel Path Planning Method for the Collaborative Robot in Tight Micro-Assembly Environments[J]. International Journal of Control, Automation and Systems, 2025, 23(9): 2630-2646.
[30] 金桥, 杨光锐, 王霄, 等. 基于A-TD3的码垛机器人轨迹规划[J]. 现代制造工程, 2025(5): 42-52.
[31] JIN Q, YANG G R, WANG X, et al.Palletizing Robot Trajectory Planning Based on A-TD3[J]. Modern Manufacturing Engineering, 2025(5): 42-52.
[32] 崔迎超, 汪志锋, 徐洁, 等. 改进HS算法在码垛机器人轨迹规划中的应用[J]. 包装工程, 2023, 44(15): 137-145.
[33] CUI Y C, WANG Z F, XU J, et al.Application of Improved HS Algorithm in Trajectory Planning of Palletizing Robot[J]. Packaging Engineering, 2023, 44(15): 137-145.
[34] WANG R G, ZHAO N J, DONG Y C, et al.Multi-Objective Trajectory Planning and Implementation of a Metamorphic Palletizing Robot[J]. Proceedings of the Institution of Mechanical Engineers, Part C: Journal of Mechanical Engineering Science, 2024, 238(20): 10091-10106.
[35] 吴鹏远. 六自由度焊接机器人的轨迹规划算法研究[D]. 太原: 中北大学, 2024.
[36] WU P Y.Research on Trajectory Planning Algorithm of Six-Degree-of-Freedom Welding Robot[D]. Taiyuan: North University of China, 2024.
[37] NI S H, CHEN W D, WEI Z T, et al.Optimal Trajectory Planning of Space Flexible-Link Manipulator Based on Singular Perturbation Theory[J]. Journal of Sound and Vibration, 2025, 617: 119242.
[38] 陈丹, 谭钦, 徐哲壮. 基于采样点优化RRT算法的机械臂路径规划[J]. 控制与决策, 2024, 39(8): 2597-2604.
[39] CHEN D, TAN Q, XU Z Z.Robotic Arm Path Planning Based on Sampling Point Optimization RRT Algorithm[J]. Control and Decision, 2024, 39(8): 2597-2604.