钵苗移栽机器人控制原理和系统设计.doc

钵苗移栽机器人控制原理和系统设计 　　引言 　　 　　钵苗移栽是温室穴盘育苗生产中的重要环节，人工作业单调繁重，正逐步被机械化移栽设备所取代。早期钵苗移栽设备的研究多以工业机器人为本体，其只适用于特定环境，不便于对系统进行扩展和改进，利用率较低。例如，Kutz 等人基于 Puma 560 设计的可将种苗从 392 孔穴盘移栽至 36 孔生长盘的苗圃植物移栽机器人; Ting 等人基于四自由度 ADEPT－SCAＲA 研制的一种带有 SNS 夹持器的移栽机器人等。近年来，荷兰、美国、韩国等国家又研制了多种用于温室作业生产线的大型钵苗移栽机，其作业效率达 800 ～ 1000 作业循环/h，最多可扩展 32 组移栽手爪。但其结构复杂、价格昂贵、体积大，与我国现阶段设施农业生产模式的适应性差。目前，邱立春、周婷、曹卫彬等人针对蔬菜钵苗自动移栽机也进行了相关研究并取得一定进展，但相对产业化应用要求仍存有诸多技术瓶颈需要突破。 　　为此，基于平动二自由度并联机构，设计了一种高速钵苗移栽机器人。基于该移栽机器人的系统构成和工作原理，应用 PLC、传感器和伺服控制技术对其控制系统进行设计，通过系统间的运动协调，实现钵苗从高密度盘到低密度盘的自动移栽。 　　1 钵苗移栽机器人结构组成及工作原理 　　如图 1 所示，钵苗移栽机器人主要由平动二自由度并联移栽机构、气动四针式取苗爪、植苗盘输送带、供苗盘输送带、穴盘输送位置检测传感器、压盘辅助装置以及控制系统组成。 　　并联移栽机构由基座、移栽动平台及两条对称的全铰接运动支链组成，每条支链由主动臂﹑副主动臂和 3 个从动臂组成，如图 2 所示。由于主动臂与副动臂、3 根从动臂等长且平行，故可简化为如图 3 所示的2 自由度 5 杆铰接机构。图 3 中，L1、L2、ui和 wi( i =1，2) 表示支链中主动臂、从动臂的长度及单位矢量;θi1和 θi2分别表示支链中主动臂和从动臂的位置角; r= ( x，y)T表示动平台参考点 O’的位置矢量; e 表示两电机轴的偏心距。详细的运动学和动力学分析参见参考文献［11］。【图1-3】 　　工作时，安装在基座上的 2 个伺服电机经减速器分别驱动 2 个主动臂绕主动关节转动，主动臂带动从动臂，进而带动移栽动平台运动。由于主动臂和从动臂均由平行四边形构成，利用平行四边形的姿态保持性，使得两主动臂的独立转动转换为动平台的二维平动。气动四针式取苗爪安装在动平台上，用于夹取和放置钵苗; 而穴盘输送系统则垂直于移栽机构的工作平面独立布置，用于供苗盘和植苗盘的纵向间歇性进给。并联移栽机构的任务是通过与两条独立穴盘定位输送系统和气动取苗爪伸缩控制系统间的运动协调，将供苗盘中钵苗依次移栽到植苗盘相应穴孔中。 　　由于该移栽机构采用闭环并联结构，伺服电机安装在基座上，机构刚度大; 从动臂可制作成轻杆，运动质量小、惯性低，动平台可获得较高的速度和加速度，满足了穴盘钵苗高速﹑中短距的移栽作业要求。 　　 　　2 钵苗移栽机器人控制原理分析 　　为满足准确定位抓取、高速移动栽植的钵苗移栽作业要求，取苗爪的工作模式设定为“定位—抓取—定位—移植”。具体工作原理如图 4 所示。【图4】 　　 　　以基座上两电机轴中心连线的中点为原点，中心连线所在直线为 x 轴，垂直方向直线为 y 轴，建立坐标系。其中，x 轴为两电机的零点位置; 矩形 Q1Q2Q3Q4为并联移栽机构的工作区间。工作时，系统根据供、植苗盘内待移出和植入钵苗的穴孔位置信息，规划出气动取苗爪的移栽路径; 然后遵循特定的轨迹运动规律控制函数( 如 5 次多项式运动规律) ，对每段移栽轨迹进行 PVT 插补; 再应用平动二自由度并联机构的运动学逆解模型，将移栽动平台在工作区间内各插补点的位置 P( x，y) 、速度 v( vx，vy) 转换成并联移栽机构两主动关节相对于各自零位( x 轴) 的转角角度 θ( θ11，θ21) 和转角速度 ω( θ·11，θ·21) ，进而转换为两伺服电机的脉冲个数 n( n1，n2) 和脉冲频率 f( f1，f2) 。 　　钵苗移栽系统采用伺服闭环控制，考虑机电耦合效应，可建立如图 5 所示的控制系统模型。该模型的系统输入为移栽动平台在工作区间中的理想设定轨迹 s( t) ，经运动学逆解模型转换为速度环的输入即理想角速度，通过 PID 控制器控制伺服电机，从而控制移栽机构的两主动关节输入。另一方面，移栽机构的机械部分通过本身的动力学特性反作用于伺服电机，从而影响其实际输出; 移栽机构两主动关节的实际输入经运动学正解模型得到动平台的实际轨迹 s’ 　　( t) 再反馈回系统与理想轨迹进行比较。其中，αT为测速反馈系数。【图5】 　　 　　3 控制系统设计 　　3． 1 硬件设计 　　由于并联移栽机