CN109531560B - 大长径比轴孔装配分析系统及方法 - Google Patents
大长径比轴孔装配分析系统及方法 Download PDFInfo
- Publication number
- CN109531560B CN109531560B CN201910018179.6A CN201910018179A CN109531560B CN 109531560 B CN109531560 B CN 109531560B CN 201910018179 A CN201910018179 A CN 201910018179A CN 109531560 B CN109531560 B CN 109531560B
- Authority
- CN
- China
- Prior art keywords
- analysis
- contact
- assembly
- triaxial
- shaft hole
- 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
Images
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/08—Programme-controlled manipulators characterised by modular constructions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/085—Force or torque sensors
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
- Force Measurement Appropriate To Specific Purposes (AREA)
Abstract
本发明公开一种大长径比轴孔装配分析系统及方法,受力分析机构根据三轴位姿参数I1得出轴与孔的偏差角度,一定的偏差角度会使轴插入孔的时候受到很大阻力,该阻力则通过三轴接触力数据I2、三轴力矩数据I3计算获得,一旦阻力过大,就说明插入动作受阻,轴孔的装配有偏差以致无法顺利完成装配,此时就需要调整装配机器人的动作,以满足顺利将轴插入到孔中。有益效果:通过装配过程中大长径比轴的受力情况准确分析其装配是否有偏差,从而为精确控制装配动作提供分析。
Description
技术领域
本发明涉及装配机器人控制分析技术领域,具体的说,涉及一种大长径比轴孔装配分析系统及方法。
背景技术
出于全自动装配的考虑,装配过程中机器人的控制是否精确直接影响装配结果,装配过程的受力分析是精确控制的前提,若分析不对,控制的反馈就效果不好,当装配角度出现偏差时,装配就会有阻碍,此时的受力分析不能及时反馈偏差,就会增加装配控制难度,甚至无法完成装配。
在得到精确接触力、力矩的基础上,为了实现柔性装配控制,需要建立装配过程的分析模型。根据轴孔的几何信息,对装配过程中插轴可能出现的所有接触状态进行了分析,即:单边接触、单点接触及两点接触。具体如图1示意:(a)为单边接触,(b)为单点接触,(c)为两点接触。其中单边接触为单点接触的特例情况,可以合并进行力学受力分析。
装配过程的分析问题可以归结为,求取接触点的受力情况。
发明内容
本发明的目的是提供一种大长径比轴孔装配分析系统及方法,通过装配过程中大长径比轴的受力情况准确分析其装配是否有偏差,从而为精确控制装配动作提供分析支持。
为达到上述目的,本发明采用的具体技术方案如下:
一种大长径比轴孔装配分析系统,包括装配机器人,该装配机器人的装配端设置有姿态传感器和力传感器,所述姿态传感器用于检测装配端的三轴位姿参数I1,所述力传感器用于检测装配端的三轴接触力数据I2、三轴力矩数据I3;
还包括受力分析机构,所述受力分析机构通过三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3分析装配过程中大长径比插轴与装配孔的受力情况,得出装配姿态的调整分析结果;
所述受力分析机构的数据输入端组连接所述姿态传感器的输出端和所述力传感器的输出端,所述受力分析机构的数据输出端组连接有装配机器人控制机构的数据输入端组。
通过上述设计,受力分析机构根据三轴位姿参数I1得出轴与孔的偏差角度,一定的偏差角度会使轴插入孔的时候受到很大阻力,该阻力则通过三轴接触力数据I2、三轴力矩数据I3计算获得,一旦阻力过大,就说明插入动作受阻,轴孔的装配有偏差以致无法顺利完成装配,此时就需要调整装配机器人的动作,以满足顺利将轴插入到孔中。
进一步描述,所述受力分析机构包括判断处理模块、单点接触分析模块、两点接触分析模块、数据存储模块,所述判断处理模块分别与单点接触分析模块、两点接触分析模块、数据存储模块双向连接。
判断处理模块用于判断接触点的数量,若为单点接触,则后续处理交于单点接触分析模块处理,若为两点接触,则转由两点接触分析模块,判断处理模块还用于根据单点接触分析模块/两点接触分析模块的受力分析结果判断装配是否需要重新调整,得到装配分析结果,数据存储模块用于存储全部过程的重要数据信息,如接触点判断结果、受力分析结果、装配分析结果等。
更进一步描述,所述判断处理模块设置有接触点判断单元、分析结果判断单元,所述接触点判断单元的输出端组连接单点接触分析模块的输入端和两点接触分析模块的输入端,所述分析结果判断单元的输入端组连接单点接触分析模块的输出端和两点接触分析模块的输出端。
其中,接触点判断单元用于判断接触点的数量,分析结果判断单元用于得到装配分析结果。
一种大长径比轴孔装配分析方法:
步骤一,受力分析机构实时接收姿态传感器和力传感器检测的装配端的三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3;
步骤二,接触点判断单元通过三轴接触力数据I2、三轴力矩数据I3识别大长径比轴孔接触点的数量,若接触点为1个,进入步骤三,若接触点为2个,进入步骤四;
步骤三,单点接触分析模块根据三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3计算轴孔单点反作用力N与单点阻力f,进入步骤五;
步骤四,两点接触分析模块根据三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3计算轴孔两点反作用力N1、N2,以及两点阻力f1、f2,进入步骤六;
步骤五,分析结果判断单元分析步骤三的计算结果:
若N≥AN,f≥Af,AN为单点反作用力阈值,Af为单点阻力阈值,则分析结果为装配角度需调整,否则分析结果为正常装配;
输出分析结果;
步骤六,分析结果判断单元分析步骤四的计算结果:
若N1≥AN1,N2≥AN2,f1≥Af1,f2≥Af2,AN1、AN2为两点反作用力阈值,Af1、Af2为两点阻力阈值,则分析结果为装配角度需调整,否则分析结果为正常装配;
输出分析结果。
通过上述设计,大长径比轴与孔的装配角度准确,则分析得出的轴孔单点反作用力N与单点阻力f(或轴孔两点反作用力N1、N2,以及两点阻力f1、f2)会在一个较小区间内,此时继续装配是可以完成插入动作的,但一旦超过该区间,继续插入只会卡住,无法完成装配,需要重新调整插入动作的方向。而上述方法是每个装配动作实时分析的,在装配过程中随采集的三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3改变不断重复分析过程,直到最终完成装配工作。
进一步设计,步骤三计算轴孔单点反作用力N与单点阻力f的方法如下:
S3.1,根据装配的接触点确定分析面X-O-Z,所述分析面X-O-Z为显示有所有接触点的大长径比轴的轴剖面;
S3.2,分解所述三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3,得到基于所述分析面X-O-Z的接触力Fx、Fz、力矩Ty、轴孔偏转夹角θ、轴长l、轴径d,其中,Fz为轴心方向的接触力,Fx为垂直于轴心方向的接触力,Ty为垂直于分析面X-O-Z的力矩;
S3.3,根据以下公式组,将S3.2分解得到的数据代入计算:
得到轴孔单点反作用力N与单点阻力f。
上述设计以轴的某一轴剖面为分析面X-O-Z,但该分析面X-O-Z上需包含有所有接触点,因此若在该分析面X-O-Z上分析得到的轴孔单点反作用力N与单点阻力f超过正常受力区间,则需要调整该分析面X-O-Z的轴姿态,调整后再分析其他角度的轴剖面是否受力正常,从而使轴完全对准孔,顺利完成装配。
近似的,步骤四计算轴孔两点反作用力N1、N2,以及两点阻力f1、f2的方法如下:
S4.1,根据装配的接触点确定分析面X-O-Z,所述分析面X-O-Z为显示有所有接触点的大长径比轴的轴剖面;
S4.2,分解所述三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3,得到基于所述分析面X-O-Z的接触力Fx、Fz、力矩Ty、轴孔偏转夹角θ、轴长l、轴径d、未插入的轴长h,其中,Fz为轴心方向的接触力,Fx为垂直于轴心方向的接触力,Ty为垂直于分析面X-O-Z的力矩;
其中,未插入的轴长h指露出孔部分的最短轴长;
S4.3,根据以下公式组,将S3.2分解得到的数据代入计算:
得到轴孔两点反作用力N1、N2,以及两点阻力f1、f2。
本发明的有益效果:通过装配过程中大长径比轴的受力情况准确分析其装配是否有偏差,从而为精确控制装配动作提供分析支持。
附图说明
图1是轴剖面的接触点分析示意图;
图2是轴剖面的力学分析示意图;
图3是系统的结构框图;
图4是方法的主要流程示意图。
具体实施方式
下面结合附图及具体实施例对本发明作进一步详细说明:
一种大长径比轴孔装配分析系统,如图3所示,包括装配机器人1,该装配机器人的装配端设置有姿态传感器1a和力传感器1b,所述姿态传感器1a用于检测装配端的三轴位姿参数I1,所述力传感器1b用于检测装配端的三轴接触力数据I2、三轴力矩数据I3;
还包括受力分析机构2,所述受力分析机构2通过三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3分析装配过程中大长径比插轴与装配孔的受力情况,得出装配姿态的调整分析结果;
所述受力分析机构2的数据输入端组连接所述姿态传感器1a的输出端和所述力传感器1b的输出端,所述受力分析机构2的数据输出端组连接有装配机器人控制机构3的数据输入端组。
所述受力分析机构2包括判断处理模块2a、单点接触分析模块2b、两点接触分析模块2c、数据存储模块2d,所述判断处理模块2a分别与单点接触分析模块2b、两点接触分析模块2c、数据存储模块2d双向连接。
所述判断处理模块2a设置有接触点判断单元、分析结果判断单元,所述接触点判断单元的输出端组连接单点接触分析模块2b的输入端和两点接触分析模块2c的输入端,所述分析结果判断单元的输入端组连接单点接触分析模块2b的输出端和两点接触分析模块2c的输出端。
优选设备参数如下:
装配机器人优选型号:安川MOTOMAN MH12,控制器:DX200,负载:12kg,自由度:6,重复定位精度:±0.08mm,最大工作半径:1440mm,电源容量:1.5kVA。
该装配机器人的装配端自带有姿态传感器1a,控制器:DX200即为装配机器人控制机构;
力传感器1b优选为型号:ATI-mini45-E的六维力传感器,其主要技术参数为:量程:SI-290-10
分辨率:SI-290-10
另设有处理器主机,该处理器主机上设置受力分析机构2。
一种大长径比轴孔装配分析方法,如图4所示:
步骤一,受力分析机构2实时接收姿态传感器1a和力传感器1b检测的装配端的三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3;
步骤二,接触点判断单元通过三轴接触力数据I2、三轴力矩数据I3识别大长径比轴孔接触点的数量,若接触点为1个,进入步骤三,若接触点为2个,进入步骤四;
步骤三,单点接触分析模块2b根据三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3计算轴孔单点反作用力N与单点阻力f,进入步骤五;
步骤四,两点接触分析模块2c根据三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3计算轴孔两点反作用力N1、N2,以及两点阻力f1、f2,进入步骤六;
步骤五,分析结果判断单元分析步骤三的计算结果:
若N≥AN,f≥Af,AN为单点反作用力阈值,Af为单点阻力阈值,则分析结果为装配角度需调整,否则分析结果为正常装配;
输出分析结果;
步骤六,分析结果判断单元分析步骤四的计算结果:
若N1≥AN1,N2≥AN2,f1≥Af1,f2≥Af2,AN1、AN2为两点反作用力阈值,Af1、Af2为两点阻力阈值,则分析结果为装配角度需调整,否则分析结果为正常装配;
输出分析结果。
本实施例中单点受力情况如图2中(a)部分所示,该剖视面即为分析面X-O-Z,步骤三计算轴孔单点反作用力N与单点阻力f的方法优选为:
S3.1,根据装配的接触点确定分析面X-O-Z,所述分析面X-O-Z为显示有所有接触点的大长径比轴的轴剖面;
S3.2,分解所述三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3,得到基于所述分析面X-O-Z的接触力Fx、Fz、力矩Ty、轴孔偏转夹角θ、轴长l、轴径d,其中,Fz为轴心方向的接触力,Fx为垂直于轴心方向的接触力,Ty为垂直于分析面X-O-Z的力矩;
S3.3,根据以下公式组,将S3.2分解得到的数据代入计算:
得到轴孔单点反作用力N与单点阻力f。
本实施例中两点受力情况如图2中(b)部分所示,该剖视面即为分析面X-O-Z,步骤四计算轴孔两点反作用力N1、N2,以及两点阻力f1、f2的方法优选如下:
S4.1,根据装配的接触点确定分析面X-O-Z,所述分析面X-O-Z为显示有所有接触点的大长径比轴的轴剖面;
S4.2,分解所述三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3,得到基于所述分析面X-O-Z的接触力Fx、Fz、力矩Ty、轴孔偏转夹角θ、轴长l、轴径d、未插入的轴长h,其中,Fz为轴心方向的接触力,Fx为垂直于轴心方向的接触力,Ty为垂直于分析面X-O-Z的力矩;
S4.3,根据以下公式组,将S3.2分解得到的数据代入计算:
得到轴孔两点反作用力N1、N2,以及两点阻力f1、f2。
Claims (3)
1.一种大长径比轴孔装配分析方法,其特征在于:
步骤一,受力分析机构(2)实时接收姿态传感器(1a)和力传感器(1b)检测的装配端的三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3;
步骤二,接触点判断单元通过三轴接触力数据I2、三轴力矩数据I3识别大长径比轴孔接触点的数量,若接触点为1个,进入步骤三,若接触点为2个,进入步骤四;
步骤三,单点接触分析模块(2b)根据三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3计算轴孔单点反作用力N与单点阻力f,进入步骤五;
步骤四,两点接触分析模块(2c)根据三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3计算轴孔两点反作用力N1、N2,以及两点阻力f1、f2,进入步骤六;
步骤五,分析结果判断单元分析步骤三的计算结果:
若N≥AN,f≥Af,AN为单点反作用力阈值,Af为单点阻力阈值,则分析结果为装配角度需调整,否则分析结果为正常装配;
输出分析结果;
步骤六,分析结果判断单元分析步骤四的计算结果:
若N1≥AN1,N2≥AN2,f1≥Af1,f2≥Af2,AN1、AN2为两点反作用力阈值,Af1、Af2为两点阻力阈值,则分析结果为装配角度需调整,否则分析结果为正常装配;
输出分析结果。
3.根据权利要求1所述的大长径比轴孔装配分析方法,其特征在于:步骤四计算轴孔两点反作用力N1、N2,以及两点阻力f1、f2的方法如下:
S4.1,根据装配的接触点确定分析面X-O-Z,所述分析面X-O-Z为显示有所有接触点的大长径比轴的轴剖面;
S4.2,分解所述三轴位姿参数I1、三轴接触力数据I2、三轴力矩数据I3,得到基于所述分析面X-O-Z的接触力Fx、Fz、力矩Ty、轴孔偏转夹角θ、轴长l、轴径d、未插入的轴长h,其中,Fz为轴心方向的接触力,Fx为垂直于轴心方向的接触力,Ty为垂直于分析面X-O-Z的力矩;
S4.3,根据以下公式组,将S3.2分解得到的数据代入计算:
得到轴孔两点反作用力N1、N2,以及两点阻力f1、f2。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910018179.6A CN109531560B (zh) | 2019-01-09 | 2019-01-09 | 大长径比轴孔装配分析系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910018179.6A CN109531560B (zh) | 2019-01-09 | 2019-01-09 | 大长径比轴孔装配分析系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109531560A CN109531560A (zh) | 2019-03-29 |
CN109531560B true CN109531560B (zh) | 2021-04-09 |
Family
ID=65834582
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910018179.6A Active CN109531560B (zh) | 2019-01-09 | 2019-01-09 | 大长径比轴孔装配分析系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109531560B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112247898B (zh) * | 2020-09-18 | 2022-04-08 | 浙江工业大学 | 一种基于挠度分析的机器人非刚体装配方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104057290A (zh) * | 2014-06-24 | 2014-09-24 | 中国科学院自动化研究所 | 一种基于视觉和力反馈控制的机器人装配方法与系统 |
EP2818275A1 (en) * | 2012-02-23 | 2014-12-31 | NSK Ltd. | Method for assembling and device for assembling roller bearing |
CN104625676A (zh) * | 2013-11-14 | 2015-05-20 | 沈阳新松机器人自动化股份有限公司 | 轴孔装配工业机器人系统及其工作方法 |
CN106272416A (zh) * | 2016-08-29 | 2017-01-04 | 上海交通大学 | 基于力觉和视觉的机器人细长轴精密装配系统及方法 |
-
2019
- 2019-01-09 CN CN201910018179.6A patent/CN109531560B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2818275A1 (en) * | 2012-02-23 | 2014-12-31 | NSK Ltd. | Method for assembling and device for assembling roller bearing |
CN104625676A (zh) * | 2013-11-14 | 2015-05-20 | 沈阳新松机器人自动化股份有限公司 | 轴孔装配工业机器人系统及其工作方法 |
CN104057290A (zh) * | 2014-06-24 | 2014-09-24 | 中国科学院自动化研究所 | 一种基于视觉和力反馈控制的机器人装配方法与系统 |
CN106272416A (zh) * | 2016-08-29 | 2017-01-04 | 上海交通大学 | 基于力觉和视觉的机器人细长轴精密装配系统及方法 |
Non-Patent Citations (3)
Title |
---|
基于模糊控制的机器人柔顺装配研究;张铁等;《机械设计与研究》;20130620(第03期);全文 * |
基于视觉/力传感器的机器人柔顺;李海龙;《中国硕士学位论文全文数据库 信息科技辑》;20150115;正文第14-23页 * |
柔顺装配中轴、孔插装过程的力学分析;王玲;《哈尔滨理工大学学报》;19990225(第01期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN109531560A (zh) | 2019-03-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109940605B (zh) | 融合三维视觉与接触力分析的柔顺装配系统及方法 | |
US11059169B2 (en) | Method of controlling robot, method of teaching robot, and robot system | |
US10906182B2 (en) | Method of teaching robot and robot system | |
JP2005011580A (ja) | コネクタ把持装置、同装置を備えたコネクタ検査システム及びコネクタ接続システム | |
US20080267737A1 (en) | Fitting device | |
US9248572B2 (en) | Axis angle determination method for six-axis robot and control apparatus for six-axis robot | |
JP2015155126A (ja) | ロボットシステムのツール座標系補正方法、およびロボットシステム | |
JP2013006231A (ja) | 自動組立装置および自動組立装置による部品組立方法 | |
JP4643619B2 (ja) | ロボット制御装置 | |
CN109740270A (zh) | 基于接触力与力矩预测和分析的大长径比轴孔装配系统及方法 | |
CN109940606B (zh) | 基于点云数据的机器人引导系统及方法 | |
CN105912823B (zh) | 基于n-2-1定位的飞机蒙皮和长桁装配偏差分析方法 | |
Liu et al. | An efficient insertion control method for precision assembly of cylindrical components | |
CN109531560B (zh) | 大长径比轴孔装配分析系统及方法 | |
CN115582831A (zh) | 机械手臂的自动校正方法与系统 | |
Kim et al. | Active peg-in-hole of chamferless parts using force/moment sensor | |
Mousavi et al. | Rapid and safe wire tension distribution scheme for redundant cable-driven parallel manipulators | |
JP2013013987A (ja) | ロボットシステム | |
US11279027B2 (en) | Method for estimating a wrench | |
Malhan et al. | Integrating impedance control and learning based search scheme for robotic assemblies under uncertainty | |
Liu et al. | Laser tracker-based control for peg-in-hole assembly robot | |
CN112975947A (zh) | 元器件引脚的矫正方法、装置、设备及存储介质 | |
CN116945229A (zh) | 一种机器人高精度轴孔装配方法、系统、终端及存储介质 | |
CN114791333A (zh) | 力传感器测量坐标系标定方法、装置、设备及存储介质 | |
CN112757344B (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 |