Motion planning for improved operational reliability of composite industrial robots
-
摘要: 复合工业机器人的应用能够有效提升智能制造车间生产效率。而在其运动规划问题中, 基于移动平台调整的机械臂初始站姿直接决定了目标任务是否能够可靠执行。为解决以上问题, 提出一种考虑机械臂初始站姿的运动规划优化方法。基于前期基础, 采用旋量描述和切片表征方法分别解决了复合工业机器人运动学建模和最小避障距离建模问题, 为进行轨迹优化提供了模型基础; 建立了最小化耗能当量和运动时间的运动规划优化模型, 通过考虑初始站姿影响设计了包括移动运动参数、冗余关节角度和机械臂运动参数在内的混合优化变量集, 同时考虑运动学约束和避障约束条件保证机械臂运动平稳性和安全性; 结果表明, 基于规划优化的复合工业机器人具有较高的操作可靠性。Abstract: The application of the composite industrial robot can effectively improve the production efficiency of the intelligent manufacturing shop. In the problem of its motion planning, the initial posture of the manipulator adjusted by the mobile device directly determines whether the target task can be executed reliably. To solve the above problem, a motion planning optimization method considering the initial posture of the manipulator was proposed. Based on the previous foundation, the proposed method solved the kinematics modeling and the minimum obstacle avoidance distance modeling of the composite industrial robot respectively by using screw description and slices characterization methods, which provided the model basis for trajectory optimization. The motion planning optimization model is established to minimize the equivalent energy consumption and the motion time. The hybrid variable set is designed by considering the initial station, including parameters of the mobile device and the manipulator, redundant joint angle. Constraints of kinematic constraints and obstacle avoidance are both considered to guarantee the movement stability and safety of the manipulator. Results indicate that the composite industrial robot based on planning optimization has high operational reliability
-
表 1 箱型空间各障碍平面顶点坐标
障碍平面 顶点1 顶点2 顶点3 顶点4 平面1 [1 400-300 400] [2 400-300 400] [2 400 300 400] [1 400 300 400] 平面2 [2 400 300 400] [1 400 300 400] [1 400 300 2 000] [2 400 300 2 000] 平面3 [2 400-300 400] [2 400 300 400] [2 400 300 2 000] [2 400-300 2 000] 平面4 [1 400-300 400] [2 400-300 400] [2 400-300 2 000] [1 400-300 2 000] 平面5 [1 400-300 2 000] [2 400-300 2 000] [2 400 300 2 000] [1 400 300 2 000] 表 2 运算环境
CPU CPU内存 操作系统版本 仿真软件 Intel(R)Core(TM)2.6GHz 8 GB Windows 10 Matlab2016 表 3 优化结果
参数 优化结果 β/rad -0.004 0 δx/mm 612.354 4 δy/mm -202.514 5 δz/mm -189.065 6 θrad/rad 0.954 8 Vratio/(%) 33.79 Aratio/(%) 28.223 Obs/mm 11.847 4 τmax/(N·m) 9.954 3 Tcov/min 12.97 F(Xs) 7.295 -
[1] Guo S, Fang T T, Song T, et al. Tracking and localization for omni-directional mobile industrial robot using reflectors[J]. Advances in Manufacturing, 2018, 6(1): 118-125. doi: 10.1007/s40436-018-0216-y [2] Mac T T, Copot C, Tran D T, et al. A hierarchical global path planning approach for mobile robots based on multi-objective particle swarm optimization[J]. Applied Soft Computing, 2017, 59: 68-76. doi: 10.1016/j.asoc.2017.05.012 [3] 胡平. 基于改进梯度投影法的冗余度机器人避障算法研究[D]. 天津: 河北工业大学, 2017: 44. [4] 汪首坤, 朱磊, 王军政. 基于导航势函数法的六自由度机械臂避障路径规划[J]. 北京理工大学学报, 2015(2): 80-85. https://www.cnki.com.cn/Article/CJFDTOTAL-BJLG201502015.htm [5] 邓伟, 张其万, 刘平, 等. 基于双种群遗传混沌优化算法的最优时间轨迹规划[J]. 计算机集成制造系统, 2018, 24(1): 101-106. https://www.cnki.com.cn/Article/CJFDTOTAL-JSJJ201801010.htm [6] 徐立云, 蔡炳杰, 杨连生, 等. 复杂机器人工位布局与运动时间的协同优化[J], 计算机集成制造系统, 2016, 22(8): 1867-1876. https://www.cnki.com.cn/Article/CJFDTOTAL-JSJJ201608005.htm [7] Han D, Nie H, Chen J, et al. Dynamic obstacle avoidance for manipulators using distance calculation and discrete detection[J]. Robotics and Computer-Integrated Manufacturing, 2018, 49: 98-104. doi: 10.1016/j.rcim.2017.05.013 [8] Klosowski J T, Held M. Efficient collision detection using bounding volume hierarchies of k-DOPs[J]. IEEE transactions on visualization and computer graphics, 1998, 4(1): 21-36. doi: 10.1109/2945.675649 [9] 雷超帆. 基于改进蚁群算法的六自由度机械臂避障路径规划[D]. 郑州: 郑州大学, 2019: 24-27. [10] 隆兴银. 基于人体实体切片的图像处理及三维重建技术研究[D]. 成都: 四川大学, 2005: 19. [11] Xu J J, Liu Z F, et al. Minimal distance calculation between the industrial robot and its workspace based on circle/polygon-slices representation[J]. Applied Mathematical Modelling, 2020, 87: 691-710. doi: 10.1016/j.apm.2020.06.012 [12] Qian D H, Wang X F, Zhao W, et al. Algorithm for the inverse kinematics calculation of 6DOF robots based on screw theory and Paden-Kahan sub-problems[J]. Mech. Eng., 2009, 45 (9): 72-75. doi: 10.3901/JME.2009.09.072 [13] 刘志峰, 许静静, 赵永胜, 等. 一种基于旋量理论的6R机器人逆运动学几何求解方法: 中国, 201710953599.4[P]. 2018-03-06