农机化研究 第5期 基于改进人工势场的采摘仿生机械手设计和仿真研究 陈东凤 (重}夫电 I 职业学院应用电r 院, 厌401 33 1) 摘要:捉fIj r一种} 用于水果采摘fJ【器人木端执行器的仿,l 饥械l『,并没汁了仿,l fJ【做于指关 微电机的 控制虚拟总轴系统,提高r采摘机 人r指荚 的灵活性,降低r水粜采摘机器人采摘过程 对 实的损伤 针对传统的}u机人_厂势场控制器难以满 …负载扰动引起的多电fJl实时的同步运转,提f1{r 订相邻吸引力的 人上势场多fu机 步控制方法,通过十¨邻电机的卡l 作用,他各个电机协 工作,降低JI 吹械扰动对于机械仿,卜 手指动作 捌的干扰。刈 采摘机械仿 丁辛牛手指关节电机的 随 性进行r测试,结果表H月:采用改进 r指们速度的数仳 的人上势场摸 后,可以有效地改*跟随于指的角度误差,响心效率尚, 更短的时 内¨II以将误差降低到最 低。对采摘过 l丁指的协 性进行r 拟仿 研究,结果表f J:改进后人工势场控制使, 差异较小, r指的 吲性较好,可以满足协¨控制的陂计要求 关键词:采摘 撒手;人_r势场;仿 机械; 中图分类号:S126;TP24 拟仿真;协川控制 文章编号:1003—188X(2017)05—0231—05 文献标识码:A 0 引言 近年来,关于多电机同步控制的研究受剑越来越 多的关注,多l乜机川步控制已广泛川于1 业生产领 域,不仅解决J 多_r程中的实际『¨J题, H.扶得了 很大的经济效 。采摘机器人机械仿 卜下的手指关 制。【}j于手指体积较小,【人I此需 采用微电机控制。 以 粜采摘为例,于指抓取 过程如图1所示 节采用微电机进行控制,属于多电机 川一I 作的系 统,是一个多变垃、 线性的模型,因此对于控制系统 的没计要求更尚。人 势场法是[f{Khatib提l叶J的一 种虚拟力法,其 夺思想是将机器人作、I 的环境抽象 为引力和斥力构建的场,目标会对机器人J ,li引力作 用,而障碍物会刈‘机{替{人产生斥力竹:JIJ,最后利用合 力来控制机器人的移动路径。将人I 势场进行改进 I j 衔把 小总【訇 Fig I .rhe Immatic diagram llf graspi ̄Ig apple by fingers 为r简化设计、节省成本,可以苹果的抓取为例, 后,应用到仿,{!机械于关 多电机的控制系统中,对 于指的协同控制研究具有重要的意义。 主要埘3个手指进行霞点设计。设计过程中,使3个 手指 微电机的控制下, 以协同动作,其整体没计 效果如 2所示 1 采摘仿真机械手指结构原理 在水果的采摘过程中,机械手指 对水果抓取过 程中很容易造成水果的伤害,为了降低机械于对采摘 果实的伤害,捉尚采摘机械手指的灵活性,需要设汁 一种类似人类丁.指的仿,li机械手。仿 机械r以人 类手指为参考刈 象,需设计较为柔软的接触面;I 真 实人类 指一样,具有 活的关节,火 采f}1=I=开环控 收稿日期: 基金项目: 图2仿牛机械l『结构示意图 Fig.2 The schematic diagram of the bionic robol 作者简介: 2017年5月 农机化研究 第5期 采用微电机对仿真机械手的关节进行控制,并利 生引力场,相邻电机之间的引力势场为 1 用电子虚拟总轴来同时控制仿生机械手的手指关节 电机。与同步运行的机械长轴类似,电子虚拟总轴中 Ux(i,i+1)=— △ (OL ,OL…) Aa( ,O/ )<△ f (1) 将信号通过总轴作用后,计算每台电机的输入信号; 总轴协调后,使每个手指的关节电机跟随运动,从而 间接地对整个电机控制系统进行了改善。电子虚拟 总轴的结构如图3所示。 其中,/3表示正比例增益系数,对应的应力为 F ( ,i十1)= (Ot ,OL ) (2) 而改进后人工势场跟随电机i所受的合力为 F^(i)=F (i)+F (i)+F (i,i+1) (3) 其中,F (i)表示斥力。由此可见,改进后的人工 势场的电机受力不仅包括引力和斥力,还包括相邻电 机的作用力,其控制的耦合性更强,因此在一个手指 发出动作后,其他手指可以更好地追随该手指发出动 3 电子虚拟总轴控制结构 Fig.3 The control structure of the electronic virtual axis 作。把电机受到的合力作为主手指同步控制器的输 入,可以使其他手指使其能够和其他跟随手指实现同 步动作。本次研究以单个智能体为研究对象,根据电 机中的电压和电矩平衡方程可以得 在电子虚拟总轴控制系统中,各个手指电机的控 制回路是相对独立的,各个回路的关系为并行关系, 由于各个电机之问没有耦合关系,因此控制较为简单 易行。在这种控制方式下,各个手指关节控制电机不 存在指令的时间差,若一个手指电机关节电机被扰 动,可利用人工势场通过相邻电机进行补偿,最终实 现电机的同步协调运转。 E 2基于改进人工势场的机械手微电机协同控 制算法 对于传统的人工势场而言,其考虑的仅仅是主电 机和跟随电机的作用,而没有考虑相邻电机之间的关 系。如果跟随电机中的某个电机转速不同于其他电 = Il 一 = .n 表示采摘机械手指驱动电机的两端电压;其中, + I Ir表示回路中的总电阻;,J表示电路绕组的电感; 表 示直流电机的转速;i表示回路电流;E表示回路的感 m~m _誊~ + 应电动势;E c表示电压反馈系数;J表示转动惯量;k表 示电磁力矩的系数;T,表示负载的转矩;T表示电机产 生的电磁转矩。当 : 、 = 时,可以得到控制系 统的状态方程为 4 机,相邻电机不能很好地保持协同性,会使电机的协 同作用降低,影响多电机同步控制的效果。改进后的 人工势场如图4所示。其考虑了相邻电机1和2之间 的引力,可以使转速保持高度协同,从而使整个电机 系统处于同步运转状态。 f【 一 2=一 2+6M (5) 其中,n= ,6= ;“表示控制输入。电机 的同步控制可以由人工势场驱动,而跟随误差可以采 用PID进行控制,假设第i台电机的控制输入为 Ui(t)=UJ (t)+ (t) (6) 其中,跟随误差控制器的输出采用PID控制器进 行控制,其表达式为 图4改进后的多电机受力示意图 Fig.4 The force schematic diagram of the improved multi motor Uli㈩=kpe(f) )df+ 。 (7) 假设Ol表示相邻电机i和i+1的转角,△ ( , )= 一 表示转角差,△ 表示转角差额定最大 值。当△ ( , )= 一Ot <Aa 时,在电机上会差 ・其中,e(t)表示期望的控制误差,通过控制其大小 可以得到期望的输出值; 、k,、 。分别表示比例、积分 和微分控制系数。 232・ 201 7年5月 农机化研究 笫5期 3 采摘仿生机械手实验测试和虚拟仿真 为了验证改进人_]lI势场对采摘仿真机械手关节微 电机 同控制的效果,以茄子采摘为研究对象,设计 了仿生机械手的实验测试,测试对象主要是跟随电机 的跟随误差,如图5所示。 验 ,其r指的虚拟网 模 如 9所爪 0 l 2 :{ { h n , H 时州/ 图7 采摘机械手手指误差测试曲线 Fig.7 The finger el’ror test cLirve,of picking robo! l割5仿真机械j 指肺子 验 g.5 The eggplant experiment simulation of mechanical finger 为了使仿生机械手完成采摘过程,首先将仿生机 械手置于茄子的位置,然后给定主手指电机一个转向 信号,从而可以得到手指作用时间随时问变化曲线, 如图6所示。 I r×Il1、 1——SPRO00.2force p。|I1 fNl 图8 机械仿,}:下采摘模型 }’ig.8 The picking model of mechanical bionic ham I J 1.1 J .【J .5.I】 1.【】 t1.L J ti.【J tl,¨『i】f 6作川 J随【IIfmJ变化『}I】线 Fig.6 Fhe【・LIn P‘Jf I )rt‘P reFiLlS time 在转向的作州下,丁.指和肺子进行接触,d_I于给 定电机转向的信u.属于阶跃信号, 此在起始阶段作 用力为零;当接受到信 后,于指作用力随时J 保持 一个恒定值,通过测试得到了其他两个于.指的角度跟 采摘机械手误差测试的实验曲线表明:采用人1一 随误差如图7所,J 。 I刳9 J艟拟仿 _删格{=51) F’ig.9_rhr gt id mo(h 1‘lr、 idual simulation 势场后可以有效地改善跟随于指的角度误蔗,并且响 应迅速,在较短的采摘时间『大J可以将误篪降低到最 低。 利刚手指的虚拟网格可以绘制出手指上任一点随 时问变化曲线,在3个手指L分别取一点,便可以得3 如图8所示,为了进一步验证采摘仿生机械手微 电机的协同控制效果,本研究采用MatLab/SiIl1ulink平 手指的协同控制曲线 通过仿真模拟计算,得到了在 阶跃响应下,3个手指横向摆动的角速度曲线,如图 10所示。 台,对仿生机械手的微电机同步控制方案进行了仿真 2017年5月 农机化研究 参考文献: 第5期 张奇志,周亚丽.基于人工势场与细胞自动机的移动机 器人呢路径规划算法[J].北京信息科技大学学报, 2014,29(5):8—13. [2] 高溪钠,吴丽娟.多机器人编队的人工势场法控制[J]. 辽宁科技大学学报,2014,37(4):381—386. f1叶l_1_/ 图1O 改进前阶跃响应下横向摆动角速度仿真曲线 Fig.1 0 Simulation CHIves of horizontal swing velocity under the improved front step response [3] 赵海,刘倩,邵士亮,等.一种面向多智能体群集的避障 算法[J].东北大学学报,2014,35(3):347—350. [4] 曲成刚,曹喜滨,张泽旭.人工势场和虚拟领航者结合的 多智能体编队[J].哈尔滨工业大学学报,2014,46(5): 1—5. 为了验证改进后人工势场对多微电机协同控制的 效果,分别对改进前后阶跃响应下的手指摆动角速度 曲线进行了仿真计算,如图1l所示。由改进前的阶 跃响应下手指摆动的角速度可以看出:改进前3手指 [5] 杨一波,王朝立.基于改进的人T势场法的机器人避障 控制及其MATLAB实现[J].上海理工大学学报,2013, 35(5):496-500. 角速度的数值差异较大,不能满足协同控制的设计要 求。 [6] 林志雄,张莉.基于神经模糊势场法的足球机器人路径 规划[J].计算机仿真,2014,31(1):416—420. [7] 魏伊,薛彦卓.船舶自动避障仿真研究[J].大连海事大 学学报,2013,39(2):18—20. [8] 王奎民,赵 飞,侯恕萍,等.一种改进人工势场的UUV 动碍航物规避方法[J].智能系统学报,2014,9(1):47 —52. [9] 申舟,谢文俊,赵晓林,等.基于人一I二势场的无人机战场 威胁建模研究[J].计算机仿真,2014,31(2):60—64. 刚 /s [1O] 乇伟,王华.基于约束人 势场法的弹载 行器实时避 图1 1 改进后阶跃响应下横向摆动角速度仿真曲线 Fig.1 1 Simulation CUlWes of horizontal swing velocity under improved step response 障航迹规划[J].航空动力学报,2014,29(7):1738— 1743. 陈运鹏,龙慧,刘志杰.我国施肥技术与施肥机械的研 究现状及对策[J].农机化研究,2015,37(4):255— 260. 由改进后的阶跃响应下手指摆动的角速度可以看 出:改进后3手指角速度的数值差异较小,3手指的协 同性较好,可以满足协同控制的设计要求,从而验证 [12] 姬江涛,郑治华,杜蒙蒙.农业机器人的发展现状及趋 势[J].农机化研究,2014,36(12):1—4. 了改进人工势场对多电机协同控制的可靠性。 [13] 乔永亮,何东键,赵川源,等.基丁多光谱图像和SVM的 4 结论 利用改进的人工势场模型,结合微机电技术和多 关节微电机的协同控制虚拟总轴系统,对采摘机器人 仿生机械手进行了优化设计,有效地提高了采摘机器 玉米出间杂草识别[J].农机化研究,2013,35(8):30— 34. [14] 姬长英,周俊.农业机械导航技术发展分析[J].农业机 械学报,2014,45(9):44—54. [15] 孟庆宽,何洁,仇瑞承,等.基于机器视觉的自然环境下 作物行识别与导航线提取[J].光学学报,2014,34(7): 1—7. 人手指关节的灵活性,降低了不同手指负载扰动对整 个机械手动作不协调的干扰。采用实验测试和虚拟 仿真相结合的方法,对采摘机器人仿生机械手的性能 进行了测试,结果表明:采用改进后的人工势场模型 后,手指跟随运动的误差得到了明显的改善,而且提 高了响应速度。仿真结果表明:采用改进后人工势场 控制模型后,3手指的协同性较好,从而验证了改进后 的人工势场在多电机协同控制中的作用,为采摘机器 人仿生机械手的研究提供了重要借鉴。 ・[16] 刘金龙,郑泽锋,r为民,等.埘靶喷雾红外探测器的设 计与探测距离测试[J].江苏农业科学,2013,41(7): 368—370. [17] 高国琴,李明.基于K—means算法的温室移动机器人导 航路径识别[J].农业上程学报,2014,30(7):25—33. [18] 方莉娜,杨必胜.乍载激光扫描数据的结构化道路自动 提取方法[J].测绘报,2013,42(2):260—267. [19] 熊爱武.基于车载激光云点数据的道路模型重建[J]. 234・ 201 7年5月 地理信息世界,2013,20(6):86—88. 农机化研究 (11):26—30. 第5期 魏泽鼎,贾俊国,王占永.基于视觉传感器的棉花果实 定位方法[J].农机化研究,2012,34(6):66—68. 张玲玲,贾元华,曹瑾鑫.基于人工势场的交叉口车辆 集聚模型[J].北京交通大学学报,2012,36(6):117— 121. [25] 李晓光,姚自强,杨旭.基于人工势场法的迷宫路径搜 索算法设计[J].北京交通大学学报,2014,38(5):27— 31. [26] 王佳.基于人工势场方法的WSN传感覆盖率提高算法 [J] 传感技术学报,2012,25(6):821—825. [27] 张得涛,王少军,杨智利.转炉倾动系统电机同步控制 研究[J].自动化技术与应用,2013,32(8):3-5. [28] 郭叔增.现代印刷技术中的无轴传动系统[J].中国科 [22] 姬伟,程风仪.基于改进人工势场的苹果采摘机器人机 械手避障方法[J].农业机械学报,2013,44(I1):253 —259. [23] 王建鑫,杨涛,李文.基于人工势场法的虚拟夹具建模 技术研究[J].工业控制计算机,2013,26(9):103一 l05. 技信息,2014(2):109—111. [29] 曹玲芝,马跃军.基于偏差耦合的PMSM滑模变结构同 步控制[J].微特电机,2012,4O(9):56—59. [24] 裴文祥,唐敦兵,顾文斌,等.基于人工势场的车间作业 [30] 彭晓燕,刘威,张强.基于改进型偏差耦合结构的多电 机同步控制[J].湖南大学学报,2013,40(11):77—83. 调度应用与研究[J].中国制造业信息化,2012,41 Improved Artiicifal Potential Field Chen Dongfeng (Institute of Applied Electronics,Chongqing College of Electronic Engineering,Chongqing 40 1 33 1,China) Abstract:It presents an application to fruit picking robot execution for bionic manipulatorand designs bionic robot fin. ,ger joints micro motor coordinated control,virtual shaft system,which improves the picking robot finger joint flexibility, reduces the fruit picking robot picking the damage to the fruit in the processAccording to traditional motor artiicial po f.tential field controller,it is difficult to meet the load disturbance caused by multi motor real—time synchronous 0Derati0n. The adjacent attraction is the artiifcial potential field of multi motor synchronous control method.Through the interaction of adjacent motor,each motor cooperative work and reduce the load disturbance for bionic robot finger in coordination of interference.The results show that the artificial potential field model can effectively improve the follow the finger ang1e er- rot with high efficiency response,and it can be error can be reduced to a minimum in a shorter periodThe picking .process is with the help of finger coordination of research Oil virtual simulation.The simulation results show that the im proved artificial potential field to control the numerical difference of the angular velocity of the model of three tingers is smaller,the three fingers are in good synergy,which can meet the requirements of the control collaborative design. Key words:picking manipulator;artificial potential field;bionic machinery;virtual simulation:collaborative control ・235・