CN104237380A - 复杂构件机械手扫查位姿的四元数转换方法 - Google Patents
复杂构件机械手扫查位姿的四元数转换方法 Download PDFInfo
- Publication number
- CN104237380A CN104237380A CN201410529261.2A CN201410529261A CN104237380A CN 104237380 A CN104237380 A CN 104237380A CN 201410529261 A CN201410529261 A CN 201410529261A CN 104237380 A CN104237380 A CN 104237380A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- hypercomplex number
- point
- component
- ultrasonic
- 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.)
- Granted
Links
Landscapes
- Investigating Or Analyzing Materials By The Use Of Ultrasonic Waves (AREA)
Abstract
本发明提出一种实现复杂构件扫查成像检测的机械手位姿转换的方法:对五轴数控加工生成的数控代码进行后置处理,采用四元数法代替矩阵和欧拉角描述六自由度机械手末端执行器空间超声检测的位姿;针对复杂型面工件的专用性和特殊性,本发明采用水浸式超声检测,将探头固定于水槽中,机械手夹持被测工件相对超声探头进行复杂空间运动,进而对其实现超声无损检测。这种机械手位姿转换方法可有效地完成机械手超声扫查的后置处理,旋转变换计算更加简洁、方便。
Description
一、技术领域
本发明提出一种复杂构件机械手扫查位姿的四元数转换方法,该方法运用于机械手的位姿转换,可有效地完成机械手超声扫查的后置处理过程,旋转变换计算更加简洁、方便。
二、背景技术
在工程实践中,复杂型面构件的可靠性与其内部结构紧密相关,其内部结构复杂,超声传播规律复杂,人工检测的难度大、效率低,其内部缺陷的无损检测一直是探伤技术领域的难题。
超声检测是相当有效的一种检测手段,可以比较精确地检测出被测构件内部的缺陷。目前,有一种自动检测的方法可以有效解决人工检测带来的问题:采用水浸式检测方法,把水作为耦合剂,将超声探头固定在水槽中,六自由度机械手握持被测构件在水槽中相对探头进行复杂空间运动,采用超声扫查方法对被测构件内部缺陷进行检测。
然而这种方法存在的问题是,在超声扫查的过程中,需要对被测构件CAD数据模型进行轨迹规划,但是数控软件得到的刀位数据并不能被机械手利用,需要对其进行后置处理。在笛卡尔坐标系中,被测构件在坐标系下的位姿由三个位置自由度和三个姿态自由度组成。后置处理的任务就是对CAM系统所提供的工件坐标系下的刀位数据进行处理,转换为机械手末端执行器的位置坐标及相应的回转角度。
常用的坐标转换方法有欧拉角法、旋转矩阵法和四元数法。欧拉角旋转时某些情况下可能导致的自由度丧失,即所谓的“万向节锁”现象。用旋转矩阵法需要9个参数,计算繁琐且耗时。经万方数据库检索,文献(肖文磊,等.切削加工机器人与CAD/CAM系统集成化[J].机械工程学报,2011)公开了一种将G代码进行坐标转换的方法,但该方法只适用于机械手夹持刀具相对被测构件运动的情况。对上述描述的探头固定,机械手夹持被测构件相对探头进行检测这种情况不适用。
由于运用欧拉角法或旋转矩阵法对被测构件进行旋转时,需要得到已知的被测点的自身坐标系才能完成坐标转换,而CAM软件五轴加工生成的刀位文件只有被测点在自身坐标系中的位置和法线矢量,缺少被测点的方位矢量和接近矢量,不方便在被测点建立局部坐标系,继而进行坐标转换。另一方面,对复杂型面进行超声扫查检测过程中,我们需要保证被测构件的各个扫查点的表面法线方向与超声换能器的轴线方向一致,即保证构件被测点旋转到超声换能器位置时候,法线矢量zg与换能器法线方向n一致。这样一来,坐标转换就有了一定的困难。
1843年,爱尔兰数学家哈密顿(Hamilton)发明了四元数。1985年,Shoemake将其引入计算机图形学领域。从此四元数在计算机图形学、计算机动画、计算机视觉和虚拟实现等领域得到了广泛运用。经文献检索发现,文献(谢荣,鲁海燕.基于四元数的船舶运动姿态仿真研究[J].中国造船,2011)采用四元数方法对运动船舶模型的三维姿态及其旋转进行了描述,但不是针对机械手位姿转换的。
为解决以上的问题,本文提出了一种采用四元数对五轴数控加工生成的数控代码进行后置处理,继而来描述六自由度机械手夹持被测构件相对探头运动过程中末端执行器空间超声检测的位姿,实现机械手超声扫查的位姿转换的方法,这是一种全新的方法,具有广泛的应用前景。
三、发明内容
本发明的目的是提供一种用于机械手夹持被测构件相对探头运动过程中机械手的位姿转换方法。该方法可解决欧拉角或矩阵法难以实现的坐标转换问题,可以实现复杂型面超声扫查的机械手位姿转换。
本发明的目的是这样实现的:
步骤1:求四元数q。超声探头自身坐标系为MX1Y1Z1(∑1)(M表示坐标原点,X1表示X轴。Y1表示Y轴,Z1表示Z轴,为简便说明,我们把上述坐标系用(∑1)表示),同理,被测工件坐标系为OX2Y2Z2(∑2)(O表示坐标原点,X2表示X轴。Y2表示Y轴,Z2表示Z轴,为简便说明,我们把上述坐标系用(∑2)表示;同时,令被测构件坐标系与机械手末端执行器坐标系重合)。已知被测构件在∑2坐标系下某一点A的点位信息A(x,y,z,Tx,Ty,Tz)(前三个参数(x,y,z)表示被测点的位置坐标,后三个参数(Tx,Ty,Tz)表示该点的法线矢量),设构件坐标系∑2原点O的点位信息为O(0,0,0,0,0,-1),其中,前3个参数表示原点位置(0,0,0),后3个参数表示原点沿Z轴反方向一单位长度的法线矢量(0,0,-1);同理,设∑1坐标系原点M的点位信息为M(0,0,0,0,0,-1)。
通过四元数法获得要使被测点A的法线矢量(Tx,Ty,Tz)旋转到与点M的法线矢量(0,0,-1)同向的四元数q(q0,q1,q2,q3);在确定了四元数q后,接下来需要对构件所有被测点的位置进行四元数q旋转变换。此时,A点变为A′=(x,y,z,Tx′,Ty′,Tz′),O点变为O′(0,0,0,T′Ox,T′Oy,T′Oz)。
步骤2:求平移向量p。计算出旋转后的被测点A′到点M的距离p=(-x′,-y′,-z′)。将构件位移p。此时,位移后的O″距离M的距离为p0=(px,py,pz)=O″+p。
步骤3:求机械手输入参数。将上述的四元数q通过四元数与欧拉角的转换公式变换为机械手需要的欧拉角(α,β,γ)。这样,我们就得到了机械手夹持被测构件时,被测点A到达探头坐标原点M时候机械手的六个参数(px,py,pz,α,β,γ)。
本发明的优点在于:被测构件相对探头运动,运用四元数方法对NC代码进行后置处理,保证被测工件每个被测点上的法线矢量zg依次旋转到与探头法线方向n一致,可以有效解决CAM软件得到不完整所需数据继而难以进行坐标转换这个问题。这种方法适用于复杂型面超声扫查的机械手位姿转换,旋转变换计算更加简洁、方便。
四、附图说明
图1被测构件与超声探头在世界坐标系O0X0Y0Z0下的坐标转换关系图
图2机械手位姿的转换过程
图3水浸式超声脉冲反射法被测构件检测示意图
五、具体实施方式
下面对本发明的具体实施方式进行详细说明:
被测构件与探头的相对运动可以看成两个刚体的一般运动,可以通过绕某个轴的旋转和沿该轴的平移实现。用四元数表示空间的旋转q;当考虑平移部分时,可设平移向量为p,这样就由四元数旋转q与平移向量p构成了被测构件的整个变换过程。表达式为:
pB=qpAq-1+p (1)
其中,pA为坐标转换前的值,pB为坐标转换后的值。
被测构件与超声探头在世界坐标系O0X0Y0Z0下的坐标转换关系,为简便介绍该方法,我们将被测构件简化成一刚体,如图1。设探头形心点的自身坐标系为用户坐标系MX1Y1Z1;被测构件自身坐标系与机械手末端执行器的坐标系重合,为OX2Y2Z2;被测构件上任一被测点A处的坐标系为OgXgYgZg。
步骤1:求四元数q。见图2(a),超声探头自身坐标系为MX1Y1Z1(∑1)(M表示坐标原点,X1表示X轴。Y1表示Y轴,Z1表示Z轴,为简便说明,我们把上述坐标系用(∑1)表示),同理,被测工件坐标系为OX2Y2Z2(∑2)(O表示坐标原点,X2表示X轴。Y2表示Y轴,Z2表示Z轴,为简便说明,我们把上述坐标系用(∑2)表示;同时,令被测构件坐标系与机械手末端执行器坐标系重合)。已知被测构件在∑2坐标系下某一点A的点位信息A(x,y,z,Tx,Ty,Tz)(前三个参数(x,y,z)表示被测点的位置坐标,后三个参数(Tx,Ty,Tz)表示该点的法线矢量),设构件坐标系∑2原点O的点位信息为O(0,0,0,0,0,-1),其中,前3个参数表示原点位置(0,0,0),后3个参数表示原点沿Z轴反方向一单位长度的法线矢量(0,0,-1);同理,设∑1坐标系原点M的点位信息为M(0,0,0,0,0,-1)。
通过四元数法获得要使被测点A的法线矢量(Tx,Ty,Tz)旋转到与点M的法线矢量(0,0,-1)同向的四元数q(q0,q1,q2,q3);在确定了四元数q后,接下来需要对刚体所有被测点位置进行式(3)四元数q旋转变换,即得到图2(b)。此时,A点变为A′=(x,y,z,Tx′,Ty′,Tz′),O点变为O′(0,0,0,T′Ox,T′Oy,T′Oz)。
步骤2:求平移向量p。计算出旋转后的被测点A′到点M的距离p=(-x′,-y′,-z′)。将被测构件位移p,即得到图2(c)。此时,位移后的O″距离M的距离为p0=(px,py,pz)=O″+p。
步骤3:求机械手输入参数。将上述的四元数q通过四元数与欧拉角的转换公式变换为机械手需要的欧拉角(α,β,γ)。这样,我们就得到了机械手夹持被测构件时,被测点A到达探头坐标原点M时候机械手的六个参数(px,py,pz,α,β,γ)。
本发明采用水浸式脉冲反射法对复杂型面缺陷进行超声检测,见图3。
由超声检测原理知,检测时超声束沿着被测构件表面法向入射最优。扫查时一方面要保证超声换能器与被测构件表面等距(该间距称作水声距),另一方面要保证在各个扫查点超声换能器的轴线n与被测构件的表面法线方向zg一致。利用四元数法将CAM软件得到的被测构件每个被测点上的法线矢量zg依次旋转到与探头法线方向n一致,实现对复杂型面超声扫查的机械手位姿转换。
保证被测构件位置数据与超声检测数据对应性的实施方式。在对被测构件进行检测的过程中,为了有效、准确、真实地表达被检构件各个部位的缺陷情况,要保证机械手的运动位置与超声换能器的检测信号采集的对应性。本发明采用的方法是,在运用四元数法对被测构件的点位信息进行坐标转换后,实时传输给机械手,机械手严格按照指定的坐标变换来运动,保证被测构件位置数据与超声检测信号数据的对应性。
Claims (4)
1.复杂构件机械手扫查位姿的四元数转换方法,其特征在于:
步骤1:求四元数q。超声探头自身坐标系为MX1Y1Z1(Σ1),被测工件坐标系为OX2Y2Z2(Σ2)(令被测构件坐标系与机械手末端执行器坐标系重合)。已知被测构件在Σ2坐标系下某一点A的点位信息A(x,y,z,Tx,Ty,Tz),设构件坐标系Σ2原点O的点位信息为O(0,0,0,0,0,-1),其中,前3个参数表示原点位置(0,0,0),后3个参数表示原点沿Z轴反方向一单位长度的法线矢量(0,0,-1);同理,设Σ1坐标系原点M的点位信息为M(0,0,0,0,0,-1)。
通过四元数法获得要使被测点A的法线矢量(Tx,Ty,Tz)旋转到与点M的法线矢量(0,0,-1)同向的四元数q(q0,q1,q2,q3);在确定了四元数q后,接下来需要对构件所有被测点的位置进行四元数q旋转变换。此时,A点变为A'=(x,y,z,Tx',Ty',Tz'),O点变为O'(0,0,0,T'Ox,T'Oy,T'Oz)。
步骤2:求平移向量p。计算出旋转后的被测点A'到点M的距离p=(-x',-y',-z')。将构件位移p。此时,位移后的O″距离M的距离为p0=(px,py,pz)=O″+p。
步骤3:求机械手输入参数。将上述的四元数q通过四元数与欧拉角的转换公式变换为机械手需要的欧拉角(α,β,γ)。这样,我们就得到了机械手夹持被测构件时,被测点A到达探头坐标原点M时候机械手的六个参数(px,py,pz,α,β,γ)。
2.根据权利要求1所述的复杂构件机械手扫查位姿的四元数转换方法,其特征在于:被测构件相对探头运动,运用四元数方法对数控代码进行后置处理,保证被测工件每个被测点上的法线矢量zg依次旋转到与探头法线方向n一致,可以有效解决CAM软件得到不完整所需数据继而难以进行坐标转换这个问题。
3.根据权利要求1所述的复杂构件机械手扫查位姿的四元数转换方法,其特征在于:采用水浸式脉冲反射法对复杂型面内部缺陷进行超声检测,被测构件相对固定探头做空间运动。
4.根据权利要求1和3所述的复杂构件机械手扫查位姿的四元数转换方法,其特征在于:在运用四元数法对被测构件的点位信息进行坐标转换后,实时传输给机械手,机械手严格按照指定的坐标变换来运动,保证叶片位置数据与超声检测信号数据的对应性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410529261.2A CN104237380B (zh) | 2014-10-10 | 2014-10-10 | 复杂构件机械手扫查位姿的四元数转换方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410529261.2A CN104237380B (zh) | 2014-10-10 | 2014-10-10 | 复杂构件机械手扫查位姿的四元数转换方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104237380A true CN104237380A (zh) | 2014-12-24 |
CN104237380B CN104237380B (zh) | 2017-01-18 |
Family
ID=52225875
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410529261.2A Active CN104237380B (zh) | 2014-10-10 | 2014-10-10 | 复杂构件机械手扫查位姿的四元数转换方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104237380B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105699487A (zh) * | 2016-03-09 | 2016-06-22 | 北京理工大学 | 复杂构件残余应力的机械手检测装置及方法 |
JP7449604B2 (ja) | 2020-04-27 | 2024-03-14 | シングパイロット プライベート リミテッド | 自律マシン及びこれを制御する方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008310767A (ja) * | 2007-06-18 | 2008-12-25 | Toyota Central R&D Labs Inc | 姿勢信号演算装置 |
JP2011220825A (ja) * | 2010-04-09 | 2011-11-04 | Toyota Motor Corp | 姿勢推定装置及び方法、姿勢制御装置及び方法、並びにプログラム |
CN102620656A (zh) * | 2012-04-16 | 2012-08-01 | 南京航空航天大学 | 一种航天器交会对接相对位姿测量方法 |
CN102794763A (zh) * | 2012-08-31 | 2012-11-28 | 江南大学 | 基于线结构光视觉传感器引导的焊接机器人系统标定方法 |
CN103673882A (zh) * | 2012-12-27 | 2014-03-26 | 广州市地下铁道总公司 | 一种三维空间坐标寻迹方法及其数据采集装置 |
JP5456557B2 (ja) * | 2010-04-26 | 2014-04-02 | 本田技研工業株式会社 | ロボット、制御システムおよび制御プログラム |
CN103955939A (zh) * | 2014-05-16 | 2014-07-30 | 重庆理工大学 | 三维扫描系统中点云拼接用边界特征点配准方法 |
-
2014
- 2014-10-10 CN CN201410529261.2A patent/CN104237380B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008310767A (ja) * | 2007-06-18 | 2008-12-25 | Toyota Central R&D Labs Inc | 姿勢信号演算装置 |
JP2011220825A (ja) * | 2010-04-09 | 2011-11-04 | Toyota Motor Corp | 姿勢推定装置及び方法、姿勢制御装置及び方法、並びにプログラム |
JP5456557B2 (ja) * | 2010-04-26 | 2014-04-02 | 本田技研工業株式会社 | ロボット、制御システムおよび制御プログラム |
CN102620656A (zh) * | 2012-04-16 | 2012-08-01 | 南京航空航天大学 | 一种航天器交会对接相对位姿测量方法 |
CN102794763A (zh) * | 2012-08-31 | 2012-11-28 | 江南大学 | 基于线结构光视觉传感器引导的焊接机器人系统标定方法 |
CN103673882A (zh) * | 2012-12-27 | 2014-03-26 | 广州市地下铁道总公司 | 一种三维空间坐标寻迹方法及其数据采集装置 |
CN103955939A (zh) * | 2014-05-16 | 2014-07-30 | 重庆理工大学 | 三维扫描系统中点云拼接用边界特征点配准方法 |
Non-Patent Citations (4)
Title |
---|
D.GRIVON, E.VEZZETTI,MARIA GRAZIA VIOLANTE: "Development of an innovative low-cost MARG sensors alignment and distortion compensation methodology for 3D scanning applications", 《ROBOTICS AND AUTONOMOUS SYSTEMS》 * |
张劲夫,蔡泰信: "对偶四元数及其在刚体定位中的应用", 《黄淮学刊》 * |
张帆,曹喜滨,邹经湘: "一种新的全角度四元数与欧拉角的转换算法", 《南京理工大学学报》 * |
李克昭,袁建平,岳晓奎: "空间飞行器特征提取与相对定姿研究进展", 《自然科学进展》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105699487A (zh) * | 2016-03-09 | 2016-06-22 | 北京理工大学 | 复杂构件残余应力的机械手检测装置及方法 |
JP7449604B2 (ja) | 2020-04-27 | 2024-03-14 | シングパイロット プライベート リミテッド | 自律マシン及びこれを制御する方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104237380B (zh) | 2017-01-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Mineo et al. | Robotic path planning for non-destructive testing–A custom MATLAB toolbox approach | |
Joubair et al. | Kinematic calibration of a six-axis serial robot using distance and sphere constraints | |
CN108982664B (zh) | 一种双机械手超声检测方法 | |
Cai et al. | Easy industrial robot cell coordinates calibration with touch panel | |
Liu et al. | Optimal path planning for automated dimensional inspection of free-form surfaces | |
CN108469785B (zh) | 一种基于隐函数的五轴加工复杂曲面碰撞检测方法 | |
Cai et al. | Real-time collision-free grasp pose detection with geometry-aware refinement using high-resolution volume | |
Lu et al. | Automatic method for synchronizing workpiece frames in twin-robot nondestructive testing system | |
Heo et al. | Computer-aided measurement plan for an impeller on a coordinate measurement machine with a rotating and tilting probe | |
CN104237380A (zh) | 复杂构件机械手扫查位姿的四元数转换方法 | |
Wang et al. | Optimal robot-world and hand-eye calibration with rotation and translation coupling | |
CN102778510A (zh) | 变壁厚零件超声透射检测方法 | |
Guo et al. | A tool centre point calibration method of a dual-robot NDT system for semi-enclosed workpiece testing | |
Riise et al. | Adapting robot paths for automated NDT of complex structures using ultrasonic alignment | |
Cooper et al. | Development of a fast inspection system for aerospace composite materials-the IntACom project | |
CN112325804A (zh) | 基于激光跟踪仪的机器人装配误差检测方法 | |
Chen et al. | A Point Cloud‐Based Feature Recognition and Path Planning Method | |
Lalithakumari et al. | Development of Algorithm for Precise Movement Controller for Robotic Arm | |
Khan et al. | Introducing adaptive vision-guided robotic non-destructive inspection | |
Vitalli et al. | Mathematical Modeling of Digital Twins and Industry 4.0 Technologies for Measuring Pipe Wall Thickness at Angra 1 Nuclear Power Plant | |
Yang et al. | A kinematic calibration method of a 3-DOF secondary mirror of the giant magellan telescope based on least square algorithm | |
Gueta et al. | Multiple-goal task realization utilizing redundant degrees of freedom of task and tool attachment optimization | |
Liu et al. | A calibration method of workpiece frames for ultrasonic testing using twin-robot | |
Yang et al. | Correction of Workpiece Frame for Robot-Assisted Ultrasonic Nondestructive Testing | |
Duan et al. | A Manipulator Pose Planning Algorithm Based on Matrix Information Geometry |
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 |