CN109631847A - 一种基于点云数据的含螺纹目标物位姿的计算方法 - Google Patents
一种基于点云数据的含螺纹目标物位姿的计算方法 Download PDFInfo
- Publication number
- CN109631847A CN109631847A CN201811464360.1A CN201811464360A CN109631847A CN 109631847 A CN109631847 A CN 109631847A CN 201811464360 A CN201811464360 A CN 201811464360A CN 109631847 A CN109631847 A CN 109631847A
- Authority
- CN
- China
- Prior art keywords
- plane
- cloud data
- point cloud
- screw thread
- straight line
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
Abstract
本发明提供了一种基于点云数据的含螺纹目标物位姿的计算方法,包括如下步骤:1)记含螺纹目标物固定时与他物相交处的平面为第一平面,获取点云数据;拟合第一平面的平面方程,得到法向量;2)作N个垂直于第一平面的平面Ci,选取落在同一平面Ci上的螺纹点云数据作直线拟合,得到直线Li;3)在螺纹点云数据分布区域内作多个第一平面的平行平面Pj;4)选取直线Li与平面Pj的交点,利用同一平面内的点拟合椭圆,获取中心点坐标;5)将多个中心点坐标进行直线拟合,再求取其与特定平面的夹角,得到含螺纹目标物与特定平面的夹角。该方法在获取含螺纹目标的点云数据后即能计算出含螺纹目标物的位姿数据,准确、实时,适用于在线检测。
Description
技术领域
本发明涉及工业制造领域及建筑领域,具体涉及一种基于点云数据的含螺纹目标物位姿的计算方法。
背景技术
在工业制造、建筑领域中有多个场景需使用含螺纹目标物进行联接、传动或者密闭。含螺纹目标物的位姿对后续工序有重大影响,目前针对含螺纹目标物的位姿检测有以下两种方法:人工检测、线结构光检测。人工检测采用断差尺、百分表、钢板尺、楔形塞尺、铁片尺等工具进行,测量精度、效率都较低,不能实现在线测量。而结构光检测,美国Perceptron公司研制了多线结构光的传感器用于螺柱位姿检测,其通过利用线结构光对螺柱进行重建,从而分析螺柱的位姿,但螺柱表面较为复杂,并且具有高反光特性,这一特性势必影响光条中心提取的精度,另外使用线激光耗时较长,不能满足在线测量实时性的要求。
发明内容
为了解决含螺纹目标物的位姿在线检测的问题,本发明提供了一种基于点云数据的含螺纹目标物位姿的计算方法,该方法在获取含螺纹目标的点云数据后即能计算出含螺纹目标物的位姿数据,准确、实时,适用于在线检测。
为此,本发明的技术方案如下:
一种基于点云数据的含螺纹目标物位姿的计算方法,包括如下步骤:
1)记含螺纹目标物固定时其与他物相交处的平面为第一平面,获取含螺纹目标物及第一平面的点云数据;
拟合所述第一平面的平面方程,获取其法向量;
2)作N个垂直于所述第一平面的平面,记为平面Ci,1≤i≤N,N≥6;平面Ci需同时满足与所述含螺纹目标物的点云数据相交,取落在同一平面Ci上的点云数据作直线拟合,得到拟合直线Li;所述拟合直线Li共有N条;
3)在所述含螺纹目标物的点云数据分布区域内作M个与所述第一平面相平行的平面,记为平面Pj,1≤j≤M,M≥2;
4)选取N条直线Li与平面Pj的交点,利用同一平面Pj内的N个点拟合椭圆,获取椭圆的中心点坐标;得到M个椭圆的中心点坐标;
5)利用所述M个椭圆的中心点坐标进行直线拟合,得到轴线L的直线方程,再求取轴线L与特定平面的夹角,得到含螺纹目标物与特定平面的夹角。继而就可评价含螺纹目标物与特定平面的夹角,用以评定含螺纹目标物的位姿是否与所在位置垂直。
进一步,步骤5)所述特定平面为所述第一平面。
进一步,步骤1)中拟合所述第一平面的方法为最小二乘法;步骤2)中得到拟合直线Li的方法为最小二乘法;步骤4)中拟合椭圆的方法为最小二乘法;步骤5)中进行直线拟合的方法为最小二乘法。
进一步,所述含螺纹目标物为螺柱、螺栓、螺杆或螺孔。
进一步,所述螺纹为三角形螺纹、矩形螺纹、梯形螺纹或锯齿形螺纹。
该方法在获取含螺纹目标物的点云数据后即能计算出含螺纹目标物的位姿数据,准确、实时,适用于在线检测。
附图说明
图1为具体实施方式中的螺柱及底板的点云数据;
图2为具体实施方式中的螺柱的点云数据;
图3为具体实施方式中的第一平面的点云数据。
具体实施方式
以下结合附图和具体实施方式对本发明的技术方案进行详细描述。
利用本发明提供的方法对汽车工件上螺柱进行检测,具体步骤如下:
1)将螺柱固定时与底板相交处的平面记为第一平面,获取工件点云数据,如图1所示,从中得到螺柱、第一平面的点云数据,如图2、图3;采用最小二乘法拟合出第一平面所对应的平面方程M:
Ax+By+Cz+1=0
设在第一平面上取Q个点,坐标记为:(xi,yi,zi),利用最小二乘法拟合出最佳平面M;
设di=Axi+Byi+Czi+1,(1≤i≤N,i取整),令函数G(A,B,C)分别对A,B,C求偏导,则可得到相应的方程组,
通过对方程组求解,则可解算出相应的参数A,B,C,从而可求得该平面的表达式,得到该平面所对应的法向量;设平面M的法向量为n,则n=(A,B,C),得到结果(0.0052,-0.0390,-0.0454);
2)作257个垂直于第一平面的平面,记为平面Ci,1≤i≤N,N≥6;平面Ci与螺柱的点云数据相交,取落在同一平面Ci上的点云数据作直线拟合,得到拟合直线Li;拟合直线Li共有257条;
设平面Ci为:Aix+Biy+Ciz+Di=0;
平面Ci的法向量为mi,则mi=(Ai,Bi,Ci);
可得:mi·n=0
3)在螺柱的点云数据分布区域内作M个与第一平面相平行的平面,记为平面Pj,1≤j≤M,M≥2;具体实施时作了20个平面;
4)选取257条直线Li与平面Pj的交点,利用同一平面Pj内的257个交点利用最小二乘法拟合椭圆,获取椭圆的中心点坐标;进行椭圆拟合时,通过将20个平面Pj分别进行旋转,令其平行于xoy平面再进行最小二乘椭圆拟合,将点坐标转至平面Pj内,得到中心点在平面Pj内的三维坐标;解算出20个椭圆的中心点坐标;
5)利用20个椭圆的中心点坐标进行直线拟合,得到轴线L的直线方程,再求取轴线L与特定平面的夹角,得到螺柱与底板的夹角为88.29°。
设轴线L的表达式为轴线L的方向向量为s=(M,N,P)平面M的法向量n=(A,B,C),轴线L的方向向量为s=(M,N,P),结果为(-0.0781,0.8752,1),依据向量夹角公式,可得:化简求解θ:
通过夹角θ即可求出螺柱与其底板的角度。
本申请提供的方法不仅适用于螺柱的位姿检测,还适用于螺栓、螺杆或螺孔。该方法适用于各种螺纹,具体包括三角形螺纹、矩形螺纹、梯形螺纹或锯齿形螺纹。其适用领域不仅为白车身在线测量中螺柱及螺孔位姿检测,还适用于电子产品、机械产品、数码产品、电力设备、机电机械产品、交通工具,以及管路联接等领域中外形轮廓呈螺纹状目标的位姿测量,如飞机主要承力部分的联接螺纹,大型生产器械的传动螺纹以及天然气、自来水等管道的密闭螺纹等。
Claims (5)
1.一种基于点云数据的含螺纹目标物位姿的计算方法,其特征在于包括如下步骤:
1)记含螺纹目标物固定时其与他物相交处的平面为第一平面,获取含螺纹目标物及第一平面的点云数据;
拟合所述第一平面的平面方程,获取其法向量;
2)作N个垂直于所述第一平面的平面,记为平面Ci,1≤i≤N,N≥6;平面Ci需同时满足与所述含螺纹目标物的点云数据相交,取落在同一平面Ci上的点云数据作直线拟合,得到拟合直线Li;所述拟合直线Li共有N条;
3)在所述含螺纹目标物的点云数据分布区域内作M个与所述第一平面相平行的平面,记为平面Pj,1≤j≤M,M≥2;
4)选取N条直线Li与平面Pj的交点,利用同一平面Pj内的N个点拟合椭圆,获取椭圆的中心点坐标;得到M个椭圆的中心点坐标;
5)利用所述M个椭圆的中心点坐标进行直线拟合,得到轴线L的直线方程,再求取轴线L与特定平面的夹角,得到含螺纹目标物与特定平面的夹角。
2.如权利要求1所述计算方法,其特征在于:步骤5)所述特定平面为所述第一平面。
3.如权利要求1所述计算方法,其特征在于:步骤1)中拟合所述第一平面的方法为最小二乘法;步骤2)中得到拟合直线Li的方法为最小二乘法;步骤4)中拟合椭圆的方法为最小二乘法;步骤5)中进行直线拟合的方法为最小二乘法。
4.如权利要求1所述计算方法,其特征在于:所述含螺纹目标物为螺柱、螺栓、螺杆或螺孔。
5.如权利要求1所述计算方法,其特征在于:所述螺纹为三角形螺纹、矩形螺纹、梯形螺纹或锯齿形螺纹。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811464360.1A CN109631847B (zh) | 2018-12-03 | 2018-12-03 | 一种基于点云数据的含螺纹目标物位姿的计算方法 |
PCT/CN2019/098666 WO2020113977A1 (zh) | 2018-12-03 | 2019-07-31 | 一种基于点云数据的含螺纹目标物位姿的计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811464360.1A CN109631847B (zh) | 2018-12-03 | 2018-12-03 | 一种基于点云数据的含螺纹目标物位姿的计算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109631847A true CN109631847A (zh) | 2019-04-16 |
CN109631847B CN109631847B (zh) | 2020-08-07 |
Family
ID=66070469
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811464360.1A Active CN109631847B (zh) | 2018-12-03 | 2018-12-03 | 一种基于点云数据的含螺纹目标物位姿的计算方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN109631847B (zh) |
WO (1) | WO2020113977A1 (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110411341A (zh) * | 2019-07-31 | 2019-11-05 | 易思维(杭州)科技有限公司 | 含螺纹目标物的位姿计算方法 |
CN110490865A (zh) * | 2019-08-22 | 2019-11-22 | 易思维(杭州)科技有限公司 | 基于螺柱高反光特性的螺柱点云分割方法 |
WO2020113977A1 (zh) * | 2018-12-03 | 2020-06-11 | 易思维天津科技有限公司 | 一种基于点云数据的含螺纹目标物位姿的计算方法 |
CN111784766A (zh) * | 2020-06-08 | 2020-10-16 | 易思维(杭州)科技有限公司 | 一种含螺纹目标物位姿的计算方法 |
CN112082481A (zh) * | 2020-09-09 | 2020-12-15 | 易思维(杭州)科技有限公司 | 用于检测螺纹特征的视觉检测系统的精度评价方法 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113361368B (zh) * | 2021-06-01 | 2024-03-19 | 福建福昕软件开发股份有限公司 | 基于桌面软件通过函数拟合识别pdf内多类线条的方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104197894A (zh) * | 2014-07-02 | 2014-12-10 | 同济大学 | 一种基于圆拟合的塔倾斜测量方法 |
CN106247938A (zh) * | 2016-08-31 | 2016-12-21 | 中交第二航务工程局有限公司 | 基于三维激光扫描仪提取螺栓孔特征数据的方法 |
JP2018136299A (ja) * | 2016-12-30 | 2018-08-30 | ジオスペェィシャル インフォメーション テクノロジー カンパニー リミテッドGeospatial Information Technology Co.,Ltd. | ステレオ整合技術により生成された3次元形状情報を介したポイントクラウドバンドラーシステム |
CN108534679A (zh) * | 2018-05-14 | 2018-09-14 | 西安电子科技大学 | 一种筒形件轴线位姿的无靶标自动测量装置及方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3792357B2 (ja) * | 1997-07-11 | 2006-07-05 | ポリプラスチックス株式会社 | 樹脂製ハスバ歯車金型の製造方法 |
CN105021124B (zh) * | 2015-04-16 | 2018-02-16 | 华南农业大学 | 一种基于深度图的平面零件三维位置和法向量计算方法 |
CN108416809B (zh) * | 2018-03-09 | 2023-08-22 | 江南大学 | 一种基于机器视觉的钢桶螺纹盖位姿识别方法 |
CN109631847B (zh) * | 2018-12-03 | 2020-08-07 | 易思维(天津)科技有限公司 | 一种基于点云数据的含螺纹目标物位姿的计算方法 |
-
2018
- 2018-12-03 CN CN201811464360.1A patent/CN109631847B/zh active Active
-
2019
- 2019-07-31 WO PCT/CN2019/098666 patent/WO2020113977A1/zh active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104197894A (zh) * | 2014-07-02 | 2014-12-10 | 同济大学 | 一种基于圆拟合的塔倾斜测量方法 |
CN106247938A (zh) * | 2016-08-31 | 2016-12-21 | 中交第二航务工程局有限公司 | 基于三维激光扫描仪提取螺栓孔特征数据的方法 |
JP2018136299A (ja) * | 2016-12-30 | 2018-08-30 | ジオスペェィシャル インフォメーション テクノロジー カンパニー リミテッドGeospatial Information Technology Co.,Ltd. | ステレオ整合技術により生成された3次元形状情報を介したポイントクラウドバンドラーシステム |
CN108534679A (zh) * | 2018-05-14 | 2018-09-14 | 西安电子科技大学 | 一种筒形件轴线位姿的无靶标自动测量装置及方法 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020113977A1 (zh) * | 2018-12-03 | 2020-06-11 | 易思维天津科技有限公司 | 一种基于点云数据的含螺纹目标物位姿的计算方法 |
CN110411341A (zh) * | 2019-07-31 | 2019-11-05 | 易思维(杭州)科技有限公司 | 含螺纹目标物的位姿计算方法 |
CN110411341B (zh) * | 2019-07-31 | 2020-12-08 | 易思维(杭州)科技有限公司 | 含螺纹目标物的位姿计算方法 |
CN110490865A (zh) * | 2019-08-22 | 2019-11-22 | 易思维(杭州)科技有限公司 | 基于螺柱高反光特性的螺柱点云分割方法 |
CN110490865B (zh) * | 2019-08-22 | 2022-04-01 | 易思维(杭州)科技有限公司 | 基于螺柱高反光特性的螺柱点云分割方法 |
CN111784766A (zh) * | 2020-06-08 | 2020-10-16 | 易思维(杭州)科技有限公司 | 一种含螺纹目标物位姿的计算方法 |
CN112082481A (zh) * | 2020-09-09 | 2020-12-15 | 易思维(杭州)科技有限公司 | 用于检测螺纹特征的视觉检测系统的精度评价方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109631847B (zh) | 2020-08-07 |
WO2020113977A1 (zh) | 2020-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109631847A (zh) | 一种基于点云数据的含螺纹目标物位姿的计算方法 | |
Shao et al. | Calibration of stereo-digital image correlation for deformation measurement of large engineering components | |
CN105021124A (zh) | 一种基于深度图的平面零件三维位置和法向量计算方法 | |
CN109141266B (zh) | 一种钢结构测量方法及系统 | |
CN103954245A (zh) | 一种用于关节式坐标测量机的精度标定板 | |
CN101907439A (zh) | 建筑钢结构制作仿真测量检测方法 | |
CN105571511B (zh) | 一种船舶外板成型精度在线检测方法 | |
CN110440743B (zh) | 一种基于基线的隧道变形监测方法、系统、介质及设备 | |
CN104019745A (zh) | 基于单目视觉间接标定方法的自由平面尺寸测量方法 | |
CN109211132A (zh) | 一种无人机高精度摄影测量获取高大物体变形信息的方法 | |
CN105643620B (zh) | 一种基于十字型杆件的工业机器人简易标定方法 | |
CN105758364A (zh) | 非正交轴系激光经纬仪视准轴动态模型建立方法 | |
CN103954220A (zh) | 撞桥试验中船体运动状态数字图像测量方法 | |
CN106813570B (zh) | 基于线结构光扫描的长圆柱形物体三维识别与定位方法 | |
CN103049918A (zh) | 一种视频监控中准确计算实际目标大小的方法 | |
CN109615657A (zh) | 基于点云数据的含螺纹目标物位姿的计算方法 | |
CN110411341B (zh) | 含螺纹目标物的位姿计算方法 | |
CN110470223A (zh) | 一种基于1d位移传感器的三维空间坐标测量方法 | |
CN101793509A (zh) | 一种三维绿量测定方法 | |
Hedayati et al. | Strain measurement and determining coefficient of plastic anisotropy using digital image correlation (DIC) | |
CN109212598A (zh) | 基于直达波反演的三维空间二次定位方法 | |
CN105588512B (zh) | 类矩形隧道管片构件尺寸的测量装置与方法 | |
Zhu et al. | A new noncontact flatness measuring system of large 2-D flat workpiece | |
CN113267122B (zh) | 一种基于3d视觉传感器的工业零件尺寸测量方法 | |
Kang et al. | Articulated laser sensor for three-dimensional precision measurement |
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 |