[发明专利]一种基于四阶矩估计的工业机器人可靠性计算方法有效
申请号: | 201710551484.2 | 申请日: | 2017-07-07 |
公开(公告)号: | CN107443370B | 公开(公告)日: | 2019-11-26 |
发明(设计)人: | 王进;王伟;陆国栋 | 申请(专利权)人: | 浙江大学 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 33200 杭州求是专利事务所有限公司 | 代理人: | 林超<国际申请>=<国际公布>=<进入国 |
地址: | 310058 浙江*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 四阶矩 估计 工业 机器人 可靠性 计算方法 | ||
1.一种基于四阶矩估计的工业机器人可靠性计算方法,其特征在于包括以下步骤:
第一步:根据机器人的连杆臂结构建立包含基坐标系和关节局部坐标系的D-H连杆坐标系;
第二步:通过机器人连杆臂的正运动学获得机器人末端位置相对于基坐标系的齐次矩阵得到机器人末端的理论位置相对于基坐标系O_XYZ的坐标值为P(x,y,z),上述齐次矩阵采用如下表达式:
其中,n表示机器人的自由度数,R表示机器人末端在基座标系中的姿态矩阵,P(x,y,z)表示机器人末端位置坐标,П表示连乘符号;
第三步:将机器人第i个连杆臂处的连杆臂长度ai和连杆偏距di的尺寸偏差定义为满足正态分布的随机变量,连杆臂长度和连杆偏距的均值分别为μai和μdi,标准差分别为σai和σdi;同时将机器人第i个连杆臂处包含关节间隙的旋转关节的关节转角θi定义为满足均匀分布的随机变量,关节转角在均匀分布下的上边界为θi+Δi,下边界为θi-Δi;
第四步:利用MATLAB的随机数函数normrnd生成满足正态分布的随机数表示连杆臂长度和连杆偏距,利用随机数函数unifrnd生成满足均匀分布的随机数表示关节转角;
第五步:通过第四步生成的随机数值,利用第二步正运动学表达式的齐次矩阵计算机器人在第j次运动中实际末端位置相对于基座标系的坐标值为P′(x′,y′,z′),再采用以下公式计算获得机器人末端运动误差εj:
第六步:设定机器人末端的定位精度为Δr,重复第四步~第五步进行N次,共获得N个机器人末端运动误差值,将所有机器人末端运动误差值组成一个样本数据;
第七步:对第六步中获得的样本数据进行分析,计算机器人末端运动误差ε的均值με,计算公式为:
其中,εj表示第j次运动中的机器人末端运动误差;
第八步:对第六步中获得的样本数据进行分析,计算机器人末端运动误差ε的前四阶中心矩计算公式为:
其中,k表示阶数,取值为k=0,1,2,3,4;
同时以二阶中心矩作为机器人末端运动误差的方差,即其中σε表示机器人末端运动误差的标准差;
第九步:根据机器人运动可靠性的定义,建立机器人系统的功能函数g(ε),表达式为:
Z=g(ε)=Δr-ε
其中,Z表示功能函数的取值,Δr表示机器人末端的定位精度,ε表示机器人末端运动误差;
第十步:根据机器人末端运动误差ε的均值με及其前四阶中心矩和通过第九步建立的机器人系统的功能函数g(ε),计算机器人系统的功能函数g(ε)的均值μZ,计算的公式为:
μZ=Δr-με
再计算机器人系统功能函数的前四阶中心矩计算公式为:
其中,k表示具体的阶数,取值为k=0,1,2,3,4;
同时以二阶中心矩作为机器人系统功能函数的方差,即其中σZ表示机器人系统功能函数的标准差;
第十一步:将功能函数值Z变换为均值为0、方差为1的标准随机变量Y,变换公式为:
计算标准随机变量Y的前四阶中心矩计算公式为:
其中,k表示具体的阶数,取值为k=0,1,2,3,4;
第十二步:定义随机变量Y的信息熵为H[f(y)],信息熵具体表达式为:
H[f(y)]=-∫Yf(y)ln[f(y)]dy
其中,f(y)表示随机变量Y的概率密度函数;
将标准随机变量Y的前四阶中心矩作为约束条件,根据最大熵原理构造拉格朗日函数,拉格朗日函数表达式为:
其中,λk为第k阶对应的拉格朗日系数,λk=(λ0,λ1,…,λ4);
利用拉格朗日函数L对概率密度函数f(y)求偏导数,使得在极值点处偏导数为0,求导过程具体表达式为:
第十三步:根据上一步求导过程,采用以下公式计算获得随机变量Y的概率密度函数f(y),表达式具体为:
第十四步:根据随机变量Y的概率密度函数f(y),计算出机器人的可靠性计算过程表达式具体为:
其中,σz表示机器人系统功能函数的方差,μz表示机器人系统的功能函数g(ε)的均值。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于浙江大学,未经浙江大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201710551484.2/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种带液力反馈的谐振孔板式电控喷油器
- 下一篇:一种用于检测甲醇喷油器的装置