CN117182976B - 一种真空机械手r轴实时位置绝对精度测试系统及方法 - Google Patents
一种真空机械手r轴实时位置绝对精度测试系统及方法 Download PDFInfo
- Publication number
- CN117182976B CN117182976B CN202311473777.5A CN202311473777A CN117182976B CN 117182976 B CN117182976 B CN 117182976B CN 202311473777 A CN202311473777 A CN 202311473777A CN 117182976 B CN117182976 B CN 117182976B
- Authority
- CN
- China
- Prior art keywords
- manipulator
- encoder
- shaft
- data
- joint
- 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
- 238000012360 testing method Methods 0.000 title claims abstract description 68
- 238000000034 method Methods 0.000 title claims abstract description 28
- 238000001514 detection method Methods 0.000 claims abstract description 25
- 230000008569 process Effects 0.000 claims abstract description 8
- 210000000245 forearm Anatomy 0.000 claims description 23
- 238000006073 displacement reaction Methods 0.000 claims description 12
- 230000007246 mechanism Effects 0.000 claims description 10
- 238000013480 data collection Methods 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 6
- 238000012545 processing Methods 0.000 claims description 6
- 238000004804 winding Methods 0.000 claims description 3
- 238000005491 wire drawing Methods 0.000 claims description 2
- 238000011056 performance test Methods 0.000 abstract description 3
- 238000013500 data storage Methods 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 8
- 238000004891 communication Methods 0.000 description 5
- 238000009434 installation Methods 0.000 description 4
- 230000002093 peripheral effect Effects 0.000 description 4
- 238000012546 transfer Methods 0.000 description 3
- 230000009471 action Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000000691 measurement method Methods 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000010998 test method Methods 0.000 description 1
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Manipulator (AREA)
Abstract
本发明属于真空机械手性能测试领域,具体说是一种真空机械手R轴实时位置绝对精度测试系统及方法,包括:主控制器、马达控制器、机械手位置数据采集器、编码器数据采集器、数据处理器以及测试检测装置;主控制器用于生成各个关节的指令值发送至对应马达控制器;机械手位置数据采集器采集机械手本体每个关节的位置数据,发送至数据处理器;编码器数据采集器采集测试检测装置的编码器位置数据,发送至数据处理器;数据处理器处理获取机械手R轴理论值与实际值;测试检测装置实时检测机械手本体R轴的实际位置,发送至编码器数据采集器。本发明测试系统与机械手在同一时钟阈,对R轴运动路径任何位置的理论值与实际值进行实时对比,并进行数据储存。
Description
技术领域
本发明属于真空机械手性能测试技术领域,具体说是一种真空机械手R轴实时位置绝对精度测试系统及方法。
背景技术
随着半导体行业的快速发展,应用于半导体生产过程中的真空机械手的需求不断增大,特殊的行业应用需求对真空机械手的控制精度指标提出极高要求,R轴的位置绝对精度是真空机械手控制精度的重要指标。由此也带来了市场对真空机械手R轴位置绝对精度测试系统日益增多的需求。
目前机械手绝对定位精度标定方法按是否需要外部测量设备可以分为开环标定和闭环标定两大类。开环标定的方法主要是利用外部测量设备(如激光跟踪仪、三坐标测量仪等)实现标定。需要标定外部测量设备与机械手基坐标系间的关系,且外部测量设备价格昂贵,需要专门人员操作,测量设备易受环境因素影响造成测量结果不精确,进而影响标定结果。闭环标定主要采用物理约束和视觉实现机械手闭环标定。基于物理约束标定,成本低,不依赖外部传感器信息,操作简单。但标定结果的精度取决于机械加工件的精度。基于视觉标定成本低,测量方法简单,便于实现。但需要确定视觉传感器和机械手间的转换关系,存有转换误差。由于外部测试设备与机械手数据不在同一时钟域内,因此外部测量设备要实时反应当前机械手的绝对位置精度,需要将外部设备的时间统一到机械手的内部时间上,所以测试设备与机械手时间统一存在误差。因此,使用目前行业主流测量方法达到同一时间形成可对比的实时测量数据是很困难的。
发明内容
本发明目的是提供一种基于拉线编码器的机械手R轴位置绝对精度测试系统,测量设备与机械手在同一时钟阈内,获得实时位置与理论位置的对比数据,为真空机械手性能测试与研发提供数据支撑,以解决目前机械手R轴位置绝对精度测试方法中,外部设备成本高并操作复杂,无法与机械手同一时间的问题。
本发明为实现上述目的所采用的技术方案是:一种真空机械手R轴实时位置绝对精度测试系统,包括:主控制器、马达控制器、机械手位置数据采集器、编码器数据采集器、数据处理器以及测试检测装置;
所述主控制器,用于接收上位机输出的R轴运动指令,并将R轴运动指令生成各个关节的指令值发送至对应马达控制器;
所述机械手位置数据采集器,用于接收上位机通过数据处理器输出的数据采集指令,并根据数据采集指令采集机械手本体每个关节的位置数据,并发送至数据处理器;机械手位置数据采集器还通过EtherCAT总线与编码器数据采集器连接,以使编码器数据采集器的系统时间与机械手位置数据采集器系统时间统一,便于控制调用统一时间数据;
所述编码器数据采集器与测试检测装置连接,用于接收上位机通过数据处理器输出的数据采集指令,并根据数据采集指令采集测试检测装置的编码器位置数据,并发送至数据处理器;
所述数据处理器,用于接收机械手本体每个关节的位置数据和编码器位置数据,进行处理后,获取机械手R轴理论值与实际值,并发送至上位机;
所述马达控制器有多个,与机械手本体对应关节连接,用于接收来自主控制器的对应的指令值,并按照指令值控制机械手R轴由缩回位置到伸出目标位置;
所述测试检测装置,用于实时检测机械手本体R轴的实际位置,并发送至编码器数据采集器。
所述测试检测装置,包括:底板、导向轴支座、编码器安装座、导向轴、拉线编码器、外部转轮;
所述底板水平安装在工作区域,底板一端上固设有导向轴支座;所述导向轴支座内竖直插设有导向轴;
所述导向轴外套设有编码器安装座;所述编码器安装座的末端固设有拉线编码器;
所述拉线编码器的输出端上的拉绳缠绕设于外部转轮内;
所述外部转轮顶部通过固定夹具固定于机械手上方,底部与机械手本体连接。
所述外部转轮,包括:上盖板、定位轴、手臂转接法兰、限位螺钉、轴承以及C型挡圈;
其中,所述定位轴的底部端面上设有凹槽,顶部端面上设有螺纹孔,所述螺纹孔内设有限位螺钉;所述限位螺钉与定位轴的顶部端面之间夹持设有垫片;
所述手臂转接法兰顶部凸起插设于定位轴底部端面上的凹槽内,且手臂转接法兰的顶面与定位轴底部端面紧固连接;所述手臂转接法兰的底面通过螺钉与机械手固接;
所述定位轴上部轴段外圈转动设有轴承;所述轴承底端通过卡设在定位轴阶梯上的C型挡圈限位,轴承顶端通过垫片限位;
所述定位轴的下部轴段与拉线编码器的输出端上的拉绳连接,用于缠绕并拉动拉线编码器的拉绳,以获取拉线编码器位置数据。
所述定位轴为4段阶梯轴;定位轴的轴段从上至下依次为第一轴段、第二轴段、第三轴段以及第四轴段;
所述第一轴段为定位轴的上部轴段,其外圈转动设有轴承;
所述第二轴段与第三轴段形成阶梯,以用于安装C型挡圈;
所述第三轴段,用于随外部转轮转动,带动缠绕拉线编码器的输出端上的拉绳;
所述第四轴段的直径尺寸与手臂转接法兰的直径尺寸相同,且与手臂转接法兰固接,以使整个定位轴被带动旋转。
所述测试检测装置,还包括支撑轴;
所述支撑轴垂直固设于底板上,支撑轴的圆柱面与编码器安装座相贴接;以对旋转导向轴带动的编码器安装座进行限位,使编码器安装座的旋转中心与支撑轴的中心轴线在同一直线上。
一种真空机械手R轴实时位置绝对精度测试方法,包括以下步骤:
步骤1)上位机分别对数据处理器输出数据采集指令,对主控制器发出R轴由缩回位置到伸出目标位置的伸出指令,马达控制器控制马达运动;
步骤2)测试检测装置的拉线编码器实时采集的编码器位置数据,并发送至数据处理器;机械手位置数据采集器采集机械手本体每个关节的位置数据,并发送至数据处理器;
步骤3)数据处理器对接收机械手本体每个关节的位置数据进行储存,调取同一时间的数据进行处理,得到机械手本体理论的R轴位置P;
步骤4)同时R轴运动带动拉线编码器,数据处理器实时获取编码器位置数据并进行处理,得到实际的R轴位置P 1 ;
步骤5)数据处理器将步骤3)~步骤4)处理后的数据上传至上位机,得出R轴实际位置P 1 与理论位置P的运动曲线,完成机械手R轴绝对精度的测量。
所述步骤3),具体为:
步骤3-1)机械手本体为二连杆串联机构;上位机获取二连杆串联机构的大臂关节角度θ 1 和小臂关节角度θ 2 ,并根据大臂关节角度θ 1 和小臂关节角度θ 2 ,得到手臂关节角度q的关系式;
步骤3-2)通过二连杆串联机构z运动模型,得到机械手末端的坐标关系模型;
步骤3-3)将机械手末端的坐标关系模型代入至手指末端位移模型计算得到R轴方向手臂末端理论值P。
所述步骤3-1),具体为:
上位机通过指令调取数据处理器分别对应机械手大臂和小臂的编码器数据E 1 、E 2,以及大臂关节角度计算模型n、小臂关节角度计算模型s,分别计算得出大臂关节角度θ 1 和小臂关节角度θ 2 ;
θ 1 =n(E1,E2);θ 2 =s(E1,E2);
将大臂关节角度θ 1 和小臂关节角度θ 2 带入公式,计算得出手臂关节角度关系式q,即:
q=[θ 1, θ 2 ]T。
所述通过二连杆串联机构z运动模型,得到机械手末端的坐标关系模型,即:
f(q)=m(l 1 ,l 2 )
其中,m为机械手末端的坐标关系模型,机械手大臂长度为l 1 ,小臂长度为l 2 。
所述步骤3-3),具体为:
机械手末端的坐标关系模型m代入手指末端位移模型计算得到R轴方向手臂末端理论值P,即:
P=f(△q);
f(△q)=sqrt((l 1 (cos(θc 1 )-cos(θr 1 ))+l 2 (cos(θc 1+ θc 2 )-cos(θr 1+ θr 2 )))2+ (l 1 (sin(θc 1 )-sin(θr 1 ))+l 2 (sin(θc 1+ θc 2 )-cos(θr 1+ θr 2 )))2)。
其中,sqrt()为手指末端位移模型,△q为关节值变化量,θc 1 为当前机械手大臂关节角度,θc 2 为当前机械手小臂关节角度,θr 1 为位移前机械手大臂关节角度,θr 2 为位移前机械手小臂关节角度。
本发明具有以下有益效果及优点:
1.本发明可以对真空机械手R轴位置绝对精度进行测试,测试系统与机械手在同一时钟阈,可以对R轴运动路径任何位置的理论值与实际值进行实时对比,并可以进行数据储存。
2. 本发明为解决测试系统只能测试定点位置的理论值与实际值,无法测出运动路径的理论值与实际值对应曲线。外部的测试系统位置数据采集器与机械手位置数据采集器通过EtherCAT总线相连,统一系统时间,可以实时检测R轴的理论位置与实际位置进行保存。并可以绘制出R轴运动路径的理论运动曲线与实时对应的运动曲线。
3.本发明需要保持机械手的伸出方向与拉线编码器的拉线方向保持一致。根据两点确定一条直线的定理,本发明利用支撑轴定位,将支撑轴固定在伸长底板上,然后绕导向轴旋转编码器安装座,直至支撑轴与编码器安装座贴紧,再用紧定螺钉将编码器安装座与导向轴锁紧,便于安装校准,操作简单。
4.本发明与激光跟踪仪与视觉测试设备相比,拉线编码器成本低。
5.本发明通过特有的机械设计,保证机械加工精度,操作简单,节省调试时间。
附图说明
图1本发明的测试检测装置机械结构示意图;
图2本发明外部转轮内部机械结构示意图;
图3测试系统机械装置安装于整体结构上的示意图;
图4本发明的真空机械手R轴位置绝对精度测试系统功能框图;
图5编码器数据采集处理的框图;
其中,1为底板、2为导向轴支座、3为编码器安装座、4为导向轴、5为支撑轴、6为拉线编码器、7为上部盖板、8为外部转轮、9为定位轴、10为手臂转接法兰、11为限位螺钉、12为轴承、13为C型挡圈、14为垫片、101为机械手控制本体、102为机械手本体、103为测试检测装置。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
如图4所示,为本发明的真空机械手R轴位置绝对精度测试系统功能框图;本发明为实现R轴位置数据采集处理,搭建电气控制系统包括:包括:主控制器、马达控制器、机械手位置数据采集器、编码器数据采集器、数据处理器以及测试检测装置;
主控制器,用于接收上位机输出的R轴运动指令,并将R轴运动指令生成各个关节的指令值发送至对应马达控制器;本实施例中,主控制器基于KR260的ROS2环境开发,主控制器的对外接口主要有电源接口、RS232接口、通信接口等,总线支持EtherCAT。主控制器通过动作组来控制机械手,每个动作组包含初始化、复位、抓取、转移、放置,可以控制机械手本体102动作,并读取位置反馈。
机械手位置数据采集器,用于接收上位机通过数据处理器输出的数据采集指令,并根据数据采集指令采集机械手本体102每个关节的位置数据,并发送至数据处理器;
编码器数据采集器与测试检测装置连接,用于接收上位机通过数据处理器输出的数据采集指令,并根据数据采集指令采集测试检测装置的编码器位置数据,并发送至数据处理器;本实施例中,编码器数据采集器基于ER-3A编码器采集模块形成的在线监测数据采集系统,外设接口主要有电源接口、RS485接口、通信接口等,总线支持EtherCAT。编码器数据采集器用于采集机械手编码器的运动数据。
在本实施例的编码器数据采集器基于ER-3A编码器采集模块形成的在线监测数据采集系统,外设接口主要有电源接口、RS485接口、通信接口等,总线支持EtherCAT。编码器数据采集器用于采集测试系统拉线编码器的运动数据,在本实施例中,编码器数据采集器即通过EtherCAT总线与机械手位置数据采集器连接,以使二者系统时间相统一,便于控制调用统一时间数据。
数据处理器,用于接收机械手本体102每个关节的位置数据和编码器位置数据,进行处理后,获取机械手R轴理论值与实际值,并发送至上位机;本实施例中,数据处理器基于IS61LV25616芯片形成数据储存处理系统,外设接口主要有电源接口、RS232接口、通信接口等,总线支持EtherCAT。编码器数据采集器将采集的数据通过FPGA存储到RAM中,然后上位机调取进行数据处理,计算机械手R轴理论值与实际值的运动曲线。
将机械手位置数据采集器与测试系统位置数据采集器通过EtherCAT总线连接,统一测试系统与机械手在同一时钟阈内,实现数据采集阶段时间保持一致,进而统一测试系统与机械手的时间。
马达控制器有多个,与机械手本体102对应关节连接,用于接收来自主控制器的对应的指令值,并按照指令值控制机械手R轴由缩回位置到伸出目标位置;本实施例中,马达控制器基于TRINAMIC的TMCC160芯片,芯片集成电机预驱动、控制和操纵系统。外设接口主要有电源接口、RS232接口、通信接口等,总线支持EtherCAT。马达控制器控制机械手电机按照主控制器指令执行运动动作。
测试检测装置103,用于实时检测机械手本体102的R轴的实际位置,并发送至编码器数据采集器。
如图1和图3所示,为本发明的测试检测装置机械结构示意图,本发明中的测试检测装置103,包括:底板1、导向轴支座2、编码器安装座3、导向轴4、拉线编码器6、外部转轮8;
底板1水平安装在工作区域,底板1一端上固设有导向轴支座2;导向轴支座2内竖直插设有导向轴4;
导向轴4外套设有编码器安装座3;编码器安装座3的末端固设有拉线编码器6;
拉线编码器6的输出端上的拉绳缠绕设于外部转轮8内;
外部转轮8顶部通过固定夹具固定于机械手上方,底部与机械手本体102连接。
本发明为满足机械手数据采集准确性需求,保证机械手本体102的伸出方向与拉线编码器6的拉线方向保持一致。我们将支撑轴固定在底板1上,然后绕导向轴4旋转编码器安装座3,将支撑轴5与编码器安装座3贴紧,再用紧定螺钉将编码器安装座3与导向轴4锁紧。根据两点确定一条直线的定理,方便安装校准,操作简单。如图2所示。
如图2所示,为本发明外部转轮内部机械结构示意图,外部转轮8,包括:上盖板7、定位轴9、手臂转接法兰10、限位螺钉11、轴承12以及C型挡圈13;
其中,定位轴9的底部端面上设有凹槽,顶部端面上设有螺纹孔,所述螺纹孔内设有限位螺钉11;限位螺钉11与定位轴9的顶部端面之间夹持设有垫片14;
手臂转接法兰10顶部凸起插设于定位轴9底部端面上的凹槽内,且手臂转接法兰10的顶面与定位轴9底部端面紧固连接;手臂转接法兰10的底面通过螺钉与机械手本体102固接;
定位轴9上部轴段外圈转动设有轴承12;轴承12底端通过卡设在定位轴9阶梯上的C型挡圈13限位,轴承12顶端通过垫片14限位;
定位轴9的下部轴段与拉线编码器6的输出端上的拉绳连接,用于缠绕并拉动拉线编码器6的拉绳,以获取拉线编码器位置数据。
定位轴9为4段阶梯轴;定位轴9的轴段从上至下依次为第一轴段、第二轴段、第三轴段以及第四轴段;
第一轴段为定位轴9的上部轴段,其外圈转动设有轴承12;
第二轴段与第三轴段形成阶梯,以用于安装C型挡圈13;
第三轴段,用于随外部转轮8转动,带动缠绕拉线编码器6的输出端上的拉绳;
第四轴段的直径尺寸与手臂转接法兰10的直径尺寸相同,且与手臂转接法兰10固接,以使整个定位轴9被带动旋转。
测试检测装置103,还包括支撑轴5;
支撑轴5垂直固设于底板1上,支撑轴5的圆柱面与编码器安装座3相贴接;以对旋转导向轴4带动的编码器安装座3进行限位,使编码器安装座3的旋转中心与支撑轴5的中心轴线在同一直线上。
如图4所示,为本发明的真空机械手R轴位置绝对精度测试系统功能框图;基于测试系统功能框图,本发明一种真空机械手R轴实时位置绝对精度测试系统的测试方法,包括以下步骤:
首先需要对机械装置安装校准,本实施例的安装方法具体如下:
机械装置安装校准步骤:将本发明的机械装置事先组装好,然后将其增长底板带圆弧一端安装在机械手控制本体101上,并将机械手控制本体101与机械手本体102电连接,把手臂转接法兰10安装在真空机械手本体102的小臂上,因为手臂转接法兰和编码器定位轴是固定连接的,这样机械手小臂就可以带动手臂转接法兰10和拉线编码器6定位轴一同运动,安装示意图如图1~图3所示。
为了保证拉线编码器6和机械手本体102处于同一条直线上,我们还需要对该装置进行校准操作。具体方法为将支撑轴5的圆柱面与编码器安装座3贴紧,保证编码器安装座3的旋转中心与支撑轴5的中心轴线在同一条直线上,然后利用紧定螺钉将编码器安装座3与导向轴4锁紧。
进入测试阶段:
1)上位机分别对数据处理器输出数据采集指令,对主控制器发出R轴由缩回位置到伸出目标位置的伸出指令,马达控制器控制马达运动;
2)测试检测装置的拉线编码器6实时采集的编码器位置数据,并发送至数据处理器;机械手位置数据采集器采集机械手本体102每个关节的位置数据,并发送至数据处理器;
3)如图5所示,数据处理器对接收机械手本体每个关节的位置数据进行储存,调取同一时间的数据进行处理,得到机械手本体102理论的R轴位置P;
步骤3-1)本实施例的机械手本体为二连杆串联机构;
上位机获取二连杆串联机构的大臂关节角度θ 1 和小臂关节角度θ 2 ,并根据大臂关节角度θ 1 和小臂关节角度θ 2 ,得到手臂关节角度q的关系式;
步骤3-2)通过二连杆串联机构z运动模型,得到机械手末端的坐标关系模型;
步骤3-3)将机械手末端的坐标关系模型代入至手指末端位移模型计算得到R轴方向手臂末端理论值P。
步骤3-1),具体为:
上位机通过指令调取数据处理器分别对应机械手大臂和小臂的编码器数据E 1 、E 2,以及大臂关节角度计算模型n、小臂关节角度计算模型s,分别计算得出大臂关节角度θ 1 和小臂关节角度θ 2 ;
θ 1 =n(E1,E2);θ 2 =s(E1,E2);
将大臂关节角度θ 1 和小臂关节角度θ 2 带入公式,计算得出手臂关节角度关系式q,即:
q=[θ 1, θ 2 ]T。
通过二连杆串联机构z运动模型(大臂带动小臂,小臂模块有手指),得到机械手末端的坐标关系模型,即:
f(q)=m(l 1 ,l 2 )
其中,m为机械手末端的坐标关系模型,机器人大臂长度为l 1 ,小臂长度为l 2 。
步骤3-3),具体为:
机械手末端的坐标关系模型m代入手指末端位移模型计算得到R轴方向手臂末端理论值P,即:
P=f(△q);
f(△q)=sqrt((l 1 (cos(θc 1 )-cos(θr 1 ))+l 2 (cos(θc 1+ θc 2 )-cos(θr 1+ θr 2 )))2+ (l 1 (sin(θc 1 )-sin(θr 1 ))+l 2 (sin(θc 1+ θc 2 )-cos(θr 1+ θr 2 )))2)
步骤4)同时R轴运动带动拉线编码器,数据处理器实时获取编码器位置数据并进行处理,得到实际的R轴位置P 1 ;
步骤5)数据处理器将步骤3)~步骤4)处理后的数据上传至上位机,得出R轴实际位置P 1 与理论位置P的运动曲线,完成机械手R轴绝对精度的测量。
本发明为解决测试系统只能测试定点位置的理论值与实际值,无法测出运动路径的理论值与实际值对应曲线。外部的测试系统位置数据采集器与机械手位置数据采集器通过EtherCAT总线相连,统一系统时间,可以实时检测R轴的理论位置与实际位置进行保存。并可以绘制出R轴运动路径的理论运动曲线与实时对应的运动曲线。
以上所述仅为本发明的实施方式,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进、扩展等,均包含在本发明的保护范围内。
Claims (6)
1.一种真空机械手R轴实时位置绝对精度测试系统,其特征在于,包括:主控制器、马达控制器、机械手位置数据采集器、编码器数据采集器、数据处理器以及测试检测装置;
所述主控制器,用于接收上位机输出的R轴运动指令,并将R轴运动指令生成各个关节的指令值发送至对应马达控制器;
所述机械手位置数据采集器,用于接收上位机通过数据处理器输出的数据采集指令,并根据数据采集指令采集机械手本体每个关节的位置数据,并发送至数据处理器;机械手位置数据采集器还通过EtherCAT总线与编码器数据采集器连接,以使编码器数据采集器的系统时间与机械手位置数据采集器系统时间统一,便于控制调用统一时间数据;
所述编码器数据采集器与测试检测装置连接,用于接收上位机通过数据处理器输出的数据采集指令,并根据数据采集指令采集测试检测装置的编码器位置数据,并发送至数据处理器;
所述数据处理器,用于接收机械手本体每个关节的位置数据和编码器位置数据,进行处理后,获取机械手R轴理论值与实际值,并发送至上位机;
所述马达控制器有多个,与机械手本体对应关节连接,用于接收来自主控制器的对应的指令值,并按照指令值控制机械手R轴由缩回位置到伸出目标位置;
所述测试检测装置,用于实时检测机械手本体R轴的实际位置,并发送至编码器数据采集器;
所述测试检测装置,包括:底板(1)、导向轴支座(2)、编码器安装座(3)、导向轴(4)、拉线编码器(6)、外部转轮(8);
所述底板(1)水平安装在工作区域,底板(1)一端上固设有导向轴支座(2);所述导向轴支座(2)内竖直插设有导向轴(4);
所述导向轴(4)外套设有编码器安装座(3);所述编码器安装座(3)的末端固设有拉线编码器(6);
所述拉线编码器(6)的输出端上的拉绳缠绕设于外部转轮(8)内;
所述外部转轮(8)顶部通过固定夹具固定于机械手上方,底部与机械手本体(102)连接;
所述外部转轮(8),包括:上盖板(7)、定位轴(9)、手臂转接法兰(10)、限位螺钉(11)、轴承(12)以及C型挡圈(13);
其中,所述定位轴(9)的底部端面上设有凹槽,顶部端面上设有螺纹孔,所述螺纹孔内设有限位螺钉(11);所述限位螺钉(11)与定位轴(9)的顶部端面之间夹持设有垫片(14);
所述手臂转接法兰(10)顶部凸起插设于定位轴(9)底部端面上的凹槽内,且手臂转接法兰(10)的顶面与定位轴(9)底部端面紧固连接;所述手臂转接法兰(10)的底面通过螺钉与机械手固接;
所述定位轴(9)上部轴段外圈转动设有轴承(12);所述轴承(12)底端通过卡设在定位轴(9)阶梯上的C型挡圈(13)限位,轴承(12)顶端通过垫片(14)限位;
所述定位轴(9)的下部轴段与拉线编码器(6)的输出端上的拉绳连接,用于缠绕并拉动拉线编码器(6)的拉绳,以获取拉线编码器位置数据;
所述测试检测装置,还包括支撑轴(5);
所述支撑轴(5)垂直固设于底板(1)上,支撑轴(5)的圆柱面与编码器安装座(3)相贴接;以对旋转导向轴(4)带动的编码器安装座(3)进行限位。
2.根据权利要求1所述的一种真空机械手R轴实时位置绝对精度测试系统,其特征在于,所述定位轴(9)为4段阶梯轴;定位轴(9)的轴段从上至下依次为第一轴段、第二轴段、第三轴段以及第四轴段;
所述第一轴段为定位轴(9)的上部轴段,其外圈转动设有轴承(12);
所述第二轴段与第三轴段形成阶梯,以用于安装C型挡圈(13);
所述第三轴段,用于随外部转轮(8)转动,带动缠绕拉线编码器(6)的输出端上的拉绳;
所述第四轴段的直径尺寸与手臂转接法兰(10)的直径尺寸相同,且与手臂转接法兰(10)固接,以使整个定位轴(9)被带动旋转。
3.一种真空机械手R轴实时位置绝对精度测试方法,采用如权利要求1或2任一项所述的一种真空机械手R轴实时位置绝对精度测试系统执行,其特征在于,包括以下步骤:
步骤1)上位机分别对数据处理器输出数据采集指令,对主控制器发出R轴由缩回位置到伸出目标位置的伸出指令,马达控制器控制马达运动;
步骤2)测试检测装置的拉线编码器(6)实时采集的编码器位置数据,并发送至数据处理器;机械手位置数据采集器采集机械手本体每个关节的位置数据,并发送至数据处理器;
步骤3)数据处理器对接收机械手本体每个关节的位置数据进行储存,调取同一时间的数据进行处理,得到机械手本体理论的R轴位置P;
所述步骤3),具体为:
步骤3-1)机械手本体为二连杆串联机构;上位机获取二连杆串联机构的大臂关节角度θ 1 和小臂关节角度θ 2 ,并根据大臂关节角度θ 1 和小臂关节角度θ 2 ,得到q手臂关节角度关系式;
步骤3-2)通过二连杆串联机构z运动模型,得到机械手末端的坐标关系模型;
步骤3-3)将机械手末端的坐标关系模型代入至手指末端位移模型计算得到R轴方向手臂末端理论值P;
步骤4)同时R轴运动带动拉线编码器,数据处理器实时获取编码器位置数据并进行处理,得到实际的R轴位置P 1 ;
步骤5)数据处理器将步骤3)~步骤4)处理后的数据上传至上位机,得出R轴实际位置
P 1 与理论位置P的运动曲线,完成机械手R轴绝对精度的测量。
4.根据权利要求3所述的一种真空机械手R轴实时位置绝对精度测试方法,其特征在于,所述步骤3-1),具体为:
上位机通过指令调取数据处理器分别对应机械手大臂和小臂的编码器数据E 1 、E 2,以及大臂关节角度计算模型n、小臂关节角度计算模型s,分别计算得出大臂关节角度θ 1 和小臂关节角度θ 2 ;
θ 1 =n(E1,E2);
θ 2 =s(E1,E2);
将大臂关节角度θ 1 和小臂关节角度θ 2 带入公式,计算得出q手臂关节角度关系式,即:q=[θ 1, θ 2 ]T。
5.根据权利要求3所述的一种真空机械手R轴实时位置绝对精度测试方法,其特征在于,所述通过二连杆串联机构z运动模型,得到机械手末端的坐标关系模型,即:
f(q)=m(l 1 ,l 2 )
其中,m为机械手末端的坐标关系模型,机械手大臂长度为l 1 ,机械手小臂长度为l 2 。
6.根据权利要求3所述的一种真空机械手R轴实时位置绝对精度测试方法,其特征在于,所述步骤3-3),具体为:
机械手末端的坐标关系模型m代入手指末端位移模型计算得到R轴方向手臂末端理论值P,即:
P=f(△q);
f(△q)=sqrt((l 1 (cos(θc 1 )-cos(θr 1 ))+l 2 (cos(θc 1+ θc 2 )-cos(θr 1+ θr 2 )))2+(l 1 (sin(θ c 1 )-sin(θr 1 ))+l 2 (sin(θc 1+ θc 2 )-cos(θr 1+ θr 2 )))2)
其中,sqrt()为手指末端位移模型,△q为关节值变化量,θc 1 为当前机械手大臂关节角度,θc 2 为当前机械手小臂关节角度,θr 1 为位移前机械手大臂关节角度,θr 2 为位移前机械手小臂关节角度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311473777.5A CN117182976B (zh) | 2023-11-08 | 2023-11-08 | 一种真空机械手r轴实时位置绝对精度测试系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311473777.5A CN117182976B (zh) | 2023-11-08 | 2023-11-08 | 一种真空机械手r轴实时位置绝对精度测试系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN117182976A CN117182976A (zh) | 2023-12-08 |
CN117182976B true CN117182976B (zh) | 2024-01-05 |
Family
ID=88994678
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311473777.5A Active CN117182976B (zh) | 2023-11-08 | 2023-11-08 | 一种真空机械手r轴实时位置绝对精度测试系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117182976B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103934819A (zh) * | 2014-04-09 | 2014-07-23 | 武汉中科创新技术股份有限公司 | 机械手及复合材料大型壳体自动仿形系统 |
JP2016078149A (ja) * | 2014-10-15 | 2016-05-16 | キヤノン株式会社 | ロボット装置の制御方法及びロボット装置、プログラム及び記録媒体 |
CN107309884A (zh) * | 2016-04-27 | 2017-11-03 | 上海福赛特机器人有限公司 | 机器人标定系统及方法 |
DE102018122627A1 (de) * | 2017-09-26 | 2019-03-28 | Fanuc Corporation | Messsystem |
CN110497391A (zh) * | 2019-09-04 | 2019-11-26 | 湖南三一快而居住宅工业有限公司 | 机械臂示教方法及机械臂示教装置 |
-
2023
- 2023-11-08 CN CN202311473777.5A patent/CN117182976B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103934819A (zh) * | 2014-04-09 | 2014-07-23 | 武汉中科创新技术股份有限公司 | 机械手及复合材料大型壳体自动仿形系统 |
JP2016078149A (ja) * | 2014-10-15 | 2016-05-16 | キヤノン株式会社 | ロボット装置の制御方法及びロボット装置、プログラム及び記録媒体 |
CN107309884A (zh) * | 2016-04-27 | 2017-11-03 | 上海福赛特机器人有限公司 | 机器人标定系统及方法 |
DE102018122627A1 (de) * | 2017-09-26 | 2019-03-28 | Fanuc Corporation | Messsystem |
CN110497391A (zh) * | 2019-09-04 | 2019-11-26 | 湖南三一快而居住宅工业有限公司 | 机械臂示教方法及机械臂示教装置 |
Also Published As
Publication number | Publication date |
---|---|
CN117182976A (zh) | 2023-12-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107421442B (zh) | 一种外部测量辅助的机器人定位误差在线补偿方法 | |
CN109176494A (zh) | 绳驱多关节柔性机器人自标定方法及系统、存储介质 | |
CN101377418B (zh) | 基于旋转-直线运动的接触式大型异型玻璃外廓检测装置和方法 | |
JP2012038312A (ja) | 制御システム及びこの制御システムに用いる位置推定方法 | |
CN105865341B (zh) | 工业机器人空间位姿重复定位精度测量装置和方法 | |
CN102192999B (zh) | 基于探针自动测量气流压力和速度的装置 | |
CN101598531A (zh) | 真空泵叶片装配质量检测方法及专用装置 | |
CN105372091A (zh) | 刀库可靠性试验台换刀位置自适应对中调节装置及方法 | |
CN117182976B (zh) | 一种真空机械手r轴实时位置绝对精度测试系统及方法 | |
CN103934819B (zh) | 机械手及复合材料大型壳体自动仿形系统 | |
CN100354078C (zh) | 机器人关节减速器柔性的双环检测机构 | |
EP4239308A1 (en) | Speed reducer transmission error test apparatus and method | |
CN110053072A (zh) | 一种复合式机械臂机构及其进行物料搬运的方法 | |
CN110657771B (zh) | 一种轴类工件测量机器人及测量方法 | |
CN111795651B (zh) | 一种运用机械手臂测量大型回转体参数的方法及设备 | |
CN112621798A (zh) | 一种机器人手爪 | |
CN111256622B (zh) | 一种对偶激光式机器人关节角度测量方法及角度测量装置 | |
CN107300373A (zh) | 基于六自由度辅助机器人的复杂曲面测量装置 | |
CN111664812A (zh) | 一种基于激光扫描的机器人钻铆法向找正方法及装置 | |
CN114109741B (zh) | 风力发电机轴对中监测系统及方法 | |
CN109916392A (zh) | 一种基于编码器的机械装备位置检测装置及其系统、方法 | |
CN115673837A (zh) | 一种调节高精度位移平台中滚珠丝杠位姿偏差的控制设备 | |
CN213764803U (zh) | 一种锁螺丝机手爪及锁螺丝机 | |
Zhang et al. | Intelligent surface-normal adjustment system and application in aeronautical drilling robot | |
CN205228846U (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 |