基于时间与急动度最优的并联式采茶机器人轨迹规划混合策略

doi:10.3901/JME.2022.09.062

机械工程学报 ›› 2022, Vol. 58 ›› Issue (9): 62-70.doi: 10.3901/JME.2022.09.062

扫码分享

基于时间与急动度最优的并联式采茶机器人轨迹规划混合策略

杨化林, 钟岩, 姜沅政, 邓芳, 陈龙

青岛科技大学机电工程学院青岛 266061

收稿日期:2021-05-17 修回日期:2021-10-08 出版日期:2022-05-05 发布日期:2022-06-23
通讯作者: 邓芳(通信作者),女,1981年出生,博士,副教授,硕士研究生导师。主要研究方向为数字化设计、船舶运动控制和轨迹规划。E-mail：dengfhelen@163.com E-mail:dengfhelen@163.com
作者简介:杨化林,男,1975年出生,博士,教授,硕士研究生导师。主要研究方向为数字化设计、知识工程、智能农业设备和数字孪生。E-mail：younghualin@163.com
基金资助:
山东省自然科学基金(ZR2019MEE102)和山东省重点研发计划(2018GNC112007)资助项目

Hybrid Strategy of Parallel Tea Picking Robot Trajectory Planning Based on Optimal Time and Jerk

YANG Hualin, ZHONG Yan, JIANG Yuanzheng, DENG Fang, CHEN Long

College of Mechanical and Electrical Engineering, Qingdao University of Science and Technology, Qingdao 266061

Received:2021-05-17 Revised:2021-10-08 Online:2022-05-05 Published:2022-06-23

摘要/Abstract

摘要： 提出一种基于时间与急动度最优的速度曲线模型方法。分析了当前名优茶的叶芽采摘工作背景,提出一种Delta并联机构与视觉识别技术相结合的名优茶采摘机器人。建立名优茶的采摘轨迹周期并应用了改进的速度曲线模型,采用了Lamé曲线优化采摘轨迹改善Delta机构工作过程中存在的由于竖直水平运动切换引起的加速度突变问题。对调和急动模型完成适应性改进,应用适用于采茶特殊性的粒子群优化算法求解模型中最优的时间间隔参数,从而优化采茶轨迹周期中的工作时间。该模型遵守运动学约束,对采摘轨迹的时间与急动度综合优化,保持良好的轨迹平滑性。实验结果表明,该方法能够缩短采摘时间,提高效率,在急动度抑制方面有更好的性能,为名优茶采摘机器人路径规划提供了一种有效的方式。

关键词: 采茶机器人, 轨迹规划, 急动度, 改进调和急动模型, 粒子群优化

Abstract: A speed curve model method based on the optimal time and jerk is proposed. The background of the current leaf bud picking of famous tea is analyzed, and a famous tea picking robot combining Delta parallel mechanism and visual recognition technology is proposed. The picking trajectory cycle of famous teas was established and the improved speed curve model is applied, and the Lamé curve was used to optimize the picking trajectory to improve the sudden change of acceleration caused by the switching of vertical and horizontal motion in the working process of the Delta mechanism. The adaptive improvement of the harmonic jerk model is completed, and the particle swarm optimization algorithm suitable for the particularity of tea picking is applied to solve the optimal time interval parameters in the model, thereby optimizing the working time in the tea picking trajectory cycle. The model complies with kinematic constraints, comprehensively optimizes the time and jerk of the picking trajectory, thus can maintain a good trajectory smoothness. Experimental results show that the method can shorten the picking time, improve the efficiency, perform better in jerk suppression, and provide an effective way for path planning of famous tea picking robots.

Key words: tea-plucking robot, trajectory optimization, jerk, improved harmonic jerk model, particle swarm optimization

中图分类号:

TP242
TP299

杨化林, 钟岩, 姜沅政, 邓芳, 陈龙. 基于时间与急动度最优的并联式采茶机器人轨迹规划混合策略[J]. 机械工程学报, 2022, 58(9): 62-70.

YANG Hualin, ZHONG Yan, JIANG Yuanzheng, DENG Fang, CHEN Long. Hybrid Strategy of Parallel Tea Picking Robot Trajectory Planning Based on Optimal Time and Jerk[J]. Journal of Mechanical Engineering, 2022, 58(9): 62-70.

参考文献

[1] YUAN Haibo, HUA Jinjie, DENG Yuliang, et al. Mechanized technology in tea-plucking[J]. China Tea, 2018, 40(6): 4-9. 袁海波, 滑金杰, 邓余良, 等. 名优绿茶机械化采摘技术[J]. 中国茶叶, 2018, 40(6): 4-9.
[2] LI Nan. Researches on the control system for a parallel tea-plucking robot[D]. Nanjing: Nanjing Forestry University, 2015. 李楠. 名优绿茶并联采摘机器人控制系统研究[D]. 南京: 南京林业大学, 2015.
[3] TANG Xiaolin. Analysis of the pros and cons of mechanised tea harvesting and its development prospects[J]. Tea Processing in China, 2008(4): 10-12. 唐小林. 机械化采茶的利弊分析及发展前景[J]. 中国茶叶加工, 2008(4): 10-12.
[4] HAN Yu, XIAO Hongru, QIN Guangming, et al. Research on the development of tea picking machinery at home and abroad[J]. Journal of Chinese Agricultural Mechanization, 2014, 35(2): 20-24. 韩余, 肖宏儒, 秦广明, 等. 国内外采茶机械发展状况研究[J]. 中国农机化学报, 2014, 35(2): 20-24.
[5] GAO Feng. Structural design and simulation of a high-quality tea parallel plucking robot[D]. Nanjing: Nanjing Forestry University, 2013. 高凤. 名优茶并联采摘机器人结构设计与仿真[D]. 南京: 南京林业大学, 2013.
[6] YANG Hualin, CHEN Long, CHEN Miaoting, et al. Tender tea shoots recognition and positioning for picking robot using improved YOLO-V3 model[J]. IEEE Access, 2019, 7: 180998-181011.
[7] YANG Hualin, CHEN Long, MA Zhibin, et al. Computer vision-based high-quality tea automatic plucking robot using Delta parallel manipulator[J]. Computers and Electronics in Agriculture, 2021, 181(7): 105946.
[8] MEI Jiangping, ZHANG Xu, ZANG Jiawei, et al. Optimization design using a global and comprehensive performance index and angular constraints in a type of parallel manipulator[J]. Advances in Mechanical Engineering, 2018, 10(7): 1-13.
[9] CHEN Qizhi, ZHANG Chengrui, NI Hepeng, et al. Trajectory planning method of robot sorting system based on S-shaped acceleration/deceleration algorithm[J]. International Journal of Advanced Robotic Systems, 2018, 15(6): 1-13.
[10] JIN Xiaojun, CHEN Yong, ZHANG Hao, et al. High-quality tea flushes detection under natural conditions using computer vision[J]. International Journal of Digital Content Technology and Its Applications, 2012, 6(18): 600-606.
[11] ZELINSKY A. Trajectory planning for automatic machines and robots (BIAGIOTTI, L. et al; 2008) [On the shelf][J]. Robotics & Automation Magazine IEEE, 2009, 16(4): 101-101.
[12] YANG Xuewei, FENG Zuren, LIU Chengyu, et al. A geometric method for kinematics of delta robot and its path tracking control[C]// International Conference on Control, 2014 14th International Conference on Control, Automation and Systems (ICCAS 2014). Gyeonggi-do, Korea (South): IEEE. 2014: 509-514.
[13] LI Yuhang, HUANG Tian, DERRK G C, et al. An approach for smooth trajectory planning of high-speed pick-and-place parallel robots using quintic B-splines[J]. Mechanism and Machine Theory, 2018, 126: 479-490.
[14] FANG Yi, HU Jie, LIU Wenhai, et al. Smooth and time-optimal S-curve trajectory planning for automated robots and machines[J]. Mechanism and Machine Theory, 2019, 137: 127-153.
[15] LIN Jianjie, SOMANI N, BIAO H, et al. An efficient and time-optimal trajectory generation approach for waypoints under kinematic constraints and error bounds[C]// 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Madrid, Spain: IEEE, 2018: 5869-5876.
[16] PIAZZI A, VISIOLI A. Global minimum-jerk trajectory planning of robot manipulators[J]. IEEE Transactions on Industrial Electronics, 2000, 47(1): 140-149.
[17] MACFARLANE S, CROFT E A. Jerk-bounded manipulator trajectory planning: Design for real-time applications[J]. IEEE Transactions on Robotics & Automation, 2003, 19(1): 42-52.
[18] LU Song, DING Bingxiao, LI Yangmin, et al. Minimum-jerk trajectory planning pertaining to a translational 3-degree-of-freedom parallel manipulator through piecewise quintic polynomials interpolation[J]. Advances in Mechanical Engineering, 2020, 12(3): 168781402091366.
[19] XIA Bin. Research on trajecctory planning of the delta robot[D]. Harbin: Harbin Institute of Technology, 2015. 夏斌. Delta并联机器人的运动规划研究[D]. 哈尔滨: 哈尔滨工业大学, 2015.
[20] XIE Zexiao, SHANG Dawei, REN Ping. Optimization and experimental verification of pick-and-place trajectory for a delta parallel robot based on lamé curves[J]. Journal of Mechanical Engineering, 2015, 51(1): 52-59. 解则晓, 商大伟, 任凭. 基于Lamé曲线的Delta并联机器人拾放操作轨迹的优化与试验验证[J]. 机械工程学报, 2015, 51(1): 52-59.
[21] JOSÉ R. GARCÍA-MARTÍNEZ, EDSON E, et al. A PID-type fuzzy logic controller-based approach for motion control applications[J]. Sensors, 2020, 20(5323): 1-19.
[22] WANG Mingli, XIAO Juliang, ZENG Fan, et al. Research on optimized time-synchronous online trajectory generation method for a robot arm[J]. Robotics and Autonomous Systems, 2020, 126: 103453.
[23] TEEMU K, HEIKKI K, OLOF C, et al. Experimental study on fast and energy-efficient direct driven hydraulic actuator unit[J]. Energies, 2019, 12(8): 1538-1555.
[24] LEE A Y, CHOI Y. Smooth trajectory planning methods using physical limits[J]. Proceedings of the Institution of Mechanical Engineers, Part C: Journal of Mechanical Engineering Science, 2015, 229(12): 2127-2143.
[25] FANG Yi, QI Jin, HU Jie, et al. An approach for jerk-continuous trajectory generation of robotic manipulators with kinematical constraints[J]. Mechanism and Machine Theory, 2020, 153(11): 153-174.
[26] LI H Z, GONG Z M, LIN W, et al. Motion profile planning for reduced jerk and vibration residuals[J]. SIMTech Tech, 2007, 8: 32-37.
[27] NGUYEN K D, NG T C, CEHN I M. On algorithms for planning s-curve motion profiles[J]. International Journal of Advanced Robotic Systems, 2008, 5(1): 11-19.
[28] BAI Youdun, CHEN Xin, SUN Han, et al. Time-optimal freeform s-curve profile under positioning error and robustness constraints[J]. IEEE/ASME Transactions on Mechatronics, Journal of Robotics & Machine Learning, 2018, 23(4): 1993-2003.

基于时间与急动度最优的并联式采茶机器人轨迹规划混合策略

Hybrid Strategy of Parallel Tea Picking Robot Trajectory Planning Based on Optimal Time and Jerk

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	刘亚军, 訾斌, 王正雨, 游玮, 郑磊. 智能喷涂机器人关键技术研究现状及进展[J]. 机械工程学报, 2022, 58(7): 53-74.
[2]	丁飞, 黎乾龙, 雷飞, 刘杰. 动态轨迹跟踪下力矩相关性驱动辅助的人机协同转向预测控制策略研究[J]. 机械工程学报, 2022, 58(6): 143-152.
[3]	魏凌涛, 王翔宇, 邱彬, 李亮, 周道林, 林进贵. 基于自适应预瞄路径的自动驾驶车辆寻迹和避障控制[J]. 机械工程学报, 2022, 58(6): 184-193.
[4]	李锦龙, 刘传耙, 孙涛, 张弢, 连宾宾, 宋轶民. 面向并联骨折手术机器人的复位轨迹自动式规划方法[J]. 机械工程学报, 2022, 58(5): 26-33.
[5]	蔡鑫祥, 撖奥洋, 周生奇, 菅学辉, 张智晟. 基于改进Bagging算法与模糊MP-LSTM融合的短期负荷预测模型^*[J]. 电气工程学报, 2022, 17(1): 164-170.
[6]	林琳, 高雪, 甄钊. 考虑含热电联产机组及可再生能源优先消纳的风-光-水-火联合优化调度[J]. 电气工程学报, 2021, 16(3): 85-91.
[7]	李沐蓉, 雷勇, 黄成, 胡英达, 杜世伦, 关昊天, 高德东. 基于迭代学习算法的柔性针轨迹规划[J]. 机械工程学报, 2021, 57(11): 128-137.
[8]	苏福清, 匡洪海, 钟浩, 匡威, 陶成. 基于柯西变异改进粒子群算法的无功优化 ^*[J]. 电气工程学报, 2021, 16(1): 55-61.
[9]	赵金焕,马平. 计及DG功率不确定性的配电网多目标无功优化^*[J]. 电气工程学报, 2020, 15(3): 65-71.
[10]	张鹏, 尹来容, 周振华, 黄龙. 基于近似测地线的分层次自动铺带轨迹规划方法[J]. 机械工程学报, 2020, 56(23): 226-238.
[11]	赵飞飞, 曹开拓, 保宏, 高国明. Timoshenko梁的变形场重构及传感器位置优化[J]. 机械工程学报, 2020, 56(20): 1-11.
[12]	滕儒民, 李玉鑫, 王欣, 赵哲. 基于凸优化的举高消防车时间最优轨迹规划[J]. 机械工程学报, 2019, 55(6): 138-144.
[13]	孙志毅, 张韵悦, 李虹, 孙前来, 王银. 挖掘机的最优时间轨迹规划[J]. 机械工程学报, 2019, 55(5): 166-174.
[14]	彭海军, 施博洋, 王昕炜, 谢小辉, 孙立宁. 考虑区间不确定性的双摆吊车运动轨迹规划[J]. 机械工程学报, 2019, 55(2): 204-213.
[15]	陈栋, 李世其, 王峻峰, 何旺, 丰意. 并联机构的运动学多目标轨迹规划方法[J]. 机械工程学报, 2019, 55(15): 163-173.