CN103868996B - 用于无损检测的双机械手工件坐标系自动重合方法 - Google Patents
用于无损检测的双机械手工件坐标系自动重合方法 Download PDFInfo
- Publication number
- CN103868996B CN103868996B CN201410103672.5A CN201410103672A CN103868996B CN 103868996 B CN103868996 B CN 103868996B CN 201410103672 A CN201410103672 A CN 201410103672A CN 103868996 B CN103868996 B CN 103868996B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- workpiece coordinate
- workpiece
- mechanical hand
- hands
- 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
Landscapes
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明提出一种用于无损检测的双机械手工件坐标系自动重合方法,该方法应用于双机械手检测***中,在检测工件之前,通过示教的方式,使双机械手的顶尖分别在空间内任意不共线的三点处对齐,根据给定的方法计算两个机械手基坐标系下的坐标变换关系。在检测工件,需要确定两个机械手的工件坐标系时,只需示教其中一个机械手,确定其工件坐标系的三个点,得到该机械手的工件坐标系。另一个机械手的工件坐标系,根据双机械手之间的坐标变换关系和三点坐标,可以直接求得,且得到的两个机械手的工件坐标系重合。当检测不同类型的工件时,只需要重复其中一个机械手确定工件坐标系的步骤,大大节省了确定工件坐标系的时间。
Description
一、技术领域
本发明涉及超声无损检测领域、工业机器人应用领域,具体涉及到一种双机械手无损检测***。提出一种不用示教两个机械手顶尖到达工件上的同一点,就能确保两个机械手工件坐标系重合的方法。
二、背景技术
由复合材料制造的复杂曲面零件的无损检测,由于需要一发一收两个传感器同步运动,一直是超声无损检测领域的一个难题。常规的检测方法很难完成曲面的检测任务。机械手由于柔性好,集成化程度高,能够实现复杂的扫查运动,在无损检测领域逐步获得推广和应用。在应用双机械手检测工件时,需要两个机械手协同运动完成复杂曲面的检测任务,需要两个机械手的工件坐标系重合。
两个机械手坐标系重合的传统方法是示教两个机械手到达工件坐标系上的三个点,然后计算各自的工件坐标系。对于不在工件上面的点,需要两个机械手更高的对齐精度,因为这些点的偏差将导致两个机械手工件坐标系的重合度下降。为了保证两个机械手的顶尖能够依次到达同一个点,需要根据工件形状,调整机械手的位姿,防止两个机械手干涉,才能依次让两个机械手的顶尖对齐,调整困难,且精度较差。
双机械手协同控制中工件坐标系的确定方法目前延续着传统的方法,每次要示教两个机械手到达同一个点,还要保证其对齐的精度。传统的双机械手工件坐标系重合方法操作难度大,每次的操作时间长,特别是变换不同类型的工件以后,重新确定两个机械手的工件坐标系,需要重复以上工作,效率很低。因此,提出双机械手工件坐标系自动重合的方法可以节省双机械手确定工件坐标系的时间。特别是针对变换工件以后工件坐标系的确定,只需要示教其中一个机械手确定其工件坐标系,就可以确定另一个机械手的工件坐标系,且两个机械手工件坐标系重合,该方法具有较大的操作优势,能够节省大量的时间。
三、发明内容
为了克服现有的确定双机械手工件坐标系重合方法工作量大、难度高、精度低等缺点,本发明提出一种简单方便使双机械手工件坐标系自动重合的方法。
本发明采用的技术方案是:双机械手检测工件的示意图如图1所示,控制两个机械手在空间中任意三个不共线的点对齐,记录两个机械手基坐标系下的坐标值,根据得到的数据推导出两个机械手之间的变换关系式。在确定工件坐标系时,示教其中一个机械手到工件坐标系上指定的三点,并记录这三点在主动机械手基坐标系中的坐标值,确定其工件坐标系。将这些点的坐标值通过变换关系式求出这些点在另一个机械手基坐标系下的值,并输入到此机械手中,确定其工件坐标系。
下面是本发明的理论推导过程。
我们首先定义两个机械手中一个为主动机械手(简称主手)Rm,另一个为从动机械手(简称从手)Rs。示教主手和从手的顶尖在空间中任意不共线的三点处对齐,如图2所示。
假设这三点在主手基坐标系下的坐标为:
Pm1=[Xm1,Ym1,Zm1]′
Pm2=[Xm2,Ym2,Zm2]′
Pm3=[Xm3,Ym3,Zm3]′
在从手基坐标系下的坐标为:
Ps1=[Xs1,Ys1,Zs1]′
Ps1=[Xs2,Ys2,Zs2]′
Ps3=[Xs3,Ys3,Zs3]′
求两个机械手之间的坐标变换关系需要四个线性无关的点坐标,为了保证四个点线性无关,需要求得一个点不在这三个点组成的平面上。
令
求得主手和从手第四个点的坐标:
Pm4=[Xm4,Ym4,Zm4]′
Ps4=[Xs4,Ys4,Zs4]′
假设主手和从手之间的坐标变换关系式的旋转矩阵为
平移矩阵为:
如图1所示。上述四点满足关系式
通过线性变换可以导出以下关系式
求解上述的线性方程组,可以求得Rrm和Posm,则两个机械手之间的坐标转换关系为:
Ps=Rrm*Pm+Posm (8)
在检测一类工件时,需要确定机械手的工件坐标系。控制主手顶尖到工件坐标系上的三个已知点如图3所示,这时不需要考虑机械手到这三点时姿态,容易控制,操作时间短。记录主手在基坐标系下这三点的坐标值,可以求得主手的工件坐标系。通过式(1)和(2)计算第四点的坐标,并将四点的坐标代入式(7),求得Rrm和Posm。将主手基坐标系下的三点坐标值代入式(8),求得从手基坐标系下的三点坐标值。将求得的从手基坐标系下的三点坐标值输入到从手的机械手中,确定从手的工件坐标系。
由上述方法确定的两个机械手的工件坐标系自动重合。
如果两个机械手的位置没有变化,下一次需要确定工件坐标系时,不需要再次计算两个机械手之间的变换关系式。控制一个机械手到达工件坐标系下的三点,就能够确定新的双机械手的工件坐标系。
本发明的有益效果是,在确定工件坐标系时,只需要确定一个机械手的工件坐标系,就可以使两个机械手的工件坐标系自动重合,大大节省确定双机械手工件坐标系的时间。当需要检测不同类型的工件时,如果两个机械手的位置没有发生变化,则再次确定工件坐标系时,不需要重新计算两个机械手之间的坐标变换关系式,只需要使用主动机械手确定工件坐标系,这样大大缩短了确定工件坐标系的时间。
四、附图说明
图1是双机械手***坐标系关系示意图。
图2是主动机械手和和从动机械手顶尖空间对齐的示意图。
图3是主动机械手确定工件坐标系的示意图
图4是双机械手***检测工件的示意图
图中标注
1-主动机械手 2-从动机械手 3-主动机械手顶尖 4-从动机械手顶尖 5-主动机械手基坐标系 6-从动机械手基坐标系 7-工件坐标系 8-发射换能器 9-接收换能器 10-被测工件
五、具体实施方式
下面对本发明的具体实施方式进行详细说明:
1.对于位置固定的双机械手检测***,依次控制两个机械手运动,将两个机械手顶点在空间中任意不共线的三点处对齐,记录这三个点在两个机械手基坐标系中的坐标值。
2.通过式(1)和(2)计算第四点的坐标,根据式(7)计算两个机械手基坐标系的坐标转换关系,推导出Rrm和Posm。
3.在检测工件时,示教主动机械手到工件坐标系上指定的三点,并记录这三点在主动机械手基坐标系中的坐标值。
4.根据这三点坐标,确定主动机械手的工件坐标系。
5.将上述三点的坐标值代入到坐标变换关系式(8)中,得到这三个点在从动机械手基坐标系中的坐标值。
6.将计算得到的三点坐标值输入到从动机械手中,确定从动机械手的工件坐标系。
7.当更换不同类型的工件时,只需要主动机械手重新确定工件坐标系,再重复步骤3到步骤6,则两个机械手的工件坐标系将在新的工件坐标系下重合。
Claims (3)
1.一种双机械手工件坐标系自动重合的方法,其特征是对位置确定的双机械手检测***,依次控制两个机械手在空间中任意不共线三点处对齐,并记录其在两个机械手基坐标系下的坐标值,根据给定的算法确定两个机械手之间的坐标变换关系,在需要确定两个机械手的工件坐标系时,只需示教其中一个机械手到达工件坐标系上的三个已知点,得到该机械手的工件坐标系,这三个点通过坐标变换关系的算法得到第二个机械手在这三个点的坐标值,进而得到第二个机械手的工件坐标系,通过上述几步使得两个机械手的工件坐标系重合。
2.根据权利要求1所述的双机械手工件坐标系自动重合方法,其特征是:示教其中一个机械手的顶尖到被测工件坐标系的三个已知点,可以得到该机械手的工件坐标系,根据已经确定的两个机械手之间的坐标变换关系,计算出这些点在第二个机械手基坐标系下的坐标值,将上述步骤得到的坐标值输入到第二个机械手的基坐标系当中,确定这个机械手的工件坐标系,得到的两个机械手的工件坐标系重合。
3.根据权利要求1所述的双机械手工件坐标系自动重合方法,其特征是:变换不同类型的工件后,重新确定两个机械手的工件坐标系时,只需重新确定一个机械手的工件坐标系,第二个机械手的工件坐标系可以根据上述计算的坐标变换关系式进行推导,不需再次计算两个机械手的坐标变换关系。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410103672.5A CN103868996B (zh) | 2014-03-20 | 2014-03-20 | 用于无损检测的双机械手工件坐标系自动重合方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410103672.5A CN103868996B (zh) | 2014-03-20 | 2014-03-20 | 用于无损检测的双机械手工件坐标系自动重合方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103868996A CN103868996A (zh) | 2014-06-18 |
CN103868996B true CN103868996B (zh) | 2016-09-14 |
Family
ID=50907758
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410103672.5A Active CN103868996B (zh) | 2014-03-20 | 2014-03-20 | 用于无损检测的双机械手工件坐标系自动重合方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103868996B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104155321A (zh) * | 2014-09-09 | 2014-11-19 | 北京理工大学 | X射线舱机械手无损检测方法 |
CN108318581B (zh) * | 2017-12-08 | 2020-12-18 | 中国兵器科学研究院宁波分院 | 一种不用装夹定位的圆弧面工件超声波c扫描自动检测方法 |
CN108982664B (zh) * | 2018-07-16 | 2020-06-19 | 北京理工大学 | 一种双机械手超声检测方法 |
CN112326802B (zh) * | 2020-11-05 | 2021-09-07 | 北京理工大学 | 一种超声c扫局部缺陷复现的机械手运动控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102226677A (zh) * | 2011-01-26 | 2011-10-26 | 东南大学 | 具有协作关系的多机器人***的基坐标系标定方法 |
CN102662350A (zh) * | 2012-05-31 | 2012-09-12 | 东南大学 | 主从式多机器人协作***的轨迹示教与规划方法 |
CN102721746A (zh) * | 2012-07-04 | 2012-10-10 | 北京理工大学 | 一种双机械手超声透射检测装置 |
CN103322953A (zh) * | 2013-05-22 | 2013-09-25 | 北京配天大富精密机械有限公司 | 工件坐标系的标定方法、装置及工件加工处理方法、装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10300827A1 (de) * | 2003-01-10 | 2004-07-22 | Intelligendt Systems & Services Gmbh & Co Kg | Einrichtung zur Ultraschallprüfung eines Werkstückes in Durchschallungstechnik |
-
2014
- 2014-03-20 CN CN201410103672.5A patent/CN103868996B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102226677A (zh) * | 2011-01-26 | 2011-10-26 | 东南大学 | 具有协作关系的多机器人***的基坐标系标定方法 |
CN102662350A (zh) * | 2012-05-31 | 2012-09-12 | 东南大学 | 主从式多机器人协作***的轨迹示教与规划方法 |
CN102721746A (zh) * | 2012-07-04 | 2012-10-10 | 北京理工大学 | 一种双机械手超声透射检测装置 |
CN103322953A (zh) * | 2013-05-22 | 2013-09-25 | 北京配天大富精密机械有限公司 | 工件坐标系的标定方法、装置及工件加工处理方法、装置 |
Non-Patent Citations (5)
Title |
---|
Base frame calibration for coordinated industrial robots;Gan Yahui,et al.;《Robotics and Autonomous Systems》;20110420;563-570 * |
Cooperative Path Planning and Constraints Analysis for Master-Slave Industrial Robots;Yahui Gan,et al.;《International Journal of Advanced Robotic Systems》;20120706;1-13 * |
Offline motion planning and simulation of two-robot welding coordination;Tie Zhang,et al.;《Frontiers of Mechanical Engineering》;20120306;81-92 * |
多机器人协作无夹具焊接***设计;甘亚辉等;《控制工程》;20130531;第20卷(第3期);397-403 * |
大型曲面复合材料超声检测技术;徐春广等;《纤维复合材料》;20130930;33-38 * |
Also Published As
Publication number | Publication date |
---|---|
CN103868996A (zh) | 2014-06-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103868996B (zh) | 用于无损检测的双机械手工件坐标系自动重合方法 | |
CN106426189B (zh) | 打磨抛光机器人工件夹持的自动纠偏方法 | |
CN104625676B (zh) | 轴孔装配工业机器人***及其工作方法 | |
JP3002097B2 (ja) | ビジュアルトラッキング方法 | |
CN104390612B (zh) | 用于Stewart平台构型的六自由度并联机器人基准位姿标定方法 | |
US9772619B2 (en) | Motor control device | |
CN103901852B (zh) | 一种飞机装配结合面数字化加垫方法 | |
CN102266958B (zh) | 基于制孔设备坐标系确定的柔性导轨孔群加工方法 | |
CN102225516A (zh) | 一种实现夹具***综合误差提取及确定补偿值的方法 | |
CN109397265A (zh) | 一种基于动力学模型的关节型工业机器人拖拽示教方法 | |
CN109848989A (zh) | 一种基于红宝石探针的机器人执行末端自动标定及检测方法 | |
CN104552341A (zh) | 移动工业机器人单点多视角挂表位姿误差检测方法 | |
CN103878770A (zh) | 基于速度估计的空间机器人视觉时延误差补偿方法 | |
Kim et al. | Hole detection algorithm for square peg-in-hole using force-based shape recognition | |
WO2017179452A1 (ja) | アクチュエータ制御システム、アクチュエータ制御方法、情報処理プログラム、および記録媒体 | |
CN112775956A (zh) | 一种机械手awc纠偏***实现方法 | |
JP2013019704A (ja) | 三次元計測システム及び三次元計測方法 | |
CN106097390A (zh) | 一种基于卡尔曼滤波的机器人运动学参数标定方法 | |
CN105814502A (zh) | 轨迹测定装置、数控装置以及轨迹测定方法 | |
CN106584509A (zh) | 并联机器人的原点标定方法 | |
JP2014075050A (ja) | 加工システム、及びその加工方法 | |
CN103832005B (zh) | 在线式瓦楞纸板线原纸架自动对边的方法及对边*** | |
Sun et al. | An online calibration method for six-dimensional force/torque sensor based on shape from motion combined with complex algorithm | |
JP3104839B2 (ja) | ロボット診断方法 | |
JP2020190551A (ja) | 計測システム、計測装置、計測方法、及び計測プログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |