取苗机械手运动控制联合仿真研究及试验

doi:10.13733/j.jcam.issn.2095-5553.2023.02.002

摘要/Abstract

摘要： 为减少取苗机械手研制过程中投入大量的成本和时间，解决机械手在作业过程中控制精度低、适应性差等问题，采用SolidWorks建立机械手的模型，并导入ADAMS中；采用模糊PID控制算法对机械手夹持角度进行实时动态联合仿真分析，设计模糊PID控制器及模糊规则。利用MATLAB/Simulink和ADAMS建立联合仿真模型，以阶跃信号为激励，模糊PID控制和PID控制仿真结果表明：PID控制的响应时间为1.1 s，模糊PID的响应时间为0.33 s且响应速度更快，说明模糊PID优于经典PID控制，设计的取苗机械手具有良好的动态响应和轨迹跟踪特性，理论上能够满足实际作业要求。取苗试验结果表明：在取苗频率为50、60和70株/min时，采用PID算法和模糊PID算法取苗成功率分别为9609%、93.75%、92.96%和98.43%、95.31%、93.75%，采用模糊PID算法的取苗成功率更高，能够满足实际作业要求。

关键词: 取苗机构, 机械手, 联合仿真, 模糊PID

Abstract: In order to reduce the development cost and time, and solve the problems of low control accuracy and poor adaptability of the seedling manipulator in the process of operation, the model of manipulator is established by SolidWorks and imported into ADAMS. The fuzzy PID control algorithm is used to realize realtime dynamic joint simulation analysis for the angle of the manipulator, and the fuzzy PID controller and fuzzy rules are designed. The joint simulation model is established by using MATLAB/Simulink and ADAMS. Taking the step signal as the excitation, the simulation results of fuzzy PID control and PID control show that the response time of PID control is 1.1 s, the response time of fuzzy PID is 033 s and the response speed is faster, indicating that fuzzy PID is better than classical PID control. The designed seedling manipulator has good dynamic response and trajectory tracking characteristics; theoretically, it can meet the requirements of practical operation. The results of seedling taking test show that when the seedling taking frequency is 50, 60 and 70 plants/min, the success rates of PID algorithm and fuzzy PID algorithm are 96.09%, 93.75%, 92.96% and 98.43%, 9531%, 93.75%, respectively, the success rate of fuzzy PID algorithm is higher, which can meet the actual operation requirements.

Key words: seedling collection mechanism, manipulator, cosimulation, fuzzy PID

中图分类号:

TP391.9

鲁丁, 王卫兵, 韩帅. 取苗机械手运动控制联合仿真研究及试验[J]. 中国农机化学报, 2023, 44(2): 8-13.

Lu Ding, Wang Weibing, Han Shuai. Cosimulation study and experiment on motion control of seedling picking manipulator[J]. Journal of Chinese Agricultural Mechanization, 2023, 44(2): 8-13.

参考文献

［1］　
王宁, 任玲, 李江全, 等. 穴盘苗移栽机自动取苗技术研究现状与展望［J］. 中国农机化学报, 2021, 42(1): 59-66.

Wang Ning, Ren Ling, Li Jiangquan, et al. Research status and prospect of automatic seedling picking technology of transplanter ［J］. Journal of Chinese Agricultural Mechanization, 2021, 42(1): 59-66.

［2］　
毛灿, 罗海峰, 朱毅, 等. 钵苗移栽机械研究现状与发展趋势［J］. 中国农机化学报, 2020, 41(1): 215-222.

Mao Can, Luo Haifeng, Zhu Yi, et al. Research status and development trend of seedling transplanting machinery ［J］. Journal of Chinese Agricultural Mechanization, 2020, 41(1): 215-222.

［3］　
韩绿化, 毛罕平, 严蕾, 等. 穴盘育苗移栽机两指四针钳夹式取苗末端执行器［J］. 农业机械学报, 2015, 46(7): 23-30.

Han Lühua, Mao Hanping, Yan Lei, et al. Pincettetype endeffector using two fingers and four pins for picking up seedlings ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2015, 46(7): 23-30.

［4］　
韩绿化, 毛罕平, 缪小花, 等. 基于穴盘苗力学特性的自动取苗末端执行器设计［J］. 农业机械学报, 2013, 44(11): 260-265.

Han Lühua, Mao Hanping, Miao Xiaohua, et al. Design of automatic seedling picking end effector based on mechanical characteristics of plug seedling ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2013, 44(11): 260-265.

［5］　
韩长杰, 徐阳, 张静, 等. 半自动压缩基质型西瓜钵苗移栽机设计与试验［J］. 农业工程学报, 2018, 34(13): 54-61.

Han Changjie, Xu Yang, Zhang Jing, et al. Design and experiment of semiautomatic transplanter for watermelon seedlings raised on compression substrate ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2018, 34(13): 54-61.

［6］　
马锐, 曹卫彬，任玲，等. 穴盘苗自动移栽机末端执行器的参数优化设计［J］. 机械设计与制造, 2019(12): 185-189.

Ma Rui, Cao Weibin, Ren Ling, et al. Design and parameter optimization of endeffector on automatic plug seedling transplanter ［J］. Machinery Design & Manufacture, 2019(12): 185-189.

［7］　
王蒙蒙, 宋建农, 刘彩玲, 等. 蔬菜移栽机曲柄摆杆式夹苗机构的设计与试验［J］. 农业工程学报, 2015, 31(14): 49-57.

Wang Mengmeng, Song Jiannong, Liu Cailing, et al. Design and experiment of crank rocker type clamp seedlings mechanism of vegetable transplanter ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2015, 31(14): 49-57.

［8］　
赵匀, 张卫星, 辛亮, 等. 探入式番茄钵苗移栽机构设计与试验［J］. 农业机械学报, 2019, 50(1): 105-112.

Zhao Yun, Zhang Weixing, Xin Liang, et al. Design and experiment of extensible potted tomatoes seedling transplanting mechanism ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2019, 50(1): 105-112.

［9］　
申团辉, 王卫兵, 冯静安, 等. 机械手夹持机构运动与控制联合仿真研究［J］. 计算机仿真, 2019, 36(2): 292-296.

Shen Tuanhui, Wang Weibing, Feng Jingan, et al. Research of cosimulation of motion and control of manipulator clamping mechanism ［J］. Computer Simulation, 2019, 36(2): 292-296.

［10］　
申团辉. 穴盘苗移栽机末端执行器机构设计及控制系统研究［D］. 石河子: 石河子大学, 2019.

Shen Tuanhui. Research on the design and control system of the end effector of the plug seedling transplanter ［D］. Shihezi: Shihezi University, 2019.

［11］　
马晓晓, 李华, 曹卫彬, 等. 番茄钵苗移栽机自动取苗装置作业参数优化与试验［J］. 农业工程学报, 2020, 36(10): 46-55.

Ma Xiaoxiao, Li Hua, Cao Weibin, et al. Optimization and experiment of working parameters of automatic seedling picking device for tomato seedlings transplanting ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2020, 36(10): 46-55.

［12］　
李华, 马晓晓, 曹卫彬, 等. 夹茎式番茄钵苗取苗机构设计与试验［J］. 农业工程学报, 2020, 36(21): 39-48.

Li Hua, Ma Xiaoxiao, Cao Weibin, et al. Design and experiment of seedling picking mechanism by stem clipping for tomato plug seedling ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2020, 36(21): 39-48.

［13］　
童俊华, 俞高红, 朱赢鹏, 等. 三臂回转式蔬菜钵苗取苗机构设计与试验［J］. 农业机械学报, 2019, 50(1): 113-121.

Tong Junhua, Yu Gaohong, Zhu Yingpeng, et al. Design and experiment of threearms rotary vegetable plug seedling pickup mechanism ［J］. Transactions of the Chinese Society for Agricultural Machinery, 2019, 50(1): 113-121.

［14］　
Yuan Z, Zhu W, Wang D, et al. Kinematics analysis and simulation of a 7-DOF welding robot based on ADAMS and MATLAB ［J］. Springer Berlin Heidelberg, 2011.

［15］　
Luo H, Liu Y, Chen Z, et al. Cosimulation control of robot arm dynamics in ADAMS and MATLAB ［J］. Research Journal of Applied Sciences Engineering & Technology, 2013, 6(20): 3778-3883.

［16］　
陈罡, 周奇才, 吴菁, 等. 七自由度机械臂的ADAMS/MATLAB联合仿真研究［J］. 系统仿真学报, 2017, 29(1): 99-106.

Chen Gang, Zhou Qicai, Wu Jing, et al. Research for cosimulation of 7DOF manipulator based on ADAMS and MATLAB ［J］. Journal of System Simulation, 2017, 29(1): 99-106.

［17］　
马岳峰, 刘昭度, 张景波, 等. 基于ADAMS和MATLAB的ACC联合仿真［J］. 计算机仿真, 2007(4): 252-254.

Ma Yuefeng, Liu Zhaodu, Zhang Jingbo, et al. Cosimulation of ACC with ADAMS/CAR and MATLAB ［J］. Computer Simulation, 2007(4): 252-254.

［18］　
任玲, 王宁, 曹卫彬, 等. 番茄钵苗整排取苗手定位的模糊PID控制［J］. 农业工程学报, 2020, 36(8): 21-30.

Ren Ling, Wang Ning, Cao Weibin, et al. Fuzzy PID control of manipulator positioning for taking the whole row seedlings of tomato plug seedlings ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2020, 36(8): 21-30.

［19］　
宋琦, 王卫兵, 喻俊志, 等. 移栽机械臂的设计及仿真研究［J］. 中国农机化学报, 2020, 41(5): 12-16.

Song Qi, Wang Weibing, Yu Junzhi, et al. Design and simulation of transplanting mechanical arm ［J］. Journal of Chinese Agricultural Mechanization, 2020, 41(5): 12-16.

［20］　
刘姣娣, 曹卫彬, 许洪振, 等. 自动补苗装置精准定位自适应模糊PID控制［J］. 农业工程学报, 2017, 33(9): 37-44.

Liu Jiaodi, Cao Weibin, Xu Hongzhen, et al. Adaptive fuzzyPID control of accurate orientation for autodetect seedling supply device ［J］. Transactions of the Chinese Society of Agricultural Engineering, 2017, 33(9): 37-44.

［21］　
NY/T 3486—2019, 蔬菜移栽机作业质量［S］.

[1]	柯超, 谢守勇, 邓成志, 刘凡一, 刘军, . 丘陵山地移栽机自动调平系统设计与试验[J]. 中国农机化学报, 2023, 44(8): 17-26.
[2]	李洪兵, 罗洋, 张颖, 王雨凝, 欧俊, 崔浩. 基于模糊PID控制的NB-IoT果蔬农业物联网系统设计与试验[J]. 中国农机化学报, 2023, 44(1): 162-171.
[3]	谢佩军, 张育斌 . 阻尼累加离散灰色预测的Smith预估智能灌溉系统[J]. 中国农机化学报, 2022, 43(8): 158-165.
[4]	章新, 董荻, 睢志伟, 李占龙, 李建伟. 液压减振器节流孔与拖拉机减振特性研究[J]. 中国农机化学报, 2022, 43(7): 57-62.
[5]	崔迎港, 徐晓辉, 宋涛, 孙圆龙, 司玉龙. 基于SOA优化模糊PID的水肥控制系统研究[J]. 中国农机化学报, 2022, 43(3): 60-67.
[6]	郝文彬, 冯天玉, 黄世明, 程捷, 朱望武. 基于模糊PID控制的烘干房温度控制设计[J]. 中国农机化学报, 2021, 42(12): 101-106.
[7]	董哲, 陆静平. 基于模糊PID控制的甘蔗收割机刀盘仿形系统设计及仿真^*[J]. 中国农机化学报, 2021, 42(11): 12-16.
[8]	宋琦;王卫兵;喻俊志;申团辉;. 移栽机械臂的设计及仿真研究[J]. 中国农机化学报, 2020, 41(5): 12-16.
[9]	赵玲亚;王英健;赵子开;. 圆形水果采摘机械手运动学分析与仿真[J]. 中国农机化学报, 2020, 41(3): 24-29.
[10]	孟超;. 一种新型多自由度高枝修剪机械手设计与试验[J]. 中国农机化学报, 2020, 41(3): 67-73.
[11]	李喜武;徐博;袁月明;. 自适应模糊PID算法仔猪床温度控制系统研究[J]. 中国农机化学报, 2020, 41(10): 48-53+73.
[12]	张金果;. 便携式棉花采摘机械手结构参数优化研究[J]. 中国农机化学报, 2019, 40(8): 37-42.
[13]	胡卫;秦永法;曾励;张持;. 前驱式纯电动汽车制动能量回收控制策略研究[J]. 中国农机化学报, 2019, 40(8): 116-121.
[14]	张振国;吕全贵;任杰宇;韩长杰;袁盼盼;张学军;. 旋转剪切式红花花丝采摘机械关键部件的设计[J]. 中国农机化学报, 2019, 40(7): 1-6.
[15]	刘凡;杨光友;杨康;. 农业采摘机器人柔性机械手研究[J]. 中国农机化学报, 2019, 40(3): 173-178.