一种近似圆柱工件内壁焊缝三维识别定位方法
本发明属于计算机视觉领域,具体说是一种近似圆柱工件内壁焊缝三维识别定位方法。
背景技术:
1、随着我国科学技术的快速发展和工业自动化水平的不断提高,智能化、柔性化生产逐渐成为未来的趋势。机器视觉作为机器的“眼睛”,对提高系统鲁棒性和灵活性有着重要作用,因此得到了广泛的关注和应用。结构光作为一种高精度主动式的3d视觉,比传统2d视觉多了高度信息,可以应对更多的应用场景。在机器人搬运、涂胶、打磨等项目中,结构光得到了大量应用。
2、结构光测量方法是一种主动式光学测量技术,其基本原理是通过结构光投射器向被测物体表面投射可控制光点、光条或光面结构,并由图像传感器(例如摄像机)获得图像,然后通过系统几何关系,利用三角原理计算得到物体的三维坐标。根据结构光投射器向被测物体表面投射可控制的光点、光条或光面结构,结构光可分为点结构光、线结构光和面结构光。由于近似圆柱工件打磨应用中结构光设备的主要作用是在整个工件表面定位焊缝,而点结构光测量方法需要逐点扫描工件内壁表面,图像摄取和图像处理时间过长;面结构光一次拍摄一个矩形视场,对于近似圆柱形状的工件存在拼接困难、工作距离变化大的问题。因此,线结构光成为近似圆柱形工件内表面焊缝测量应用中的首选。
3、现有线结构光焊缝测量方法往往通过拟合平面再提取高于平面一定阈值的点来提取凸起焊缝,对大型平面工件效果较好。但由于近似圆柱形工件内壁表面为曲面,且焊缝凸起小、形态不一,一般的焊缝识别定位方法很难识别和定位到大曲面上的小凸起焊缝。
技术实现思路
1、为解决在近似圆柱工件的大曲面内壁上对形态各异的小凸起焊缝识别定位困难的问题,本发明提供一种近似圆柱工件内壁焊缝三维识别定位方法,可以自动提取工件内壁不同形态焊缝的三维坐标,系统柔性好。
2、本发明为实现上述目的所采用的技术方案是:
3、一方面,本发明提供一种近似圆柱工件内壁焊缝三维识别定位方法,包括以下步骤:
4、步骤1:获取近似圆柱工件内壁表面点云数据,并将工件内壁表面点云数据根据标定关系逐帧变换到机械臂基座坐标系下,得到机械臂基座坐标系下的工件内壁表面点云数据;
5、步骤2:基于机械臂基座坐标系下的工件内壁表面点云数据,提取凸起的焊缝种子点集;
6、步骤3:对焊缝种子点集进行滤波与形态修补获得完整焊缝点集;
7、步骤4:对完整焊缝点集的每个连通区域提取骨架并去除毛刺,通过像素索引映射获得骨架每点三维坐标,完成焊缝轨迹识别定位。
8、进一步地,将工件内壁表面点云数据根据标定关系逐帧变换到机械臂基座坐标系下,得到机械臂基座坐标系下的工件内壁表面点云数据,具体步骤如下:
9、步骤s1:确定第i帧工件内壁表面点云数据相对于第0帧工件内壁表面点云数据的角度差,具体计算公式为:
10、;
11、式中,为第i帧工件内壁表面点云数据相对于第0帧工件内壁表面点云数据的角度差,为机械臂末端旋转角速度,为线结构光采集帧率;
12、步骤s2:基于第i帧工件内壁表面点云数据相对于第0帧工件内壁表面点云数据的角度差,确定第i帧工件内壁表面点云数据相对于第0帧工件内壁表面点云数据的变换矩阵;
13、步骤s3:基于标定关系和步骤s2得到的变化矩阵,得到机械臂基座坐标系下的工件内壁表面点云数据,具体计算公式为:
14、;
15、式中,为第i帧工件内壁表面点云数据机械臂基座坐标系下的坐标,为第i帧工件内壁表面点云数据线结构相机坐标系坐标,为初始扫描时,机械臂末端法兰坐标系在机械臂基座系下的位姿,为标定得到的线结构光相机坐标系相对于机械臂末端法兰坐标系下的变换矩阵。
16、进一步地,所述步骤2中,基于机械臂基座坐标系下的工件内壁表面点云数据,提取凸起的焊缝种子点集的具体方法为:
17、遍历机械臂基座坐标系下的工件内壁表面点云数据,以数据点为中心截取邻域窗口,确定邻域窗口内无效点的个数,若无效点的个数占比大于第一设定阈值,则该数据点不能加入焊缝种子点集,若无效点的个数占比小于等于第一设定阈值,对邻域窗口使用ransac算法拟合局部邻域平面,并进一步确定局部邻域平面的参数,使局部邻域平面的正向法向量朝向工件中心一侧,基于确定后的局部邻域平面的参数确定该平面对应的邻域窗口的中心数据点到其局部邻域平面的有向距离,当有向距离为正值且大于第二设定阈值,则该数据点加入焊缝种子点集。
18、进一步地,对邻域窗口使用ransac算法拟合局部邻域平面的具体方法为:
19、步骤a1:从邻域窗口中随机选择三个数据点作为假设的内点子集s;
20、步骤a2:依据内点子集s确定局部邻域平面;
21、步骤a3:确定邻域窗口中除内点子集s外的所有数据点分别到局部邻域平面的距离,若距离小于设定误差,则该数据点标记为内点,否则标记为外点;
22、步骤a4:步骤a3确定的所有内点组成一致集,若一致集中内点的个数满足第三设定阈值t,则用一致集中所有内点重新确定局部邻域平面,并作为邻域窗口的局部邻域平面,结束算法;否则返回步骤a1;
23、步骤a5:经过k次迭代,若步骤a4一致集中内点的个数均不满足第三设定阈值t,则选取内点数量最多的一致集确定的局部邻域平面作为邻域窗口的局部邻域平面,结束算法。
24、进一步地,进一步确定局部邻域平面的参数,使局部邻域平面的正向法向量朝向工件中心一侧的具体方法为:
25、步骤b1:基于局部邻域平面,确定局部邻域平面的正向法向量与邻域窗口中心数据点指向工件中心的方向向量的点积;
26、步骤b2:当局部邻域平面的正向法向量与邻域窗口中心数据点指向工件中心的方向向量的点积小于0,则局部邻域平面的正向法向量指向远离工件中心的方向,将局部邻域平面的参数均取负值,反之则局部邻域平面的正向法向量指向工件中心的方向,局部邻域平面的参数不变。
27、进一步地,确定局部邻域平面的正向法向量与邻域窗口中心数据点指向工件中心的方向向量的点积的具体计算公式为:
28、;
29、 ;
30、式中,为局部邻域平面的正向法向量与邻域窗口中心数据点指向工件中心的方向向量的点积,为邻域窗口中心数据点指向工件中心的方向向量,为局部邻域平面的正向法向量,为扫描时末端法兰坐标系原点在机械臂基座坐标系下的数据点坐标。
31、进一步地,基于确定后的局部邻域平面的参数确定该平面对应的邻域窗口的中心数据点到其局部邻域平面的有向距离的具体计算公式为:
32、;
33、式中,为邻域窗口中心数据点到其局部邻域平面的有向距离;为邻域窗口中心数据点的x轴坐标,为邻域窗口中心数据点的y轴坐标,为邻域窗口中心数据点的z轴坐标,a、b、c、d分别为局部邻域平面的参数。
34、另一方面,本技术提出一种电子设备,包括:一个或多个处理器,以及存储器,所述存储器用于存储指令,当所述指令被所述一个或多个处理器执行时,使得所述一个或多个处理器执行所述的近似圆柱工件内壁焊缝三维识别定位方法。
35、第三方面,本技术提出一种计算机可读存储介质,其存储有可执行的指令,所述指令当被执行时使得处理器执行所述的近似圆柱工件内壁焊缝三维识别定位方法。
36、第四方面,本技术提出一种计算机程序产品,包括计算机程序或指令,该计算机程序或指令被处理器执行时实现所述的近似圆柱工件内壁焊缝三维识别定位方法。
37、本发明具有以下有益效果及优点:
38、1. 本发明将旋转扫描得到的点云转化到机械臂基座系下,通过拟合局部几何平面提取焊缝种子点,再将种子点转化到二维图像进行滤波和形态修补,最终提取骨架后恢复为三维焊缝轨迹,该方法实现了对近似圆柱形物体复杂曲面内壁上小凸起焊缝的识别定位功能。
39、2. 本发明采用线结构光传感器探入目标物体进行旋转扫描的方式,可以实现对近似圆柱形物体曲面内壁焊缝的在线、自动、非接触测量。
40、3.本发明采用在三维空间提取焊缝种子点,在二维空间修复焊缝形态的方法,对待测量物体表面焊缝的形态要求低,系统柔性好。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com