机器人六维腕力传感器标定方法和标定装置的研究

机器人六维腕力传感器标定方法和标定装置的研究 机器人六维腕力传感器标定方法和标定装 置的研究 第26卷第1期 2005年1月 计量 ACTAMEIR0LOGICASINICA Vo1.26.?l January2OO5 机器人六维腕力传感器标定方法和标定装置的研究 郑红梅,刘正士,王勇 (合肥工业大学机械与汽车工程学院,安徽合肥230009) 摘要:通过对机器人六维腕力传感器系统的各种标定方法的分析讨论,说明了应采用阶跃响应的方法来对它 的动态性能进行标定.从矩形脉冲频谱对系统传递函数影响的角度,说明了为减少矩形脉冲频谱对传递函数标定 曲线的干扰,应使阶跃激励开始时刻前的采样点数为零.新 设计 领导形象设计圆作业设计ao工艺污水处理厂设计附属工程施工组织设计清扫机器人结构设计 的实验方法和实验装置便于测出标定中使用的激 励信号,通过数据采样系统的"软触发"功能,准确抓取到阶跃开始时刻,减少了干扰.同时,在该实验台上加载所 使用的定滑轮数量较少,也有效地减小了标定误差. 关键词:计量学;六维腕力传感器;动态标定;阶跃响应;软触发 中图分类号:TB931文献标识码:A文章编号:1000一ll58(20o5)1-0043—04 StudyontheMethodofDynamicCharacteristicCalibration ofthe6一AixsWristForceSensorforRobot ZHENGHong-mei,LIUZheng-shi,WANGYong (SchoolofMechanicalandAutomobileEngineering,HefeiUniversityofTechnology,Hefei, Anhui230009,China) Abstract:rnlestepl~sponsemethodshouldbeapedinthedynamiccharacteristiccalibrationofthe6一aixswristforcesen- sorforrobotand80mecomparisonsaremadewithothercalibrationmethods.Beforestartingthestepdrivepulse,thesampling numbershouldbezeroinordertoreducetheinterferencefromtherectanglepulsesignalspectrumtotransferfunction.Anewde- signedexperimenttableiseasytogetthedrivesigna1.Addedbysamplingprogram,thetriggertimeofstepdrivecanbecaptured. nlen,theinterferencecanbereducedtozei'o.AveryfewofcrownblocksontheexperimenttableCOuldbeused,thUSthecall— brafionelTorisreduced. Keywords:Metrology;6一 axiswristforcesensor;Dynamiccharacteristiccalibration;Steprosponse;Softtrigger 1引言 机器人六维腕力传感器是机器人最重要也是使 用最广泛的一种传感器,将它安装在机器人操作手 腕部,用来检测机器人操作手与外部环境相互接触 或抓放工件时,三维空间的全力信息,为机器人力控 制,力/位置混合控制系统提供反馈信息.由于设计 和制造等原因六维腕力传感器不可避免地存在测量 误差,且各输出通道之间存在着相互耦合和干扰,另 一 方面,传感器阻尼比小,达到稳定时间长,而随着 高速,高精度机器人的发展,一般要求机器人控制系 统中的伺服数字采样周期为毫秒级,对传感器的动 态性能的研究也显得越来越重要….因此六维腕力 传感器的标定应包括动态和静态两个方面,其标定 方法和装置远比一般的一维力传感器复杂得多. 目前,国内外对腕力传感器的标定主要集中在 静态方面,如传感器的数字解耦,线性和灵敏度的标 定,输入力的作用点偏离和作用线偏斜等所引起的 输出误差的分析,而对动态性能及其标定的研究较 收稿日期:2003—05—08;修回日期:2003—06—24 基金项目:国家863 计划 项目进度计划表范例计划下载计划下载计划下载课程教学计划下载 智能机器人主题资助项目(863—512—02—02);合肥工业 大学科学研究发展基金项目(030206F) 作者简介:郑红梅(1966一),女,安徽长丰县人,合肥工业大学机械与汽车工程学院 副教授,主要从事CAT/CAD/CAM及系统动力学研究. 计量2005年1月 少.国际国内市场上销售的腕力传感器的产品说明 书中也没给出动态性能指标,只有A/D转换后微处 理器的信号处理时间,它并不能反映从加力至传感 器输出达到稳定的时间"]. 研究可靠性和准确度高的传感器标定方法和标 标定都非常重要.对传感 定装置对传感器的研制, 器的静态标定进行加载较为容易,实验装置的设计 也较为简单,但对动态标定装置的设计将随标定方 法的不同而改变. 2标定方法的选择 2.1用脉冲响应法进行标定 实验时只需头部带高精度压电式传感器的脉冲 锤和安装有腕力传感器的支架,设备较简单.在脉 冲试验时,用脉冲锤敲击腕力传感器,脉冲锤自带的 压电式传感器和六维腕力传感器分别输出激励和响 应信号,对激励和响应信号进行采样后再标定.经 多次实验发现,用脉冲响应法进行标定时,脉冲锤的 施力点和施力方向很难确定,虽实验过程简单,但实 验的准确性和重复性较差.由于很难准确施加脉冲 激励力矩信号,因而难以对腕力传感器的力矩测量 准确度进行标定. 2.2用频率响应法进行标定 实验时需用不同频率的谐波信号进行激振或对 传感器进行连续扫频,而且传感器的固有频率也应 被包括在激振或扫频的频率范围内.由于腕力传感 器的固有频率一般在600,1000Hz之间,测量的频 率范围大,用不同频率的谐波信号进行激振所需实 验次数太多,实验繁杂费时.现有的实验设备又很 难准确产生连续扫频所需的频谱激振信号,因而用 此方法进行标定较难实现. 2.3用阶跃响应法进行标定 用实验的方法产生阶跃激励信号相对较为容 易,而且系统的性能指标多是以系统对单位阶跃响 应的形式给出的.机械手在实际操作中,如抓起或 放下工件,给腕力传感器的输入与阶跃输入相似,阶 跃输入往往又是实际操作中最不利的输人情况.另 外,根据系统对单位阶跃输入的响应也比较容易求 得对任何输入的响应. 产生阶跃激励信号常用的方法是在实验台上用 细绳悬挂砝码,通过定滑轮组给力传感器施加力(或 力矩),然后剪断细绳突然释放砝码,从而产生一个 负的阶跃力,力矩,即对传感器施加阶跃力(或力矩) 的激励信号. 3加载方法的讨论 文献[4]是采用释放砝码产生负阶跃激励的方 法,进行六维力传感器的动态建模,其加载方式如图 1所示. n Il h\ 剪断处 I器X 厂,--_ y (a)旖加Mx(My))'3~-(b)施加?力 图1文献[4]中传感器动态建模实验加载示意图 图1所示实验装置的设计思想很好,但由于当 时实验条件限制,还存在一些不足.从图1中可以 看出,其加载所用的绳子较长,定滑轮较多.根据文 献[5]对向加载时加载系统的误差分析可知,加载 系统的误差是由砝码的误差,滚珠轴承摩擦力矩引 起的误差以及实验台结构,制造,装配和调整等误差 引起的.要减小标定误差,应减少加载装置中使用 的定滑轮数目,减短悬挂砝码所用绳子的长度,另外 还要提高实验台上每个零件的制造精度和实验台的 装配精度,否则会直接影响传感器的标定准确度. 在用阶跃响应的方法建立传感器的动力学模型 时,为消除矩形脉冲频谱对系统传递函数的影响,实 际做Fftr时应抓取阶跃开始时刻,使阶跃前的采样 点数为零,因为采样点数决定着传递函数曲线中干 扰的大小,对系统辨识影响很大.图2为阶跃时刻 开始前采样点数不同时的传递函数受干扰的情况, 从图2可以看出,阶跃开始时刻前采样点数越多,干 扰越大,当采样点数为1时,干扰频谱基本为直线, 干扰很小,因而准确获取阶跃开始时刻对传感器动 态标定非常重要. 由于实验条件的限制文献[4]不能直接测量出 激励信号.在建立传感器的动力学模型时,根据砝 码的重量在计算机上用程序构造了一个激励信号. 但在实际的实验过程中,由于绳子的长度,绳子的弹 性和定滑轮的摩擦等原因,使得阶跃激励起始时刻 与截断绳子时刻并不同步,难以获取准确的阶跃信 号开始时刻,必然会造成矩形脉冲频谱对系统传递 函数的影响.再者,由于定滑轮组内存在摩擦等原 第26卷第1期尚丽平等:水中微量矿物油污染的光纤荧光监测技术及应用研究85 油浓度测量仪测量结果与FR.540荧光分光光度计 测量结果非常相符. 5应用与结论 在胜利石油管理局环境监测总站,山东省日照 市环境监测站等单位配合下,进行了矿物油污染的 常规监测实验.与此同时,进行现场同步采样,实验 室按国标法进行分析测量,并进行对比分析,取得了 良好的实验结果. 日照港港池内的矿物油污染主要来自船只动力 燃烧柴油,在港池内共进行了5个点位的测量,采样 及仪器光纤探头投放深度为 表 关于同志近三年现实表现材料材料类招标技术评分表图表与交易pdf视力表打印pdf用图表说话 pdf 层,各测点按国标 GB17378.4—1998用725紫外分光光度计测量,见表 4.测量结果表明:(1)用光纤荧光测油仪直接测量 和按国标GB17378.4—1998用725紫外分光光度计 测量的结果基本吻合,两者具有很高的相关系数. (2)用两种方法都在日照港港池内c,D,E测点检出 水中含微量油分,而A,B测点均未检出,表明港池 内水质非常好,这与实际情况相符,日照港码头是新 建煤炭输出码头,来往船只很少,且大多为大吨位船 只,对排油,泄漏控制较好. 在水中矿物油荧光特性理论分析和实验研究基 础上,研制的光纤荧光矿物油浓度测量系统可实现 水中微量矿物油的实时监测,仪器的检测下限为 0.002Il1g,L,测量范围为0.O1,1.0Il1g,L,测量的最 大相对误差?5%(FS). 表4日照港港池内5个测点测量结果对比 [参考文献】 [1]夏达英,王振先,李宾,等.用于探测海水中油份的 便携式油份测定仪研究[J].黄渤海海洋,1998,16(4): 28,34. [2]陈国珍,黄贤智.荧光分析法[M].北京:科学出版社, l990.23,94. [3]尚丽平.水中痕量矿物油污染荧光监测全光纤实现技 术及应用基础[D].燕山大学,2002. (上接第45页) 一 种新型的标定机器人腕力传感器的实验台,其优 点是使用了一个高精度的压电式传感器来测量阶跃 激励信号,不必再用计算机进行虚构,从而提高了标 定的准确性.在实验信号采集程序中还设置了"软 触发"功能,用来及时捕捉阶跃激励信号的开始时 刻,使阶跃激励开始时刻前的采样点数为零,消除了 矩形脉冲频谱对系统的干扰.此外,在该实验台上 进行加载时,所使用的定滑轮的数目较少,这也大大 减小了标定误差.最后在此实验台上对一只传感器 进行标定,其标定结果与理论分析结果基本一致,证 明了此标定台的设计和加载方法是正确的. [参考文献】. [1]王国泰,易秀芳,王理丽.六维腕力传感器发展中的几 个问题[J].机器人,1997,19(6):474—478. [2]陈雄标,袁哲俊,姚英学.机器人用六维力传感器标定 研究[J].机器人,1997,19(1):7一l1. [3]吴涓,曹效英,宋爱国,等.Maflab在六维腕力传感器系 统标定中的应用[J].传感技术,2001,(3):181一 l85. [4]徐科军,朱志能,李成,等.六维腕力传感器阶跃响应的 实验建模[J].机器人,2000,22(4):251—255. [5]刘正士.机器人六分量腕力传感器加载试验台系统误 差分析[J].计量,1998,19(1):44—50. [6]汪小龙.六维腕力传感器动态特性补偿系统的实用化 方法与技术研究[D].合肥:合肥工业大学,2000. [7]刘正士,陆益民,陈晓东,等.一种高性能六维腕力传感 器弹性体结构设计[J].应用科学,2001,19(1): 58.-61.