CN112326793B - 基于超声c扫投影视图缺陷再定位的机械手回溯运动方法 - Google Patents
基于超声c扫投影视图缺陷再定位的机械手回溯运动方法 Download PDFInfo
- Publication number
- CN112326793B CN112326793B CN202011220259.9A CN202011220259A CN112326793B CN 112326793 B CN112326793 B CN 112326793B CN 202011220259 A CN202011220259 A CN 202011220259A CN 112326793 B CN112326793 B CN 112326793B
- Authority
- CN
- China
- Prior art keywords
- backtracking
- projection
- ultrasonic
- projection view
- point
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N29/00—Investigating or analysing materials by the use of ultrasonic, sonic or infrasonic waves; Visualisation of the interior of objects by transmitting ultrasonic or sonic waves through the object
- G01N29/04—Analysing solids
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N29/00—Investigating or analysing materials by the use of ultrasonic, sonic or infrasonic waves; Visualisation of the interior of objects by transmitting ultrasonic or sonic waves through the object
- G01N29/22—Details, e.g. general constructional or apparatus details
- G01N29/26—Arrangements for orientation or scanning by relative movement of the head and the sensor
- G01N29/265—Arrangements for orientation or scanning by relative movement of the head and the sensor by moving the sensor relative to a stationary material
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N2291/00—Indexing codes associated with group G01N29/00
- G01N2291/02—Indexing codes associated with the analysed material
- G01N2291/023—Solids
Landscapes
- Physics & Mathematics (AREA)
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Biochemistry (AREA)
- General Health & Medical Sciences (AREA)
- General Physics & Mathematics (AREA)
- Immunology (AREA)
- Pathology (AREA)
- Acoustics & Sound (AREA)
- Investigating Or Analyzing Materials By The Use Of Ultrasonic Waves (AREA)
Abstract
本发明公开了基于超声C扫投影视图缺陷再定位的机械手回溯运动方法。使用本发明能够根据C扫投影视图的缺陷像素点位置匹配对应运动轨迹点包中的运动位姿数据,计算C扫投影视图上当前点到缺陷回溯点像素位置连线间的所有中间像素点位置,并依次与扫查运动轨迹点包的位姿数据匹配生成缺陷回溯运动轨迹点包,利用该点包控制机械手以最优路径回溯到缺陷位置。重复上述过程,可以实现多个缺陷位置的回溯。与沿扫查原路径返回的回溯方法相比较,该方法不仅可以避免回溯运动过程中的碰撞,还可以提高回溯效率。
Description
技术领域
本发明涉及测控自动化技术领域,具体涉及一种基于超声C扫投影视图缺陷再定位的机械手回溯运动方法。
背景技术
将工业领域广泛应用的机械手和超声无损检测技术相结合,可以代替人工实现对复杂构件的精确检测,同时提高检测效率和准确性。在对构件完成扫查运动生成超声C扫图像后,有时需要机械手从当前位置,再次运动到与缺陷对应的某个位置,进行缺陷再定位的回溯运动。为了避免回溯过程中机械手与被检构件碰撞、产生奇异位形等安全隐患,可以控制机械手由当前点按原扫查路径正向或反向运动到缺陷定位点,这样虽然能够有效避免碰撞,但由于扫查过程有多个往复过程,扫查路径较长,效率太低,无法满足安全、准确、高效的检测要求。
另一方面,如果利用机械手控制器内部的直线或圆弧轨迹算法,由当前点运动到缺陷回溯点,可以使回溯路径最短,但又无法避免运动过程中与被检工件产生碰撞的问题。
因此目前缺少一种针对超声C扫过程中在进行缺陷定位时,对机械手控制器的回溯路径优化方案。
发明内容
有鉴于此,本发明提供了一种基于超声C扫投影视图缺陷再定位的机械手回溯运动方法,能够控制机械手以最优路径回溯到定位的缺陷位置。
为达到上述目的,本发明的技术方案包括如下步骤:
S1:对工件进行超声C扫,得到超声C扫图像;超声C扫的扫查运动由工业机械手控制。
S2、构建三维的工件坐标系XYZ,将超声C扫图像分别在XY平面、YZ平面和XZ平面进行投影,得到投影视图;选取超声C扫图像的三个投影视图中,不产生重叠的投影视图A。
S3、在投影视图A中,提取缺陷位置像素点坐标作为目标点,并根据当前像素点坐标,在投影视图A中找到当前像素点至目标点之间的直线线段作为回溯投影线段;取回溯投影线段上所有像素点作为回溯投影点。
S4、根据回溯投影点在投影视图A中的坐标,反投影至超声C扫图像,得到每个回溯投影点在超声C扫图像中对应的轨迹点位姿数据即为回溯轨迹点,将回溯轨迹点按顺序组成回溯路径包。
进一步地,S4中,机械手控制系统根据回溯路径包控制工业机械手进行回溯。
进一步地,将超声C扫图像分别在XY平面、YZ平面和XZ平面进行投影,得到投影视图,具体地:
在XY投影视图中
XY_H=(int)(X-Xmin)×ScanLength/(Xmax-Xmin)
XY_V=(int)(Y-Ymin)×ScanWidth/(Ymax-Ymin)
其中(X,Y)为工件坐标系下机械手工具末端点的X轴和Y轴坐标;XY_H为XY投影视图中真实位置数据对应位图中像素点的横坐标位置,为整型数据;XY_V为XY投影视图中真实位置数据对应位图中像素点的纵坐标位置;ScanLength为画布长度,ScanWidth为画布宽度;Xmin、Ymin、Xmax、Ymax分别是超声C扫图像在工件坐标系下沿X轴和Y轴的最小值和最大值;画布的尺寸根据超声C扫图像的实际大小按比例设定。
进一步地,将超声C扫图像分别在XY平面、YZ平面和XZ平面进行投影,得到投影视图,具体地:
在XZ投影视图中,
XZ_H=(int)(X-Xmin)×ScanLength/(Xmax-Xmin)
XZ_V=(int)(Z-Zmin)×ScanHeight/(Zmax-Zmin)
其中XZ_H为XZ投影视图中真实位置数据对应位图中像素点的横坐标位置,为整型数据;XZ_V为XZ投影视图中真实位置数据对应位图中像素点的纵坐标位置;ScanHeight为画布高度;Zmin、Zmax是超声C扫图像在工件坐标系下沿Z轴的最小值和最大值。
进一步地,将超声C扫图像分别在XY平面、YZ平面和XZ平面进行投影,得到投影视图,具体地:
在YZ投影视图中,
YZ_H=(int)(Y-Ymin)×ScanWidth/(Ymax-Ymin)
YZ_V=(int)(Z-Zmin)×ScanHeight/(Zmax-Zmin)
其中YZ_H为YZ投影视图中真实位置数据对应位图中像素点的横坐标位置,为整型数据;YZ_V为YZ投影视图中真实位置数据对应位图中像素点的纵坐标位置。
进一步地,采用插补算法在回溯投影线段上选取像素点作为回溯投影点。
有益效果:
本发明提出一种基于超声C扫投影视图提取最优定位缺陷回溯路径的方法,克服了机械手沿原扫查路径返回的低效率问题,能够找到当前点至缺陷点的最优路径,并且回溯路径的轨迹点位姿从扫查运动轨迹点包中提取,相邻两个运动点间的位姿变化不大,有效保证了运动的平稳性和避免碰撞。
附图说明
图1为本发明提供的生成最优定位缺陷回溯路径运动轨迹点包流程图;
图2为本发明提供的机械手超声C扫过程及C扫展开图;
图3为本发明提供的超声C扫在XY、YZ和ZX平面的投影视图;
图4为本发明提供的基于超声C扫投影视图的缺陷回溯方法流程图。
具体实施方式
下面结合附图并举实施例,对本发明进行详细描述。
本发明提供了一种基于超声C扫投影视图缺陷再定位的机械手回溯运动方法,该过程如图1所示,包括:
S1:对工件进行超声C扫,得到超声C扫图像;超声C扫的扫查运动由工业机械手控制。具体地,使用机械手进行超声C扫的过程以及得到的超声C扫图像如图2所示。
S2、构建三维的工件坐标系XYZ,将超声C扫图像分别在XY平面、YZ平面和XZ平面进行投影,得到投影视图;选取超声C扫图像的三个投影视图中,不产生重叠的投影视图A。
本发明提供的超声C扫在XY、YZ和ZX平面的投影视图如图3所示。
在XY投影视图中
XY_H=(int)(X-Xmin)×ScanLength/(Xmax-Xmin)
XY_V=(int)(Y-Ymin)×ScanWidth/(Ymax-Ymin)
其中(X,Y)为工件坐标系下机械手工具末端点的X轴和Y轴坐标;XY_H为XY投影视图中真实位置数据对应位图中像素点的横坐标位置,为整型数据;XY_V为XY投影视图中真实位置数据对应位图中像素点的纵坐标位置;ScanLength为画布长度,ScanWidth为画布宽度;Xmin、Ymin、Xmax、Ymax分别是超声C扫图像在工件坐标系下沿X轴和Y轴的最小值和最大值;创建画布大小时,画布的尺寸根据超声C扫图像的实际大小按比例设定。
在XZ投影视图中,
XZ_H=(int)(X-Xmin)×ScanLength/(Xmax-Xmin)
XZ_V=(int)(Z-Zmin)×ScanHeight/(Zmax-Zmin)
其中XZ_H为XZ投影视图中真实位置数据对应位图中像素点的横坐标位置,为整型数据;XZ_V为XZ投影视图中真实位置数据对应位图中像素点的纵坐标位置;ScanHeight为画布高度;Zmin、Zmax是超声C扫图像在工件坐标系下沿Z轴的最小值和最大值。
在YZ投影视图中,
YZ_H=(int)(Y-Ymin)×ScanWidth/(Ymax-Ymin)
YZ_V=(int)(Z-Zmin)×ScanHeight/(Zmax-Zmin)
其中YZ_H为YZ投影视图中真实位置数据对应位图中像素点的横坐标位置,为整型数据;YZ_V为YZ投影视图中真实位置数据对应位图中像素点的纵坐标位置。
参见图2,该图为本实施例提供的超声C扫在XY、YZ和ZX平面的投影视图,当扫查曲面在投影平面上的视图不发生重叠时,投影视图上的任一点都与扫查曲面上的点一一对应;当扫查曲面在投影平面上的视图发生重叠时(如图3中,扫查曲面与投影平面YZ垂直,因此YZ平面投影视图重叠为一条曲线),曲线上的任一点都对应扫查曲面的多个点,这样就无法从扫查轨迹点包中唯一地匹配出缺陷定位点对应的位姿。因此,缺陷定位回溯时,应选择未发生重叠的投影视图,如XY或ZX平面的投影视图。
为了在C扫视图上表征缺陷的真实位置信息,需要在超声扫查过程中同步采集机械手工具末端点位置信息和超声A扫峰值信息。基于位置和峰值绘制位图时,应根据采集的位置信息绘制到对应的像素位置。
S3、在投影视图A中,提取缺陷位置像素点坐标作为目标点,并根据当前像素点坐标,在投影视图A中找到当前像素点至目标点之间的直线线段作为回溯投影线段;在取回溯投影线段上选取像素点作为回溯投影点。
本发明实施例中,回溯投影点的选取可以采用插补算法选取,具体地在回溯投影线段上按照一定间隔选取几个小数点作为回溯投影点即可,选取间隔可以根据实际情况设定。
S4、根据回溯投影点在投影视图A中的坐标,反投影至超声C扫图像,得到每个回溯投影点在超声C扫图像中对应的位姿数据即为回溯轨迹点,将回溯轨迹点按顺序组成回溯路径包,机械手控制系统根据回溯路径包控制工业机械手进行回溯。
提取像素点对应的位置数据后,需要在超声C扫图像对应的机械手的运动轨迹点包中匹配位置数据。
从运动轨迹点包中匹配位姿数据,是根据位置数据遍历计算运动轨迹点包中的所有运动轨迹点的位置与其的距离,选择距离最小的一组位姿数据作为当前像素位置点匹配的运动轨迹点位姿,由此可以得到超声C扫投影视图上最优定位缺陷回溯路径运动轨迹点包,将回溯运动轨迹点包传输到机械手控制器中,完成回溯运动的轨迹规划。
上位机将运动参数(标定工件坐标系三点坐标frm_ori、frm_x、frm_y,工具值tTool和关节角参数jConfig)下载到机械手控制器中,完成运动参数配置。
需要说明的是,回溯运动轨迹点包中读取的基于工件坐标系的位姿数据,因此,机械手在回溯运动前需要配置运动参数,才能将回溯运动轨迹点通过内部逆解算法转换为机械手关节角数据驱动各个关节轴的运动。
完成一次回溯运动后,下位机清空运动缓冲区。上位机可以继续生成下一个回溯点的运动轨迹点包,并下载到机械手控制器中,开始下一个回溯运动;具体循环过程如图4所示。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.基于超声C扫投影视图缺陷再定位的机械手回溯运动方法,其特征在于,包括:
S1:对工件进行超声C扫,得到超声C扫图像;所述超声C扫的扫查运动由工业机械手控制;
S2、构建三维的工件坐标系XYZ,将超声C扫图像分别在XY平面、YZ平面和XZ平面进行投影,得到投影视图;选取超声C扫图像的三个投影视图中,不产生重叠的投影视图A;
S3、在投影视图A中,提取缺陷位置像素点坐标作为目标点,并根据当前像素点坐标,在投影视图A中找到当前像素点至目标点之间的直线线段作为回溯投影线段;在所述回溯投影线段上选取像素点作为回溯投影点;
S4、根据所述回溯投影点在投影视图A中的坐标,反投影至所述超声C扫图像,得到每个回溯投影点在所述超声C扫图像中对应的轨迹点位姿数据即为回溯轨迹点,将回溯轨迹点按顺序组成回溯路径包。
2.如权利要求1所述的方法,其特征在于,所述S4中,机械手控制系统根据所述回溯路径包控制所述工业机械手进行回溯。
3.如权利要求1所述的方法,其特征在于,所述将超声C扫图像分别在XY平面、YZ平面和XZ平面进行投影,得到投影视图:
在XY投影视图中
XY_H=(int)(X-Xmin)×ScanLength/(Xmax-Xmin)
XY_V=(int)(Y-Ymin)×ScanWidth/(Ymax-Ymin)
其中(X,Y)为工件坐标系下机械手工具末端点的X轴和Y轴坐标;XY_H为XY投影视图中真实位置数据对应位图中像素点的横坐标位置,为整型数据;XY_V为XY投影视图中真实位置数据对应位图中像素点的纵坐标位置;ScanLength为画布长度,ScanWidth为画布宽度;Xmin、Ymin、Xmax、Ymax分别是超声C扫图像在工件坐标系下沿X轴和Y轴的最小值和最大值;画布的尺寸根据超声C扫图像的实际大小按比例设定。
4.如权利要求3所述的方法,其特征在于,所述将超声C扫图像分别在XY平面、YZ平面和XZ平面进行投影,得到投影视图:
在XZ投影视图中,
XZ_H=(int)(X-Xmin)×ScanLength/(Xmax-Xmin)
XZ_V=(int)(Z-Zmin)×ScanHeight/(Zmax-Zmin)
其中XZ_H为XZ投影视图中真实位置数据对应位图中像素点的横坐标位置,为整型数据;XZ_V为XZ投影视图中真实位置数据对应位图中像素点的纵坐标位置;ScanHeight为画布高度;Zmin、Zmax是超声C扫图像在工件坐标系下沿Z轴的最小值和最大值。
5.如权利要求4所述的方法,其特征在于,所述将超声C扫图像分别在XY平面、YZ平面和XZ平面进行投影,得到投影视图:
在YZ投影视图中,
YZ_H=(int)(Y-Ymin)×ScanWidth/(Ymax-Ymin)
YZ_V=(int)(Z-Zmin)×ScanHeight/(Zmax-Zmin)
其中YZ_H为YZ投影视图中真实位置数据对应位图中像素点的横坐标位置,为整型数据;YZ_V为YZ投影视图中真实位置数据对应位图中像素点的纵坐标位置。
6.如权利要求1~5任一所述的方法,其特征在于,在所述回溯投影线段上选取像素点作为回溯投影点:
采用插补算法在所述回溯投影线段上选取像素点作为回溯投影点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011220259.9A CN112326793B (zh) | 2020-11-05 | 2020-11-05 | 基于超声c扫投影视图缺陷再定位的机械手回溯运动方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011220259.9A CN112326793B (zh) | 2020-11-05 | 2020-11-05 | 基于超声c扫投影视图缺陷再定位的机械手回溯运动方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112326793A CN112326793A (zh) | 2021-02-05 |
CN112326793B true CN112326793B (zh) | 2021-09-07 |
Family
ID=74315673
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011220259.9A Active CN112326793B (zh) | 2020-11-05 | 2020-11-05 | 基于超声c扫投影视图缺陷再定位的机械手回溯运动方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112326793B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114384152B (zh) * | 2022-01-13 | 2023-09-01 | 山东大学 | 基于搜索点匹配的超声导波损伤定位方法及系统 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107462638A (zh) * | 2017-08-10 | 2017-12-12 | 兰州理工大学 | 基于超声a扫信号的缺陷三维重建方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10259653B3 (de) * | 2002-12-18 | 2004-04-29 | Eurocopter Deutschland Gmbh | Verfahren und Vorrichtung zur zerstörungsfreien Ultraschall-Werkstoffprüfung |
CN102818851B (zh) * | 2011-06-10 | 2015-02-25 | 中国商用飞机有限责任公司 | 对l形工件的弧形角部进行超声检测的检测方法 |
CN102721746A (zh) * | 2012-07-04 | 2012-10-10 | 北京理工大学 | 一种双机械手超声透射检测装置 |
CN105425830B (zh) * | 2015-11-24 | 2018-03-16 | 北京邮电大学 | 一种空间机械臂的任务规划方法及系统 |
CN105467011A (zh) * | 2015-12-09 | 2016-04-06 | 上海复合材料科技有限公司 | 一种超声c扫描检测中缺陷位置精确定位方法 |
CN109283253A (zh) * | 2018-11-28 | 2019-01-29 | 燕山大学 | 一种基于超声原理轻质陶瓷基多孔复合材料缺陷检测方法 |
CN110774284B (zh) * | 2019-10-31 | 2021-12-17 | 广州富港万嘉智能科技有限公司 | 机械手运动实时位置探测方法、计算机可读存储介质及带机械手的设备 |
CN211179655U (zh) * | 2019-12-02 | 2020-08-04 | 关键智慧(北京)科技有限公司 | 超声检测与成像系统 |
-
2020
- 2020-11-05 CN CN202011220259.9A patent/CN112326793B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107462638A (zh) * | 2017-08-10 | 2017-12-12 | 兰州理工大学 | 基于超声a扫信号的缺陷三维重建方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112326793A (zh) | 2021-02-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114289934B (zh) | 一种基于三维视觉的大型结构件自动化焊接系统及方法 | |
JP7333821B2 (ja) | 改善されたツーリング経路生成を伴う産業ロボット装置、及び改善されたツーリング経路に従って産業ロボット装置を動作させる方法 | |
CN112958959A (zh) | 一种基于三维视觉的自动化焊接和检测方法 | |
CN111014879A (zh) | 一种基于激光焊缝跟踪的机器人波纹板自动焊接方法 | |
US11801606B2 (en) | Autonomous welding robots | |
CN112847353A (zh) | 一种基于离线编程软件的多段焊缝轨迹修正方法 | |
CN114161048A (zh) | 一种基于3d视觉的铁塔塔脚参数化焊接方法及装置 | |
CN113246142B (zh) | 一种基于激光引导的测量路径规划方法 | |
CN112326793B (zh) | 基于超声c扫投影视图缺陷再定位的机械手回溯运动方法 | |
CN112958974A (zh) | 一种基于三维视觉的可交互自动化焊接系统 | |
CN117381788A (zh) | 一种复合机器人高精度定位与智能作业引导方法 | |
CN117047237B (zh) | 一种异形件智能柔性焊接系统与方法 | |
Mineo et al. | Robotic path planning for non-destructive testing of complex shaped surfaces | |
Borangiu et al. | Robot arms with 3D vision capabilities | |
Yu et al. | Multiseam tracking with a portable robotic welding system in unstructured environments | |
Chalus et al. | Calibration and using a laser profile scanner for 3D robotic welding | |
JP2023069373A (ja) | マーカ検出装置及びロボット教示システム | |
US10955237B2 (en) | Measurement method and measurement apparatus for capturing the surface topology of a workpiece | |
CN116571852B (zh) | 一种机器人螺柱自动焊接方法和系统 | |
CN118269121A (zh) | 一种机器人在曲屏管道销钉自动焊接方法 | |
CN113427160A (zh) | 一种焊接机械臂自适应焊接方法、系统、设备及存储介质 | |
CN117921670A (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 |