为了正常的体验网站,请在浏览器设置里面开启Javascript功能!

智能开罐机机械手控制算法的设计

2011-10-13 3页 pdf 213KB 21阅读

用户头像

is_700077

暂无简介

举报
智能开罐机机械手控制算法的设计 机器人技术 文章编号:1008-0570(2008)09-2-0185-02 智能开罐机机械手控制算法的设计 Design of Control Algorithm of Intelligent Manipulator Cans Rolling M achine f1.上海医疗器械高等专科学校;2.华东理工大学)季 冰 Jl Bing 摘要:近年来随着软 包装材料及工艺的发展 ,软 包装罐头开始零星 出现。用于玻璃瓶罐头加工的包装机械的研究,对我国罐 头行业的持续发展起着非常重要的作用。本文设计了智能开...
智能开罐机机械手控制算法的设计
机器人技术 文章编号:1008-0570(2008)09-2-0185-02 智能开罐机机械手控制算法的设计 Design of Control Algorithm of Intelligent Manipulator Cans Rolling M achine f1.上海医疗器械高等专科学校;2.华东理工大学)季 冰 Jl Bing 摘要:近年来随着软 包装材料及工艺的发展 ,软 包装罐头开始零星 出现。用于玻璃瓶罐头加工的包装机械的研究,对我国罐 头行业的持续发展起着非常重要的作用。本文设计了智能开罐机机械手的控制算法,通过采用先进控制算法对电机电流进 行控制.精确调整机械手抓瓶力量和机械手旋盖力矩 ,完成开罐动作 的优化控制。 关键词:机械手;开罐机;算法;模糊控制 中图分类号:~P872 文献标识码:A Abstract:Recently,as the de~fopmem of the soft packing material and the crafts,the soft packing cans appear,but just a little. The rlesear℃h of the packing mechanism used for the glass bottle cans, plays an important role in the development of the cans indus- try in our country. The new type of bottle rolling machine described in this paper is called Manipulator Bottle Rolling Machine. Its controlling precision is achieved by watching and controlling the motor current. The machine can adjusts the strength of snatching bottles and the moment of rolling,then achieves an optimize control、 Key words.-M echanical Arm;C8ns Rolling M achtne;Algorit~ ;Fuzzy Control 1引言 我国农产品丰富,对各种农产品进行加工的罐头生产行业 在我国发展迅速 ,用于玻璃瓶罐头加工的包装机械的研究,对 我国罐头行业的持续发展起着非常重要的作用。开罐机主要用 于玻璃瓶和PET瓶的螺纹盖封口。旋盖电机控制是开罐机机械 手设计的重点,本文讨论针对旋盖电机转距和转速综合控制。 现代控制理论和智能控制理论都得到了充分的应用,如采用神 经网络控制、模糊控制、变结构、参数自造应控制等各种先进控 制策略对无刷直流电机进行控制。本系统将采用模糊算法进行 旋盖电机控制,调节旋盖电机的旋盖力矩。 2开罐机械手运动 由于开罐机械手安装在旋转工作台,并与工作台同步运 动,即必须与待旋盖的瓶子同步运动。除了这个同步运动外 ,机 械手须完成的动作还有:机械手下降抓瓶、机械爪旋转旋盖、机 械手跟踪旋转运动下降。开罐机械手运动规划如图 1所示。 下 抓 旋 手 下 豸 曩 __ 磊 薏 }4旋盏结束 下降电机减速1 。叫 图 1开罐机械手运动规划 当罐头瓶进入旋盖工位后 ,机械手必须快速下降,定位到 罐头瓶 口。要提高机器生产效率,必须将机械手快速定位到特 定位置,以便进行旋盖运动。同时,机械手抓瓶力矩要求精度很 高,也就是对电机力矩的控制精度要求很高,不然会影响到罐 头质量。因此,该运动过程设计的电机控制技术是电机快速定 季 冰:硕 士研 究生 助教 位技术、电机旋转力矩精确控制技术。 机械手下降到位后,机械爪旋转进行旋盖动作,同时机械 手跟踪机械爪旋转运动,按一定比例下降。对旋盖电机,需要使 用到电机力矩精确控制技术,电机位置控制及检测技术。对驱 动机械手下降的电机,则需要使用到电机跟踪技术,它必须按 特定比例跟踪旋盖电机速度,因为瓶盖旋转时存在下降运动, 而这两个运动是关联的。 当判断到旋盖动作、旋盖指标达到要求时,旋盖电机、机械 手下降运动电机。旋盖指标达包括旋盖力矩 、电机位置两方面 的要求。鉴于旋盖电机控制的复杂性 ,本文选取旋盖电机控制 进行算法设计 ,文中采用模糊控制进行旋盖电机控制。 3模糊控制及模糊控制器的原理与组成 模糊控制 uzzy Contro1)是一种以模糊集合论、模糊语官 变量及模糊逻辑推理为数学基础的新型计算机控制。模糊 控制是模糊数学的基础上发展起来的,通过计算机或者各种微 处理器来实现。 目标值— — 二 噩团 壅塑垂 匿卜 ]塑麴亘]I 二 j ]T+输出值 j L⋯ ⋯⋯ 圃 -u ⋯i 图2模糊控制系统结构图 模糊控制系统具有与数字控制系统的一般结构形式,如图 2所示。图2图中,模糊控制器是系统核心,实际上它是一台微 计算机,完成输入量的模糊化、模糊关系运算、模糊决策以及决 策结构非模糊化等重要过程。模糊控制器的智能程度,在很大 程度上,决定一个模糊控制系统的性能指标的优劣。 模糊控制器是模糊控制系统的核心,它通过在微计算机上 用软件编程实现。模糊控制器完成的任务有 :首先,微计算机采 @国自控嗣邮局订阅号:82躺360~/ -185— 维普资讯 http://www.cqvip.com 机器人技术 中文核心期刊 《微计算机信息》(嵌入式与SOC)2008年第24卷第9-2期 集被控对象输出信号的精确值;然后,将该信号与给定值相比 较得到误差信号E,并将误差信号 E的精确值变成模糊量,得 到误差 E的模糊语言集合的一个子集 e,至此 ,。已是一模糊向 量;最后 ,用 e和模糊控制规则 R根据推理的合成规则进行模 糊决策,得到模糊向量 u为 :u=e·R。 为对被控对象实现精确控制,必须进行反模糊化,把模糊 量转换成精确量,去控制控制执行结构运行相应的动作。该过 程如图3所示。 系 统输入 广 — — J L — — ] l 模糊化 l I。。。。。。。。。。。。。’ ’。。‘’ 。。’。。。。。。。。。。 模糊控制规则 厂_——L] ⋯ ⋯ ⋯ ~ 一 ⋯ ⋯ .1 模糊推理l 模糊输出 l 反模糊化I 系统输出 图 3模糊控制系统处理流程图 4旋盖电机模糊控制器设计 4.1旋盖电机控制变量及其关系 旋盖电机是驱动机械手旋盖的动力装置,为提高开罐机效 率,旋盖电机必须在尽可能短的时间内完成旋盖动作。 旋盖电机控制系统如图 4所示。电机采用 PWM驱动电路; 电流检测采用电流传感器;速度检测采用光电编码器。得到的 电机速度和电流与旋盖电机力矩给定值一起作为旋盖电机模 糊控制器的输入变量,控制器输出是驱动电机的 PWM波形。 图 4旋盖电机控制系统 控制对象是旋盖力矩和旋盖速度 ,根据旋盖动作的要求 , 旋盖电机开始运行时力矩小 ,电机以较高的速度旋盖,随着旋 盖动作的进行,电机力矩加大,电机速度逐渐减小 ,当电机力矩 达到旋盖电机力矩给定值时,电机速度为零。 4.2检测值的初步处理 旋盖电机力矩给定值为 T,最大转速给定值为 V,力矩 T是 实际旋盖所需力矩,v是实际的旋盖试验测得的转速最大值。 首先根据式 )将电机力矩给定值转换成对应的电流大小,设 力矩给定值为 T对应的电流给定值为 I。假设系统中电机最大 转距为 I,最大转距为 2v,检测得到的力矩或转速超过假设 的 最大值时,做假设的最大值处理。即对电机力矩检测值和转速 检测之作如下处理:fj 当i
示 ,只是他 们都表示为正值。精确输入、输出量量化到模糊论域的方法本 设计采用 Mamdani提出的标准化设计方法,即将转速偏差 e、, 的模糊论域设为『_6,+611X间内并使之离散化,构成含 13个整 数元素的离散集合: 卜6,一5,一4,一3,-2,-1,0,1,2,3,4,5,6】; 对于电机转距偏差 eI由于没有负值,故将其量化到 : 【0,1,2,3,4,5,6,7,8,9,10,11,12】; 而对控制器输出u,由于存在加减速情况,将其量化到: 【一6,一5,一4,-3,一2,一1,0,1,2,3,4,5,61。 电机转距的范围为『0,e ,其中电流en.t~=I,根据其模糊 论域范围,其量化系数为: , : 旦 转速偏差ev的范围:e=【一e e 一,e =V,其对应的模糊 论域为:{---6,一5,-4,一3,一2,一1,0,1,2,3,4,5,6},则量化系数为: k (3) 考虑输出值的范围只在正方向上变化 ,基本论域为 u:『0, 1】,则将其量化到模糊论域卜6,一5,一4,一3,一2,一1,0,1,2,3,4, 5。6}的方法为: , y=12. 一 1) (4) 量化后的 Y值,需要进行取整运算以映射到模糊论域中。 本设计采用三角形的隶属函数形式,同时选取两两模糊集合重 叠时的 a值为 0.5。 5模糊控制规则的制定 对于旋盖电机转速转距控制,根据该旋盖电机控制要求和 系统的性能指标 ,以及输入输出之间的关系制定控制规则。通 过对电机旋转瓶盖进行试验,做出旋盖电机实际的转距曲线和 转速曲线,选取电流、转速符合开罐机控制要求的曲线作为实 际控制控制要求,依据这两条曲线的过程特征以及输入输出之 间的关系制定控制规则。根据以上规则可制定出模糊控制规则 表,如表 1所示: 表 1模糊控制规则表 NB NM NS Z PS PM PB PB PB PB PM PM PM PS NM PM PB PM PM PS PM PS NM PS PM PM PS PS PS Z NS Z Z PS PS Z Z Z Z NS NS NM NS NS NS NS NB NM NM NM NM NS NM NM NB NB NM NB NM NM NM NM NB 该模糊控制规则表中包含的每一条模糊条件语句都决定 一 个模糊关系,表中模糊规则选用“if eI and ev then u”的形式 , 表中模糊规则 R.,R2按照模糊理论中的关系式表示为: R.=[( ) ,×( ) r×(们 ) = [(ⅣB) ×(朋 ) 】 ×( ) (5) 由此类推可得到共 49条控制规则关系式,控制器总的模 糊关系R为: R=RIV V..·V尼8VR49 f61 本文创新点 本文针对旋盖电机转距和转速综合控制 ,建立了采用模糊 转第 189页) 一 186—360元 /年 邮局订阅号:82-946 维普资讯 http://www.cqvip.com 机器人技术 图 2和图 3所示。图中黑线即为两种情况下所得到的最优路 径,也即从栅格 0到栅格 99的最短无碰撞路径。图 2中表示路 径的个体适应度值f=0.0612044,图 3中表示路径的个体适应度 值 f=0.0601834。在图4中,给出了在图 3所示障碍物分布的情 况下,种群个体适应度值在算法执行过程中大体的变化情况。 其中,图 4fa1中分别列出了初始种群的适应度值、初始种群经插 入和删除操作后的适应度值,以及第一代种群和第十代种群的 适应度值的分布。图 4(b)是图 4fa】中各种群适应度值在同一图 中的反映。图4fc)中是第二十代、第三十代、第四十代和第五十 代各种群的适应度值分布。在五十代以后 ,各代种群的适应度 值都是收敛的,如图 4fd)所示。从整体上可以看出,随着进化代 数的增加,种群个体平均适应度值增大直至收敛。 图 2仿真结果一 。“; s ,o 韧始种群的适应度 第 代种群的适应度 插^和删障后的适应f 笨Ht种群的适应庙 0 J 2 3 4 5 6 , 8 9 JO 图3仿真结果二 (c) (d) 图4 遗传算法运算过程中种群个体适应度值的变化 4结束语 本文创新点在于提出了新的变异算子、插入和删除算子 , 增加了最优保存策略,因而提高了路径搜索速度和搜索过程中 的避障能力。对算法进行的仿真实验表明,本文提出的移动机 器人路径规划可以有效地获得在 由栅格表示环境下移动机器 人的最短路径。 基金项 目的经济效益:100万元以上,来源于重庆市外专 局。在本单位现有的Pioneer 3-Dx型移动机器人上来研究机器 人的导航、定位、地图构建、路径规划及多传感器信息融合等机 器人相关技术。 参考文献 【1]ZHAO M,ANASARI N,HOU E.Mobile manipulator path plan- ning by a genetic algorithm[A1..Proceedings of the International Conference on Intelligent Robots an d System 【C】.USA:IEEE,1992.(1):681-688 『21喻国平,刘林.基于遗传算法的汽车调度问题研究【J].微计算机 信息.2006 .22。12Z:217—219 I3]AI EXOPOUI OS C,GRIFFIN P M .Path pla—nning for a mo— bile robot[J1.IEEE Transactions on Systems.Man and Cybernetics. 199Z,22(2):318-322 [4]BORENSTEIN J,K 0REN Y.Real一.time obstacle avoidance for manipulators and mobile robots【J].IEEE Transactions on Systenl8。 Man and Cybernetics,1989.5(1 9):1 179—1 187 【5】孙树栋,曲彦宾.遗传算法在机器人路径规划中的应用研究[J】. 西北工业大学学报,1998,16f1):79—83 [6]张颖,吴成东,于 谦.基于遗传算法的机器人路径规划叽20O2'18(4) 作者简介 :x_~(1981-),男 ,硕士。研究方向:移动机器人路径规 划;张 毅(1969一),男 ,教授、博士生导师。主要研究方向:数据融 合、现代移动通信理论与技术、现代信号处理在移动通信中的 应用等。 Biography:WANG-Zhou,male,Master,major in Path Planning 0f Mobile Robot. (40o0~5 重庆 重庆邮电大学智能系统及机器人研究所1王洲 (Research Center of Intelligent System and Robotics。 Chongqing University of Posts and Telecommunications, Chongqing 40OO65.China)WANG Zhou 通讯地址:(400065重庆邮电大学自动化学院 77#信箱1王洲 (收稿日期:2008.07.23)(修稿日期:2008.09..05) (上接第 186页) 算法控制无刷直流电机的数学模型,调节旋盖电机的旋盖力矩。 项目经济效益约为 100万元。 参考文献: 【1】SIMATIC$7-200系统手册.北京:西门子(中国)有限公司.2004.6 [2】熊幸明等.一种工业机械手的 PLC控制.微计算机信息.2006 .. 1 1—1:120—122 【3】李朝青等.无线发送,接收 Ic芯片及其数据通信技术选编.北 京:北京航空航天大学出版社.2003.5 [4】彭魏臻.PPI分析.化工自动化及仪表.2006(4):P.47—50 【5】程军.亿恒 (西门子)C166系列 16位单片机原理与开发 . 北 京:北京航空航天大学出版社.2001.12 作者简介:季冰 (1978.4一),江苏泰州人,硕士研究生 , 助教.研 究方向:工业 自动化。 Biography:JI Bing('1978_4一),Born in Jiangsu Taizhou.Posstgrad-. Hate,Teaching Assistant,Research Areas:Industrial Automation . (200093上海医疗器械高等专科学校)季 冰 (200237华东理工大学 机械与动力工程学院1季 冰 (Shanghai Medical Instrumentation College,Shanghai 20093) JIBing (East China University of Science and Technology,Shanghai 2000237)JI Bing 通讯地址:(2ooo93上海市军工路 516号 306号楼 801室)季 冰 (收稿日~h2oo8.07.23) 稿13期:2008.09.O51 @国自控阁邮局订阅号:82.946 36。元/年一189— 维普资讯 http://www.cqvip.com
/
本文档为【智能开罐机机械手控制算法的设计】,请使用软件OFFICE或WPS软件打开。作品中的文字与图均可以修改和编辑, 图片更改请在作品中右键图片并更换,文字修改请直接点击文字进行修改,也可以新增和删除文档中的内容。
[版权声明] 本站所有资料为用户分享产生,若发现您的权利被侵害,请联系客服邮件isharekefu@iask.cn,我们尽快处理。 本作品所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用。 网站提供的党政主题相关内容(国旗、国徽、党徽..)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。

历史搜索

    清空历史搜索