基于迭代学习PID算法的苹果采摘机器人设计

　　摘要:为了提高采摘机器人机械手控制系统的精准性和采摘机器人的移动效率，设计出基于迭代学习PID算法的苹果采摘机器人。借助MatLab软件平台进行模型搭建及控制系统仿真测试，实验室条件下进行硬件结构设计，并完成采摘过程测试、路径规划避障测试和采摘果实破损率统计分析。实验验证表明:基于迭代学习PID算法设计的采摘机器人可准确锁定采摘目标，迅速实施稳定的采摘动作，以最佳采摘角度最大程度地保证采摘果实完整性。基于迭代学习PID算法设计的苹果采摘机器人有效提高了采摘的精度和效率，使苹果整体完好率达到98．3%以上，最大限度保证了采摘苹果的质量。

　　关键词:苹果采摘机器人;路径规划;迭代学习;PID算法

　　0引言

　　苹果是我国生产的主要农业产品之一，2017年我国苹果种植面积为250．96万hm2，年产量突破4548万t，规模居世界第一。我国苹果产量约占世界苹果总产量的56．13%，居三大果品(苹果、柑橘、梨)之首。2017年，我国苹果种植环节生产总成本平均每667m2为5013．33元［1］。当前，苹果采摘机器人的发明与推广在一定程度上提高了生产效率，降低了人力成本，同时也带来了一些弊端。例如，低控制精度下的采摘机器人动作会对采摘果实造成一定程度的机械损伤，使得病原微生物对果实有机可乘，病原微生物的入侵将会导致苹果腐烂变质，给农业生产带来巨大损失。采摘机器人在采摘过程中实际接触果实，所以保证机械采摘果实完整性显得尤为重要。为此，立足于控制系统角度进行机器人全局优化设计，进一步提升采摘机器人控制的精准性和移动效率，具有较大的价值与意义。

　　1系统总体设计

　　苹果采摘机器人系统包括移动环节和采摘环节两大部分。移动环节采用履带式结构，采摘环节由手臂与手腕部分辅助实施采摘过程。苹果采摘机器人主要采用关节型结构，即每一个关节由一个舵机组成。本文设计的苹果采摘机器人机械部分结构图如图1所示。

　　2硬件部分设计

　　苹果采摘机器人硬件部分设计主要包括机械结构和硬件电路两部分。在机械结构设计部分中，底盘采用履带式结构，保证采摘机器人在运行时不受采摘场地的限制。硬件电路部分主要由STM32主控制核心、图像采集识别、舵机控制电路、XEEB通信、超声波及红外等传感器组成，如图3所示。本文设计的苹果采摘机器人采摘机械臂为6自由度机械手，动力结构由2个旋转舵机和4个移动舵机组成。该结构灵活性大、采摘范围广、运行速度快且旋转角度大，最大限度地保证采摘苹果的质量。采摘机器人控制流程:首先，通过图像采集模块捕捉到苹果的实际位置，并将苹果所在位置信息发送给主控制器，迭代学习PID算法开始响应，控制器进行计算并规划出期望运动路径;然后，设定电机转速，硬件电路通过采样得到电机转速，同时计算系统误差值e，通过迭代学习PID算法改变PWM占空比，进一步消除偏差量，直到转速稳态到期望值;主控制器根据迭代学习PID控制算法保证机器人，以最佳期望方案进行动作，通过准确控制旋转舵机与夹角舵机的动作配合，实现准确快速采摘。期望方案以最佳采摘角度来保证采摘果实的完整性。主控制器利用控制算法保证采摘机器人以最佳移动方式切合期望路径，超声波及红外模块则配合该算法保证采摘机器人有较强的避障性能。XBEE通信模块则实现采摘机器人的一系列通信功能。

　　3采摘机器人控制系统设计

　　本文设计的苹果采摘机器人为多关节结构，为了保障控制系统在复杂环境具有良好性能，设计时需要引入参数不确定的随机干扰因素，动力学方程为M(qk(t))q··k(t)+C(qk(t)，q·k(t))q·k(t)+G(qk(t))=τk(t)+dk(t)(3)其中，qk∈Ｒn、q·k∈Ｒn、q··k∈Ｒn为采摘机器人机械臂的角位移、角速度和角加速度;M(qk)∈Ｒn×n为惯性矩阵;C(qk，q·k)q·k∈Ｒn为离心力;G(qk)∈Ｒn为重力;τk(t)为控制力矩;dk(t)为采摘机器人机械臂工作时不确定外来扰动。控制系统所要跟踪的期望轨迹为qd(t)，t∈［0，T］。系统第i次输出为qk(t)，根据公式(2)可知，系统运动误差为ek=qk(t)－qd(t)。控制系统设计基本思路是通过学习控制律设计uk+1(t)，使得第k+1的控制误差ek+1(t)减少。

　　4仿真与分析

　　在MatLab软件的Simulink中，根据参考文献［10］中机器人仿真实验步骤，搭建系统模型进行仿真分析。其中，线速度输入采用vd=1．0，角度输入信号采用sin(t)正弦信号。控制规律采用公式(4)闭环PD型，总的迭代次数为10次，系统仿真时间为20s。在实验室对苹果采摘系统进行了大量的仿真，在迭代学习PID控制算法下，y轴方向上速度跟踪如图5所示，y轴方向上角度跟踪如图6所示，角度及速度跟踪下降曲线如图7所示

　　5采摘机器人实现与测试

　　采摘系统测试从机器人移动路径测试及采摘效果测试两个方面进行。控制系统的控制对象是2个直流电机及6个控制舵机，电机同时匹配光电编码器，实时反馈电机转速波形，电机驱动模块采用L298N模块。采摘机器人主控制器芯片采用STM32F103ZET6型号32位AＲM微控制器，上电后采摘机器人采摘动作如图8所示。

　　6结论

　　1)设计了一种基于迭代学习PID算法的苹果采摘机器人，采用迭代PID算法契合控制期望目标，实现了对于苹果采摘机器人的实际动作轨迹的高效跟踪与在线调整，迭代学习过程中进一步消除了系统误差，提升控制系统精度和采摘机器人的工作效率。

　　2)基于迭代学习PID算法的苹果采摘机器人，实现了对于采摘目标的快速锁定、有效避障规划路径与稳定完整采摘果实，工作效率高，果实破损率低。3)苹果采摘机器人控制系统在复杂环境中可以克服未知参数和随机扰动的不确定性，控制机械手臂精准到达苹果果实所在位置进行采摘，并以最佳采摘角度和最大程度保证采摘果实的完整性。其成功率较高、硬件集成简单，易于学习接受，可在未来农业采摘机械领域上有效推广，具有一定的应用前景。

　　参考文献:

　　［1］王璇，刘军弟，邵砾群，等．我国苹果产业年度发展状况及其趋势与建议［J］．中国果树，2018(3):101－104，108．

　　［2］迟颖．基于PLC控制系统的果蔬采摘机械手设计研究［J］．农机化研究，2018，40(1):219－223．

　　［3］马贵飞，马履中，杨文亮．苹果采摘机器人机械手运动学分析与仿真［J］．农机化研究，2010，32(7):21－25．

　　［4］聂章龙，张静．采摘机器人智能避障决策系统—基于ZigBee和单片机［J］．农机化研究，2018，40(12):130－134．

　　［5］张璐，王慧．基于蚁群算法的多采摘机器人路径规划与导航系统［J］．农机化研究，2018，40(11):227－231．