CN114670205B - 一种多轴机器人机械传动解耦的方法 - Google Patents
一种多轴机器人机械传动解耦的方法 Download PDFInfo
- Publication number
- CN114670205B CN114670205B CN202210474782.7A CN202210474782A CN114670205B CN 114670205 B CN114670205 B CN 114670205B CN 202210474782 A CN202210474782 A CN 202210474782A CN 114670205 B CN114670205 B CN 114670205B
- Authority
- CN
- China
- Prior art keywords
- gear
- shaft
- transmission
- bevel gear
- relation
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 230000009347 mechanical transmission Effects 0.000 title claims abstract description 19
- 230000005540 biological transmission Effects 0.000 claims abstract description 114
- 238000004364 calculation method Methods 0.000 claims abstract description 14
- 238000007670 refining Methods 0.000 claims abstract description 4
- 230000008878 coupling Effects 0.000 claims description 20
- 238000010168 coupling process Methods 0.000 claims description 20
- 238000005859 coupling reaction Methods 0.000 claims description 20
- 230000008569 process Effects 0.000 claims description 9
- 238000010276 construction Methods 0.000 claims description 7
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 3
- 208000032369 Primary transmission Diseases 0.000 claims description 3
- 239000002131 composite material Substances 0.000 claims description 3
- 230000001419 dependent effect Effects 0.000 claims description 3
- 230000009467 reduction Effects 0.000 claims description 3
- 230000003068 static effect Effects 0.000 claims description 3
- 241000282414 Homo sapiens Species 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
Abstract
本发明涉及一种多轴机器人机械传动解耦的方法,包括如下步骤:(1)原机械传动工况分析提炼,得到原传动函数关系式;(2)设计差动齿轮箱,进行差动齿轮箱数学解析;(3)确定解耦合传动关系解析式;(4)根据确定解耦合传动关系解析式的传动关系确定传动结构;(5)校核传动关系结构,满足结构的几何关系,确保实用性。本发明技术方案的实施,机器人各轴传动独立,不相互耦合,机器人电机驱动控制中不需要进行控制解耦,大大减少控制的难度和控制算法的复杂性;减少了机器人计算和控制的精度误差;对电机调速特性的要求低,电机设计和选型减少难度。
Description
技术领域
本发明属于多轴机器人应用技术领域,具体涉及一种多轴机器人机械传动解耦的方法。
背景技术
机器人是一种能够半自主或全自主工作的智能机器,可以辅助甚至替代人类完成危险、繁重、复杂的工作,提高工作效率与质量,服务人类生活,扩大或延伸人的活动及能力范围。机器人通过驱动系统驱动工作单元产生运动,从而完成需要的动作。机器人传动系统,是将驱动器输出的运动和动力传送到工作单元的一种装置。传动系统有多种方式,机械传动是常见的一种方式。
为了提高了抓取高温工件的耐热能力,大幅减少机器人前端的质量,降低机器人重心,提高机器人的运动稳定性,机器人布置一般采用电机后置方案,即将机器人5轴和6轴电机后置,放在大臂位置,保证了机器人末端外形小巧,但也给机械传动带来了一些问题,即传动耦合,传动耦合会带来如下问题:1、电机驱动控制中需要进行控制解耦,因为控制解耦和机器人串联位姿计算相互影响,大大增加控制的难度和控制算法的复杂性。2、因为存在传动耦合,且机器人串联位姿计算的影响,增加了机器人计算和控制的精度误差。3、因为存在传动耦合,各轴对电机调速范围不同,造成对电机调速特性有更多和更严酷的要求。
综上所述,亟需提供一种机器人电机驱动控制中不需要进行控制解耦,大大减少控制的难度和控制算法的复杂性的多轴机器人机械传动解耦的方法。
发明内容
本发明的目的是提供一种机器人电机驱动控制中不需要进行控制解耦,大大减少控制的难度和控制算法的复杂性的多轴机器人机械传动解耦的方法。
上述目的是通过如下技术方案实现:一种多轴机器人机械传动解耦的方法,包括如下步骤:
(1)原机械传动工况分析提炼,得到原传动函数关系式,其中,一轴的工作单元的转速为因变量,影响该轴的工作单元的转速的因素为自变量,当自变量包括了其他轴的驱动电机的转速时,认定该轴为与其他轴耦合的耦合轴,造成干扰的其他轴则为干扰轴;
(2)设计差动齿轮箱,进行差动齿轮箱数学解析;
(3)确定解耦合传动关系解析式:采用差动齿轮箱的数学解析关系,分析原传动函数关系式,增加传动关系,再不增加新的变量的前提下,将与耦合轴驱动电机转速相关的自变量消除,得到新的关于耦合轴工作单元的转速的解耦合传动关系解析式,此时影响该轴的工作单元的转速的自变量仅包括耦合轴的驱动电机的转速;
(4)根据确定解耦合传动关系解析式的传动关系确定传动结构;
(5)校核传动关系结构,满足结构的几何关系,确保实用性。
进一步的技术方案是,所述步骤(1)中原机械传动工况分析过程如下:
轴五电机和轴六电机分别为轴五和轴六的驱动电机,轴五电机通过第三齿轮和第四齿轮将动力传给第五锥齿轮,第五锥齿轮和第八锥齿轮啮合传动,将转动传给机器人轴五的外壳,轴五的外壳作为第一行星架H1;轴六电机通过第一齿轮和第二齿轮将动力传给第六锥齿轮,第六锥齿轮和第七锥齿轮啮合传动,将转动传给第九齿轮,第九齿轮与第十齿轮啮合,将转动传给第十一锥齿轮,第十一锥齿轮和第十二锥齿轮啮合,将转动传给机器人轴六的工作单元,其中,第十齿轮、第十一锥齿轮、第十二锥齿轮固定在第一行星架H1上,第一齿轮、第二齿轮、第五锥齿轮、第六锥齿轮、第七锥齿轮、第八锥齿轮、第九齿轮的轴线固定;
轴五的传动为定轴轮系,轴五的原传动函数关系式的有公式(1)如下:
式中,nD5为轴五电机的输出转速;nS5为轴五工作单元的转速;i83为第八锥齿轮的对第三齿轮的传动比;i43为第四齿轮的对第三齿轮的传动比;i85为第八锥齿轮的对第五锥齿轮的传动比;z3为第三齿轮的齿数;z4为第四齿轮的齿数;z5为第五锥齿轮的齿数;z8为第八锥齿轮的齿数;
由公式(1)可知,原传动函数关系式,影响轴五的工作单元的转速的自变量仅包括轴五电机的输出转速,此传动具有独立性;
轴六传动为复合轮系,将其分解为定轴轮系和周转轮系,其中第一齿轮、第二齿轮、第六锥齿轮、第七锥齿轮和第九齿轮的轴线固定,为定轴轮系,传动关系有公式(2)如下:
式中,n9为第九齿轮的转数;nD6为轴六电机的输出转速;i71为第七锥齿轮的对第一齿轮的传动比;i21为第二齿轮的对第一齿轮的传动比;i76为第七锥齿轮的对第六锥齿轮的传动比;z1为第一齿轮的齿数;z2为第二齿轮的齿数;z6为第六锥齿轮的齿数;z7为第七锥齿轮的齿数;
对于第十一锥齿轮和第十二锥齿轮,轴线不固定,为周转轮系,计算时,给周转轮系加上一个绕第一行星架H1的固定轴线回转的相反的公共角速度,这时各构建之间的相对运动任将保持不变,第一行星架H1相对静止,将周转轮系转化为定轴轮系,在转化后的轮系中有公式(3)如下:
式中,为在转化后的轮系中第九齿轮的对第十齿轮的传动比;/>为在转化后的轮系中第九齿轮的转速;/>为在转化后的轮系中第十齿轮的转速;nH1为第一行星架H1的转速;n10为第十齿轮的转速;z10为第十齿轮的齿数;z9为第九齿轮的齿数;
由于nH1=nS5,可得公式(4)如下:
根据传动关系有公式(5)如下:
式中,nS6为轴六工作单元的转速;为转化后的轮系中第十二锥齿轮对第十一锥齿轮的减速比;z11为第十一锥齿轮的齿数;z12为第十二锥齿轮的齿数;
由传动关系以及公式(2)~(5)可得轴六原传动函数关系式的公式(6)如下:
由公式(6)可知,影响轴六的工作单元的转速的自变量部不仅包括轴六电机的输出转速,还包括轴五工作单元的转速,轴六与轴五耦合,轴六为耦合轴,轴五为干扰轴。
进一步的技术方案是,所述步骤(2)中,设计差动齿轮箱,差动齿轮箱由第十七锥齿轮、第十三齿轮、第十四齿轮、第十五齿轮和第二行星架组成,第十七锥齿轮与第十三齿轮同轴设置,第十四齿轮分别与第十五齿轮和第十三齿轮相啮合,第十四齿轮安装在第二行星架上,第十四齿轮的轴线随第二行星架的转动而转动,第二行星架输出转速;第十三齿轮和第十五齿轮的旋转轴线固定,第十四齿轮的轴线不固定;
对于差动齿轮箱的传动比计算,给周转轮系加上一个绕第二行星架的固定轴线回转的相反的公共角速度,这时各构建之间的相对运动任将保持不变,第二行星架相对静止,周转轮系转化为定轴轮系,在转化后的轮系中有公式(7)如下:
式中,为在转化后的轮系中第十三齿轮的对第十五齿轮的传动比;
nSC1为第二行星架的转速;n13为第十三齿轮的转速;n15为第十五齿轮的转速;z13为第十三齿轮的齿数;z14为第十四齿轮的齿数;z15为第十五齿轮的齿数;
公式(7)可简化为公式(8)如下:
令
且第二行星架通过输出轴输出转速,且第十五齿轮固定在差动齿轮箱第一输入轴上,第十三齿轮固定在第二输入轴上,则有公式(9)如下:
nC1=a1nS1+b1nS2
式中,nC1为输出轴的转速,nS1为第一输入轴的转速,nS2为第二输入轴的转速。
进一步的技术方案是,所述步骤(3)中,差动齿轮箱的输出轴与第九齿轮相连,有公式(10)如下:
n9=nC1=a1nS1+b1nS2
令nS2=ibnD6
其中,ibnD6表示轴六电机的输出转速通过传动和减速后,进入差动齿轮箱的第二输入轴的转速,ib表示传动系数,且第一输入轴与第五锥齿轮同轴相连,根据传动关系,则有公式(11)如下:
n9=a1nS5+ibb1nD6
将公式(11)带入公式(6),有公式(12)如下:
当1-a1=0时,关于nS6的自变量不在包含nS5,可解耦,即需要满足公式(13)如下:
由于z13>0,z15>0,公式(13)无解;
故加一个传动关系,使得
其中,ia为增加的传动关系的传动系数;
当1-a1ia=0,即ia>1,才能保证1-a1ia=0。
进一步的技术方案是,所述步骤(4)中,根据步骤(3)的推算,增加传动关系为:在差动齿轮箱上设置第十六齿轮和第十八齿轮,其中,第十五齿轮和第十六齿轮同轴相连,第十六齿轮和第十八齿轮啮合,第十八齿轮和第五锥齿轮共轴,差动齿轮箱的输出轴和第九齿轮相连,第二输入轴与第六齿轮相连,与轴六电机建立关系,第一输入轴通过第十六齿轮、第五锥齿轮、第十八齿轮、第八齿轮与五轴建立增速关系,则有:
当1-a1ia=0时,即要求
可得公式(14)如下:z8z15z18=z5z13z16+z5z15z16。
进一步的技术方案是,所述步骤(5)中将公式(14)中每个齿数数值确定,保证满足数学解析关系式的同时满足结构的几何关系。
相比于现有技术,本发明技术方案由如下优势:机器人电机驱动控制中不需要进行控制解耦,大大减少控制的难度和控制算法的复杂性;减少了机器人计算和控制的精度误差;对电机调速特性的要求低,电机设计和选型减少难度。
附图说明
构成本发明的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。
图1为原机器人的轴五和轴六的传动原理图;
图2为本发明利用差动齿轮箱传动关系对原传动结构的耦合关系进行解耦后传动原理图。
1第一齿轮 2第二齿轮 3第三齿轮 4第四齿轮
5第五锥齿轮 6第六锥齿轮 7第七锥齿轮 8第八锥齿轮
9第九齿轮 10第十齿轮 11第十一锥齿轮 12第十二锥齿轮
13第十三齿轮 14第十四齿轮 15第十五齿轮 16第十六齿轮
17第十七锥齿轮 18第十八齿轮 H1第一行星架 H2第二行星架
Z5轴五 Z6轴六
具体实施方式
下面结合附图对本发明进行详细描述,本部分的描述仅是示范性和解释性,不应对本发明的保护范围有任何的限制作用。此外,本领域技术人员根据本文件的描述,可以对本文件中实施例中以及不同实施例中的特征进行相应组合。
本发明实施例如下,参照图1,一种多轴机器人机械传动解耦的方法,包括如下步骤:
(1)原机械传动工况分析提炼,得到原传动函数关系式,其中,一轴的工作单元的转速为因变量,影响该轴的工作单元的转速的因素为自变量,当自变量包括了其他轴的驱动电机的转速时,认定该轴为与其他轴耦合的耦合轴,造成干扰的其他轴则为干扰轴;
具体:原机械传动工况分析过程如下,如图1:
轴五电机和轴六电机分别为轴五和轴六的驱动电机,轴五电机通过第三齿轮3和第四齿轮4将动力传给第五锥齿轮5,第五锥齿轮5和第八锥齿轮8啮合传动,将转动传给机器人轴五的外壳,轴五的外壳作为第一行星架H1;轴六电机通过第一齿轮1和第二齿轮2将动力传给第六锥齿轮6,第六锥齿轮6和第七锥齿轮7啮合传动,将转动传给第九齿轮9,第九齿轮9与第十齿轮10啮合,将转动传给第十一锥齿轮11,第十一锥齿轮11和第十二锥齿轮12啮合,将转动传给机器人轴六的工作单元,其中,第十齿轮10、第十一锥齿轮11、第十二锥齿轮12固定在第一行星架H1上,第一齿轮1、第二齿轮2、第五锥齿轮5、第六锥齿轮6、第七锥齿轮7、第八锥齿轮8、第九齿轮9的轴线固定;
轴五的传动为定轴轮系,轴五的原传动函数关系式的有公式(1)如下:
式中,nD5为轴五电机的输出转速;nS5为轴五工作单元的转速;i83为第八锥齿轮8的对第三齿轮3的传动比;i43为第四齿轮4的对第三齿轮3的传动比;i85为第八锥齿轮8的对第五锥齿轮5的传动比;z3为第三齿轮3的齿数;z4为第四齿轮4的齿数;z5为第五锥齿轮5的齿数;z8为第八锥齿轮8的齿数;
由公式(1)可知,原传动函数关系式,影响轴五的工作单元的转速的自变量仅包括轴五电机的输出转速,此传动具有独立性;
轴六传动为复合轮系,将其分解为定轴轮系和周转轮系,其中第一齿轮1、第二齿轮2、第六锥齿轮6、第七锥齿轮7和第九齿轮9的轴线固定,为定轴轮系,传动关系有公式(2)如下:
式中,n9为第九齿轮9的转数;nD6为轴六电机的输出转速;i71为第七锥齿轮7的对第一齿轮1的传动比;i21为第二齿轮2的对第一齿轮1的传动比;i76为第七锥齿轮7的对第六锥齿轮6的传动比;z1为第一齿轮1的齿数;z2为第二齿轮2的齿数;z6为第六锥齿轮6的齿数;z7为第七锥齿轮7的齿数;
对于第十一锥齿轮11和第十二锥齿轮12,轴线不固定,为周转轮系,计算时,给周转轮系加上一个绕第一行星架H1的固定轴线回转的相反的公共角速度,这时各构建之间的相对运动任将保持不变,第一行星架H1相对静止,将周转轮系转化为定轴轮系,在转化后的轮系中有公式(3)如下:
式中,为在转化后的轮系中第九齿轮9的对第十齿轮10的传动比;/>为在转化后的轮系中第九齿轮9的转速;/>为在转化后的轮系中第十齿轮10的转速;nH1为第一行星架H1的转速;n10为第十齿轮10的转速;z10为第十齿轮10的齿数;z9为第九齿轮9的齿数;
由于nH1=nS5,可得公式(4)如下:
根据传动关系有公式(5)如下:
式中,nS6为轴六工作单元的转速;为转化后的轮系中第十二锥齿轮12对第十一锥齿轮11的减速比;z11为第十一锥齿轮11的齿数;z12为第十二锥齿轮12的齿数;
由传动关系以及公式(2)~(5)可得轴六原传动函数关系式的公式(6)如下:
由公式(6)可知,影响轴六的工作单元的转速的自变量部不仅包括轴六电机的输出转速,还包括轴五工作单元的转速,轴六与轴五耦合,轴六为耦合轴,轴五为干扰轴。
(2)设计差动齿轮箱,进行差动齿轮箱数学解析;
具体:设计差动齿轮箱,差动齿轮箱由第十七锥齿轮17、第十三齿轮13、第十四齿轮14、第十五齿轮15和第二行星架H2组成,第十七锥齿轮17与第十三齿轮13同轴设置,第十四齿轮14分别与第十五齿轮15和第十三齿轮13相啮合,第十四齿轮14安装在第二行星架H2上,第十四齿轮14的轴线随第二行星架H2的转动而转动,第二行星架H2输出转速;第十三齿轮13和第十五齿轮15的旋转轴线固定,第十四齿轮14的轴线不固定;
对于差动齿轮箱的传动比计算,给周转轮系加上一个绕第二行星架H2的固定轴线回转的相反的公共角速度,这时各构建之间的相对运动任将保持不变,第二行星架H2相对静止,周转轮系转化为定轴轮系,在转化后的轮系中有公式(7)如下:
式中,为在转化后的轮系中第十三齿轮13的对第十五齿轮15的传动比;
nSC1为第二行星架H2的转速;n13为第十三齿轮13的转速;n15为第十五齿轮15的转速;z13为第十三齿轮13的齿数;z14为第十四齿轮14的齿数;z15为第十五齿轮15的齿数;
公式(7)可简化为公式(8)如下:
令
且第二行星架H2通过输出轴输出转速,且第十五齿轮15固定在差动齿轮箱第一输入轴上,第十三齿轮13固定在第二输入轴上,则有公式(9)如下:
nC1=a1nS1+b1nS2
式中,nC1为输出轴的转速,nS1为第一输入轴的转速,nS2为第二输入轴的转速。
(3)确定解耦合传动关系解析式:采用差动齿轮箱的数学解析关系,分析原传动函数关系式,增加传动关系,再不增加新的变量的前提下,将与耦合轴驱动电机转速相关的自变量消除,得到新的关于耦合轴工作单元的转速的解耦合传动关系解析式,此时影响该轴的工作单元的转速的自变量仅包括耦合轴的驱动电机的转速;
具体:差动齿轮箱的输出轴与第九齿轮9相连,有公式(10)如下:
n9=nC1=a1nS1+b1nS2
令nS2=ibnD6
其中,ibnD6表示轴六电机的输出转速通过传动和减速后,进入差动齿轮箱的第二输入轴的转速,ib表示传动系数,且第一输入轴与第五锥齿轮5同轴相连,根据传动关系,则有公式(11)如下:
n9=a1nS5+ibb1nD6
将公式(11)带入公式(6),有公式(12)如下:
当1-a1=0时,关于nS6的自变量不在包含nS5,可解耦,即需要满足公式(13)如下:
由于z13>0,z15>0,公式(13)无解;
故加一个传动关系,使得
其中,ia为增加的传动关系的传动系数;
当1-a1ia=0,即ia>1,才能保证1-a1ia=0。
进一步的技术方案是,所述步骤(4)中,
(4)根据确定解耦合传动关系解析式的传动关系确定传动结构;
具体:根据步骤(3)的推算,增加传动关系为:在差动齿轮箱上设置第十六齿轮16和第十八齿轮18,其中,第十五齿轮15和第十六齿轮16同轴相连,第十六齿轮16和第十八齿轮18啮合,第十八齿轮18和第五锥齿轮5共轴,差动齿轮箱的输出轴和第九齿轮9相连,第二输入轴与第六齿轮相连,与轴六电机建立关系,第一输入轴通过第十六齿轮16、第五锥齿轮5、第十八齿轮18、第八齿轮与五轴建立增速关系,则有:
当1-a1ia=0时,即要求
可得公式(14)如下:z8z15z18=z5z13z16+z5z15z16。
(5)校核传动关系结构,满足结构的几何关系,确保实用性:将公式(14)中每个齿数数值确定,保证满足数学解析关系式的同时满足结构的几何关系。
如上面的关系式,可以将每个齿数确定个具体数值,如下:
z5=100,z8=100,z13=60,z15=40,z16=36,z18=90
如以上齿数,不但满足数学解析关系式,也满足结构的几何关系,方案可行。因此就采用实例化校核了传动关系解构方案的可行性。
改进后的机器人传动原理如图2所示:
相对于原来的传动,即新增差动齿轮箱和第十六齿轮16和第十八齿轮18,差动齿轮箱由第十七锥齿轮17、第十三齿轮13、第十四齿轮14、第十五齿轮15和第二行星架H2组成,第十七锥齿轮17和第六齿轮啮合,第十五齿轮15和第十六齿轮16相连,第十四齿轮14分别与第十五齿轮15和第十三齿轮13相啮合。第十三齿轮13安装在第二行星架H2上,第十三齿轮13的轴线随第二行星架H2的转动而转动。第二行星架H2与输出轴与第九齿轮9相连,第十六齿轮16和第十八齿轮18啮合,第十八齿轮18和第五齿轮共轴。
图2中,轴五电机和轴六电机为驱动电机,轴五电机通过第十三齿轮13和第十四齿轮14,将动力传给第五锥齿轮5,第五锥齿轮5和第八锥齿轮8啮合传动,将转动传给工作单元,即轴五的外壳,第一行星架H1。
轴六电机通过第一齿轮1和第二齿轮2,将动力传给第六锥齿轮6,第六锥齿轮6和第十七锥齿轮17啮合传动,将转动传给第十三齿轮13。第十三齿轮13与第十四齿轮14啮合,第十四齿轮14轴线随第二行星架H2转动,同时与第十五齿轮15啮合传动。第十五齿轮15与第十六齿轮16同轴,将传动传给第十六齿轮16,第十六齿轮16和第十八齿轮18啮合,第十六齿轮16的转动与五轴转动相关联上。
第九齿轮9与第十齿轮10啮合,将转动传给第十一锥齿轮11,第十一锥齿轮11和第十二锥齿轮12啮合,将转动传给工作单元。其中,第十齿轮10、第十一锥齿轮11、第十二锥齿轮12固定在第一行星架H1上,第十四齿轮14固定在第二行星架H2上,其它齿轮的轴线固定。
新增加的齿轮存在如下关系:
z8z15z18=z5z13z16+z5z15z16
例如:z5=20,z8=50,z13=36,z15=24,z16=z18=50
下面为传动分析计算:
对于轴五的传动,为定轴轮系,传动关系不变,为:
对于轴六传动,有部分齿轮有固定轴线,而另一部分的齿轮的轴线是转动的,所以此传动为复合轮系,可以分解为定轴轮系和周转轮系:
对于第一齿轮1、第二齿轮2、第六锥齿轮6、第十三齿轮13和第十七齿轮的轴线固定,为定轴轮系,传动关系如下:
对于第十齿轮10、十一齿轮、十二齿轮,轴线不固定,为周转轮系,相关传动关系不变:
对于第八锥齿轮8、第十五齿轮15、第十六齿轮16,轴线固定,相关传动关系为:
对于第十四齿轮14,轴线不固定,为周转轮系,给周转轮系加上一个公共角速度,使之绕第二行星架H2的固定轴线回转,这时各构建之间的相对运动任将保持不变,行星架“静止不动”了。周转轮系转化为定轴轮系。在转化后的轮系中有如下关系:
上式转化为
因为第九齿轮9和第二行星架H2同轴固定连接,转速相同,所以有:
根据前面计算的结果:
进行计算和化简为如下:
z8z15z18=z5z13z16+z5z15z16
因为:
所以有轴六工作单元的转动只与轴六电机的转动有关,不再与轴五耦合,实现了机械传动的解耦。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (3)
1.一种多轴机器人机械传动解耦的方法,其特征在于,包括如下步骤:
(1)原机械传动工况分析提炼,得到原传动函数关系式,其中,一轴的工作单元的转速为因变量,影响该轴的工作单元的转速的因素为自变量,当自变量包括了其他轴的驱动电机的转速时,认定该轴为与其他轴耦合的耦合轴,造成干扰的其他轴则为干扰轴;
(2)设计差动齿轮箱,进行差动齿轮箱数学解析;
(3)确定解耦合传动关系解析式:采用差动齿轮箱的数学解析关系,分析原传动函数关系式,增加传动关系,再不增加新的变量的前提下,将与耦合轴驱动电机转速相关的自变量消除,得到新的关于耦合轴工作单元的转速的解耦合传动关系解析式,此时影响该轴的工作单元的转速的自变量仅包括耦合轴的驱动电机的转速;
(4)根据确定解耦合传动关系解析式的传动关系确定传动结构;
(5)校核传动关系结构,满足结构的几何关系,确保实用性;
其中,所述步骤(1)中原机械传动工况分析过程如下:
轴五电机和轴六电机分别为轴五和轴六的驱动电机,轴五电机通过第三齿轮和第四齿轮将动力传给第五锥齿轮,第五锥齿轮和第八锥齿轮啮合传动,将转动传给机器人轴五的外壳,轴五的外壳作为第一行星架H1;轴六电机通过第一齿轮和第二齿轮将动力传给第六锥齿轮,第六锥齿轮和第七锥齿轮啮合传动,将转动传给第九齿轮,第九齿轮与第十齿轮啮合,将转动传给第十一锥齿轮,第十一锥齿轮和第十二锥齿轮啮合,将转动传给机器人轴六的工作单元,其中,第十齿轮、第十一锥齿轮、第十二锥齿轮固定在第一行星架H1上,第一齿轮、第二齿轮、第五锥齿轮、第六锥齿轮、第七锥齿轮、第八锥齿轮、第九齿轮的轴线固定;
轴五的传动为定轴轮系,轴五的原传动函数关系式的有公式(1)如下:
式中,nD5为轴五电机的输出转速;nS5为轴五工作单元的转速;i83为第八锥齿轮的对第三齿轮的传动比;i43为第四齿轮的对第三齿轮的传动比;i85为第八锥齿轮的对第五锥齿轮的传动比;z3为第三齿轮的齿数;z4为第四齿轮的齿数;z5为第五锥齿轮的齿数;z8为第八锥齿轮的齿数;
由公式(1)可知,原传动函数关系式,影响轴五的工作单元的转速的自变量仅包括轴五电机的输出转速,此传动具有独立性;
轴六传动为复合轮系,将其分解为定轴轮系和周转轮系,其中第一齿轮、第二齿轮、第六锥齿轮、第七锥齿轮和第九齿轮的轴线固定,为定轴轮系,传动关系有公式(2)如下:
式中,n9为第九齿轮的转数;nD6为轴六电机的输出转速;i71为第七锥齿轮的对第一齿轮的传动比;i21为第二齿轮的对第一齿轮的传动比;i76为第七锥齿轮的对第六锥齿轮的传动比;z1为第一齿轮的齿数;z2为第二齿轮的齿数;z6为第六锥齿轮的齿数;z7为第七锥齿轮的齿数;
对于第十一锥齿轮和第十二锥齿轮,轴线不固定,为周转轮系,计算时,给周转轮系加上一个绕第一行星架H1的固定轴线回转的相反的公共角速度,这时各构建之间的相对运动任将保持不变,第一行星架H1相对静止,将周转轮系转化为定轴轮系,在转化后的轮系中有公式(3)如下:
式中,为在转化后的轮系中第九齿轮的对第十齿轮的传动比;/>为在转化后的轮系中第九齿轮的转速;/>为在转化后的轮系中第十齿轮的转速;nH1为第一行星架H1的转速;n10为第十齿轮的转速;z10为第十齿轮的齿数;z9为第九齿轮的齿数;
由于nH1=nS5,可得公式(4)如下:
根据传动关系有公式(5)如下:
式中,nS6为轴六工作单元的转速;为转化后的轮系中第十二锥齿轮对第十一锥齿轮的减速比;z11为第十一锥齿轮的齿数;z12为第十二锥齿轮的齿数;
由传动关系以及公式(2)~(5)可得轴六原传动函数关系式的公式(6)如下:
由公式(6)可知,影响轴六的工作单元的转速的自变量部不仅包括轴六电机的输出转速,还包括轴五工作单元的转速,轴六与轴五耦合,轴六为耦合轴,轴五为干扰轴,所述步骤(2)中,设计差动齿轮箱,差动齿轮箱由第十七锥齿轮、第十三齿轮、第十四齿轮、第十五齿轮和第二行星架组成,第十七锥齿轮与第十三齿轮同轴设置,第十四齿轮分别与第十五齿轮和第十三齿轮相啮合,第十四齿轮安装在第二行星架上,第十四齿轮的轴线随第二行星架的转动而转动,第二行星架输出转速;第十三齿轮和第十五齿轮的旋转轴线固定,第十四齿轮的轴线不固定;
对于差动齿轮箱的传动比计算,给周转轮系加上一个绕第二行星架的固定轴线回转的相反的公共角速度,这时各构建之间的相对运动任将保持不变,第二行星架相对静止,周转轮系转化为定轴轮系,在转化后的轮系中有公式(7)如下:
式中,为在转化后的轮系中第十三齿轮的对第十五齿轮的传动比;
nSC1为第二行星架的转速;n13为第十三齿轮的转速;n15为第十五齿轮的转速;z13为第十三齿轮的齿数;z14为第十四齿轮的齿数;z15为第十五齿轮的齿数;
公式(7)可简化为公式(8)如下:
令
且第二行星架通过输出轴输出转速,且第十五齿轮固定在差动齿轮箱第一输入轴上,第十三齿轮固定在第二输入轴上,则有公式(9)如下:
nC1=a1nS1+b1nS2
式中,nC1为输出轴的转速,nS1为第一输入轴的转速,nS2为第二输入轴的转速;所述步骤(3)中,差动齿轮箱的输出轴与第九齿轮相连,有公式(10)如下:
n9=nC1=a1nS1+b1nS2
令nS2=ibnD6
其中,ibnD6表示轴六电机的输出转速通过传动和减速后,进入差动齿轮箱的第二输入轴的转速,ib表示传动系数,且第一输入轴与第五锥齿轮同轴相连,根据传动关系,则有公式(11)如下:
n9=a1nS5+ibb1nD6
将公式(11)带入公式(6),有公式(12)如下:
当1-a1=0时,关于nS6的自变量不在包含nS5,可解耦,即需要满足公式(13)如下:
由于z13>0,z15>0,公式(13)无解;
故加一个传动关系,使得
其中,ia为增加的传动关系的传动系数;
当1-a1ia=0,即ia>1,才能保证1-a1ia=0。
2.根据权利要求1所述的多轴机器人机械传动解耦的方法,其特征在于,所述步骤(4)中,根据步骤(3)的推算,增加传动关系为:在差动齿轮箱上设置第十六齿轮和第十八齿轮,其中,第十五齿轮和第十六齿轮同轴相连,第十六齿轮和第十八齿轮啮合,第十八齿轮和第五锥齿轮共轴,差动齿轮箱的输出轴和第九齿轮相连,第二输入轴与第六齿轮相连,与轴六电机建立关系,第一输入轴通过第十六齿轮、第五锥齿轮、第十八齿轮、第八齿轮与五轴建立增速关系,则有:
当1-a1ia=0时,即要求
可得公式(14)如下:z8z15z18=z5z13z16+z5z15z16。
3.根据权利要求2所述的多轴机器人机械传动解耦的方法,其特征在于,所述步骤(5)中将公式(14)中每个齿数数值确定,保证满足数学解析关系式的同时满足结构的几何关系。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210474782.7A CN114670205B (zh) | 2022-04-29 | 2022-04-29 | 一种多轴机器人机械传动解耦的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210474782.7A CN114670205B (zh) | 2022-04-29 | 2022-04-29 | 一种多轴机器人机械传动解耦的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114670205A CN114670205A (zh) | 2022-06-28 |
CN114670205B true CN114670205B (zh) | 2023-11-21 |
Family
ID=82080591
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210474782.7A Active CN114670205B (zh) | 2022-04-29 | 2022-04-29 | 一种多轴机器人机械传动解耦的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114670205B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS629893A (ja) * | 1985-07-08 | 1987-01-17 | 株式会社 アマダ | ロボツト関節部の動力伝達機構 |
CN105774450A (zh) * | 2016-05-03 | 2016-07-20 | 吉林大学 | 一种二自由度解耦减速机构 |
CN109139854A (zh) * | 2018-09-29 | 2019-01-04 | 济南大学 | 一种磁吸式行星齿轮的设计方法 |
CN110516384A (zh) * | 2019-08-30 | 2019-11-29 | 西北工业大学 | 一种多输入多输出齿轮传动系统动力学建模方法 |
CN110701255A (zh) * | 2019-10-12 | 2020-01-17 | 山东科技大学 | 一种单驱动输入多轴解耦输出的传动机构及其工作方法与应用 |
WO2022027724A1 (zh) * | 2020-08-03 | 2022-02-10 | 江苏大学 | 一种兼具转速和转矩耦合的多模式无级变速器 |
CN114055436A (zh) * | 2021-11-19 | 2022-02-18 | 苏州大学 | 一种便携式全耦合并联型连续体机械臂 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2927394B1 (fr) * | 2008-02-11 | 2010-06-04 | Roucar Gear Technologies Bv | Dispositif de transmission pour machine de production d'electricite a partir d'une source motrice a vitesse variable, unite de production electrique et eolienne ainsi equipees, et procede de reglage d'un rapport de transmission |
DE102013206749B4 (de) * | 2013-04-16 | 2018-08-30 | Schaeffler Technologies AG & Co. KG | Differentialgetriebe |
-
2022
- 2022-04-29 CN CN202210474782.7A patent/CN114670205B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS629893A (ja) * | 1985-07-08 | 1987-01-17 | 株式会社 アマダ | ロボツト関節部の動力伝達機構 |
CN105774450A (zh) * | 2016-05-03 | 2016-07-20 | 吉林大学 | 一种二自由度解耦减速机构 |
CN109139854A (zh) * | 2018-09-29 | 2019-01-04 | 济南大学 | 一种磁吸式行星齿轮的设计方法 |
CN110516384A (zh) * | 2019-08-30 | 2019-11-29 | 西北工业大学 | 一种多输入多输出齿轮传动系统动力学建模方法 |
CN110701255A (zh) * | 2019-10-12 | 2020-01-17 | 山东科技大学 | 一种单驱动输入多轴解耦输出的传动机构及其工作方法与应用 |
WO2022027724A1 (zh) * | 2020-08-03 | 2022-02-10 | 江苏大学 | 一种兼具转速和转矩耦合的多模式无级变速器 |
CN114055436A (zh) * | 2021-11-19 | 2022-02-18 | 苏州大学 | 一种便携式全耦合并联型连续体机械臂 |
Non-Patent Citations (1)
Title |
---|
徐时彬 等.《机械设计基础》.国防工业出版社,2007,第334-338页. * |
Also Published As
Publication number | Publication date |
---|---|
CN114670205A (zh) | 2022-06-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0249232B1 (en) | Wrist device of robot | |
EP2618023A2 (en) | Epicyclic gear system using two input characteristics, gear module including same, and method for controlling same | |
JP6174720B2 (ja) | 動力装置 | |
WO2021189675A1 (zh) | 用于超动态仿生机器人的并联驱动关节和机器人 | |
EP0327032A2 (en) | Differential gear device incorporating internal meshing type planetary reduction gear | |
CN114670205B (zh) | 一种多轴机器人机械传动解耦的方法 | |
JPS6147673B2 (zh) | ||
CN205503875U (zh) | 一种减速机 | |
CN2572137Y (zh) | 谐波传动减速器 | |
Petrescu et al. | An algorithm to determining the gear efficiency to a simple planetary train | |
CN113305876B (zh) | 高冗余度柔顺机器人关节、机器人、关节结构 | |
CN211259504U (zh) | 一种单/双输入双输出行星齿轮减速器 | |
JPS632753B2 (zh) | ||
JPS6044288A (ja) | 工業用ロボツトの手首装置 | |
Tan et al. | Dynamic modeling and simulation of double-planetary gearbox based on bond graph | |
CN108044645B (zh) | 一种变厚机器人关节传动结构 | |
CN205331326U (zh) | 燃气轮机与电机耦合动力输出装置 | |
CN206326620U (zh) | 一种单元组合式机器人手腕 | |
JP2021524900A (ja) | 一方向動力配分の自在伝動装置 | |
CN219666650U (zh) | 一种基于行星齿轮机构的七轴机器人 | |
CN109296713B (zh) | 一种龙门刨床变向机构传动比确定方法 | |
CN113070902B (zh) | 一种三轴转动的机器人关节 | |
CN215042073U (zh) | 一种独立悬架平行轴电驱动桥及车辆 | |
JP2676286B2 (ja) | 内接噛合形遊星歯車減速機構を使用した制御装置 | |
CN211104079U (zh) | 机械臂以及机器人 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |