基于激光扫描点云的预制装配构件空间姿态反演校正算法的制作方法

1.本发明涉及预制装配构件空间姿态校正的技术领域，尤其涉及一种基于激光扫描点云的预制装配构件空间姿态反演校正算法。


背景技术：

2.装配式结构在绿色低碳的建造环境下，应用日益广泛，预制装配构件的质量决定着装配式结构的质量，因此，预制装配构件出厂前需进行质量检测，为提高检测效率和精度，可采用智能扫描检测方式。大量预制装配构件扫描过程中，目标扫描构件与智能扫描装备之间是无接触式扫描，智能扫描装备行走在固定轨道上，目标扫描构件人为快速随机放置在智能扫描装备行走范围内的测量区域内。因此，无法将目标扫描构件摆放在完全理想的位置，即目标扫描构件和理想位置相比，在由智能扫描装备水平行走方向、竖直行走方向和激光测距仪测量方向搭建起来的基准坐标系的x、y、z三个坐标轴方向都可能产生夹角，无法确定其摆放位置以及摆放姿态。
3.大型预制构件拼装面少数情况下会出现因制作误差导致的拼装面鼓包的情况。构件拼装面鼓包将影响装配式结构拼装精度，进而影响装配式结构整体质量。因此，在预制构件出厂前需要对构件拼装面平整度进行检测，常规人工检测精确度和效率较低，而采用智能扫描检测方式因摆放姿态不确定导致测量点数据和构件理论模型无法对应，从而难以计算构件拼装面的制作精度。
4.为此，本发明的设计者有鉴于上述缺陷，通过潜心研究和设计，综合长期多年从事相关产业的经验和成果，研究设计出一种基于激光扫描点云的预制装配构件空间姿态反演校正算法，以克服上述缺陷。


技术实现要素：

5.本发明的目的在于提供一种基于激光扫描点云的预制装配构件空间姿态反演校正算法，其能克服现有技术的缺陷，解决了任意摆放姿态下构件测量结果和构件理论模型的关联对比，最终实现对任意形状的预制构件空间姿态的反演校正。
6.为实现上述目的，本发明公开了一种基于激光扫描点云的预制装配构件空间姿态反演校正算法，其特征在于包含如下步骤：
7.步骤一：形成测量面的激光点云数据集q1，同时将目标扫描构件的扫描边界点数据放入边界点数据集q0；
8.目标扫描构件的一底角点为坐标原点，以扫描龙门水平前进方向为x轴正方向，以激光测距仪扫描竖直向上方向为y轴正方向，以激光测距仪测量值为z轴坐标值，建立xyz坐标系；
9.步骤二：将测量面调整到xyz坐标系的xy-平面，先确定当前测量面所在的平面方程，从边界点数据集q0中选取特征点确定当前测量面所在的平面方程，具体步骤如下：
10.步骤2.1：提取不位于同一直线上的三个点作为特征点；
11.步骤2.2：根据目标扫描构件的理论模型特点，从边界点数据集q0中提取坐标原点、x轴上距离原点最远的点、y轴上距离原点最远的点三个点，分别记为点a、b、c；
12.步骤2.3：三个特征点的坐标分别是a(x1，y1，z1)、b(x2，y2，z2)、c(x3，y3，z3)；由三点确定的平面abc即特征点面的方程为式1：
[0013][0014]
步骤三：姿态校正首先将测量面校正到xy-平面，即式2：
[0015]
z＝0；2)
[0016]
结合步骤二中特征点面的方程，得到特征点面和xy-平面之间的交线l为式3：
[0017]
ax+by+d＝0；
ꢀꢀꢀ
3)
[0018]
其中：a、b、c为函数常量；
[0019]
由特征点面、xy-平面、平面交线l可得到两个平面夹角α；
[0020]
其中：平面abc上取三个特征点中不位于交线l上的任意一点向平面交线l做垂线，垂足为点p
⊥
，以点p
⊥
为垂足，在xy-平面上做平面交线l的垂线，两垂线之间的夹角即为平面夹角α；
[0021]
步骤四：将激光点云数据集q1和边界点数据集q0中所有测量点校正到xy-平面，校正后平面记为平面abc
′
；
[0022]
步骤五：将平面abc
′
平移，使左底角点与坐标原点重合；
[0023]
步骤六：将平移后的平面abc
′
沿z轴方向旋转使目标扫描构件底面与xz-平面重合。
[0024]
其中：步骤一中通过扫描龙门带动激光测距仪在水平行走轨道和竖向行走轨道方向上移动，并不断采集激光测距仪测量值，同时搜索目标扫描构件的测量面边界，形成边界点数据集q0。
[0025]
其中：以捕获到的边界点为基础对目标扫描构件的整个测量面进行扫描，形成激光点云数据集q1。
[0026]
其中：步骤四中从激光点云数据集q1和边界点数据集q0中依次取测量点数据并记为测量点pi，pi向交线l做垂线，然后以交线l为旋转轴，以垂足为旋转圆心，以α为旋转角向xy-平面旋转，最终pi点旋转到xy-平面上的新点pi′
即为pi点校正后的位置。
[0027]
其中：直至激光点云数据集q1和边界点数据集q0中所有的测量点全部完成校正形成校正后的激光点云数据集q
1_1
和边界点数据集q
0_1
，校正后的特征点面为平面abc
′
，且平面abc
′
已经与xy-平面重合。
[0028]
其中：步骤五中取校正后边界点数据集q
0_1
中两个底角点坐标，分别记为点p
角l
(x
l
，y
l
，z
l
)和p
角r
(xr，yr，zr)，先将左角点p
角l
平移到坐标原点，即x轴平移x
l
、y轴平移y
l
，依此同样将校正后的激光点云数据集q
1_1
和边界点数据集q
0_1
中所有点均沿x轴平移x
l
，沿y轴平移y
l
，至此，较正后的测量面已经与理想摆放姿态下的测量面处于同一平面，并且两个测量面的左底角点重合，平移后的激光点云数据集q
1_1
和边界点数据集q
0_1
分别记为q
1_2
和q
0_2
。
[0029]
其中：步骤六中包含：计算目标扫描构件测量面上底部触地点所在直线与水平摆放时对应直线的夹角β：
[0030]
通过式4计算两底角点所在直线相对于x轴的斜率k1：
[0031][0032]
目标扫描构件理想摆放时两个底角点所在直线相对于x轴的斜率k2＝0；
[0033]
计算出平移后的边界点数据集q
0_2
中两个底角点所在直线和水平摆放时两个底角点所在直线夹角为β＝arctan(k1)。
[0034]
其中：步骤六中还包含：将平移后的激光点云数据集q
1_2
和边界点数据集q
0_2
中测量点值逐个绕z轴方向以β为旋转角，以构件左底角点26为圆心向x轴旋转，得到最终校正值。
[0035]
通过上述内容可知，本发明的基于激光扫描点云的预制装配构件空间姿态反演校正算法，以得到任意摆放姿态下目标扫描构件测量面与理想摆放姿态下测量面的空间夹角，将随机摆放的目标扫描构件分步旋转最终校正到理想位置的姿态，便于将扫描数据与目标扫描构件的理论模型对比，并最终对目标扫描构件的制作质量做进一步分析判断。
[0036]
本发明的详细内容可通过后述的说明及所附图而得到。
附图说明
[0037]
图1显示了本发明的基于激光扫描点云的预制装配构件空间姿态反演校正算法的流程图。
[0038]
图2显示了本发明的智能扫描装备和目标扫描构件相对位置关系。
[0039]
图3显示了本发明的目标扫描构件实际测量中测量面的正视图。
[0040]
图4显示了本发明的目标扫描构件实际测量的俯视图。
[0041]
图5显示了本发明的目标扫描构件实际测量的侧面正视图。
[0042]
图6显示了本发明的目标扫描构件理想摆放与xyz坐标系的关系示意图。
[0043]
图7显示了本发明的目标扫描构件随意摆放在标准坐标系中的示意图。
[0044]
附图标记：
[0045]
1：扫描龙门；2：目标扫描构件；202：目标扫描构件底面；21：测量面；22：测量面边界；26：左底角点；27：右底角点；3：构件扫描台；4：仓房；5：水平行走轨道；6：竖向行走轨道。
具体实施方式
[0046]
参见图1至图7，显示了本发明的基于激光扫描点云的预制装配构件空间姿态反演校正算法。
[0047]
所述基于激光扫描点云的预制装配构件空间姿态反演校正算法应用于图2所示的龙门式的智能扫描装备上，所述智能扫描装备包含扫描龙门1，所述扫描龙门的两内侧各对应设置n个激光测距仪，所述激光测距仪分别一对一成对设置，即可包含左侧激光测距仪和右侧激光测距仪，每一对激光测距仪正对安装且同步行走，以对目标扫描构件2两侧的测量面21进行扫描，目标扫描构件2位于构件扫描台3上，扫描龙门1可沿水平行走轨道5进行前后移动，也可控制激光测距仪沿扫描龙门1上竖向行走轨道6竖向上下移动，所述水平行走轨道5的一端设有库房4，该扫描龙门1可在不工作时移动至所述库房4，以提供有效保护。
[0048]
本发明算法思路为：目标扫描构件理想摆放姿态见图6中姿态，实际操作中无法保
证理想摆放，图7中姿态为实际操作中常出现的任意摆放姿态，从而将产生图3、图4、图5中各个方向的姿态偏斜，本发明的方法是首先调整图4、图5中两个方向的姿态偏斜，将其调整到xy-平面坐标系下，最后调整图3中偏斜姿态，使其最终调整到图6中理想摆放姿态。
[0049]
具体而言，本发明的基于激光扫描点云的预制装配构件空间姿态反演校正算法可包含如下步骤：
[0050]
步骤一：形成测量面21的激光点云数据集q1，同时将目标扫描构件1的扫描边界点数据放入边界点数据集q0；
[0051]
其中，可通过扫描目标扫描构件来获取边界点数据集并基于此继续扫描形成激光点云数据集，即通过扫描龙门1带动激光测距仪在水平行走轨道5和竖向行走轨道6方向上移动，并不断采集激光测距仪测量值，同时采用迂回折半方法搜索目标扫描构件2的测量面边界22，形成边界点数据集q0；并以捕获到的边界点为基础对目标扫描构件2的整个测量面21进行扫描，形成激光点云数据集q1。
[0052]
其中：可将目标扫描构件2的左底角点26作为坐标原点，以图7为例，p0为坐标原点，以扫描龙门1水平前进方向为x轴正方向，以激光测距仪扫描竖直向上方向为y轴正方向，以激光测距仪测量值为z轴坐标值，建立xyz坐标系。
[0053]
步骤二：如步骤一中所述，(针对所有同类型构件，以图4、图5为例)首先调整图4、图5中两个方向的姿态偏斜，将测量面21调整到xyz坐标系的xy-平面，需要先确定当前测量面所在的平面方程。从边界点数据集q0中选取特征点来确定当前测量面所在的平面方程，具体步骤如下：
[0054]
步骤2.1：提取特征点的原则是特征点之间距离尽量远且不位于同一直线上的三个点，这样可以最大程度的缩小误差。
[0055]
步骤2.2：根据目标扫描构件的理论模型特点，从边界点数据集q0中提取坐标原点、x轴上距离原点最远的点、y轴上距离原点最远的点三个点，分别记为点a、b、c。
[0056]
步骤2.3：三个特征点的坐标分别是a(x1，y1，z1)、b(x2，y2，z2)、c(x3，y3，z3)。由三点确定的平面abc即特征点面的方程为式1：
[0057][0058]
步骤三：姿态校正首先将测量面21校正到xy-平面，即式2：z＝0；2)
[0059]
结合步骤二中特征点面的方程，可以求得特征点面和xy-平面之间的交线l为式3：
[0060]
ax+by+d＝0；3)
[0061]
其中：a、b、c为函数常量。
[0062]
综上，由特征点面、xy-平面、平面交线l可得到两个平面夹角α。
[0063]
其中：平面abc上取三个特征点中不位于交线l上的任意一点向平面交线l做垂线，垂足为点p
⊥
，以点p
⊥
为垂足，在xy-平面上做平面交线l的垂线，两垂线之间的夹角即为平面夹角α。
[0064]
步骤四：将激光点云数据集q1和边界点数据集q0中所有测量点校正到xy-平面，校正后平面记为平面abc
′
。
[0065]
从激光点云数据集q1和边界点数据集q0中依次取测量点数据并记为测量点pi，pi向交线l做垂线，然后以交线l为旋转轴，以垂足为旋转圆心，以α为旋转角向xy-平面旋转，最终pi点旋转到xy-平面上的新点pi′
即为pi点校正后的位置。
[0066]
重复上述操作，直至激光点云数据集q1和边界点数据集q0中所有的测量点全部完成校正形成校正后的激光点云数据集q
1_1
和边界点数据集q
0_1
，校正后的特征点面为平面abc
′
，且平面abc
′
已经与xy-平面重合。
[0067]
步骤五：将平面abc
′
平移，使左底角点与坐标原点重合。
[0068]
通过步骤四可知，校正后的平面abc
′
已经与xy-平面重合，但实际测量中目标扫描构件2姿态未知，校正后其测量面左底角点未必与坐标原点p0(0，0，0)点重合。
[0069]
取校正后边界点数据集q
0_1
中两个底角点坐标(如图7中左底角点26和右底角点27)，分别记为点p
角l
(x
l
，y
l
，z
l
)和p
角r
(xr，yr，zr)。首先将左角点(如图7中左底角点26)p
角l
平移到坐标原点，即x轴平移x
l
、y轴平移y
l
。
[0070]
依此方法，将校正后的激光点云数据集q
1_1
和边界点数据集q
0_1
中所有点均沿x轴平移x
l
，沿y轴平移y
l
，至此，较正后的测量面已经与理想摆放姿态下的测量面处于同一平面，并且两个测量面的左底角点重合。平移后的激光点云数据集q
1_1
和边界点数据集q
0_1
分别记为q
1_2
和q
0_2
。
[0071]
步骤六：将平面abc
′
沿z轴方向旋转使目标扫描构件底面202与xz-平面重合，完成构件空间姿态反演校正算法。
[0072]
具体而言，还包含如下子步骤：
[0073]
步骤6.1：计算目标扫描构件测量面上底部触地点所在直线与水平摆放时对应直线的夹角β：
[0074]
通过式4计算两底角点所在直线相对于x轴的斜率k1：
[0075][0076]
目标扫描构件理想摆放时两个底角点所在直线相对于x轴的斜率k2＝0。
[0077]
综上可以计算出平移后的边界点数据集q
0_2
中两个底角点所在直线和水平摆放时两个底角点所在直线夹角为β＝arctan(k1)。
[0078]
步骤6.2：将平移后的激光点云数据集q
1_2
和边界点数据集q
0_2
中测量点值逐个绕z轴方向以β为旋转角，以构件左底角点26为圆心向x轴旋转，得到最终校正值。
[0079]
重复以上操作直至所有测量点完成最终校正，即旋转校正后的激光点云数据集q
1_3
和边界点数据集q
0_3
，完成构件空间姿态反演校正算法。
[0080]
显而易见的是，以上的描述和记载仅仅是举例而不是为了限制本发明的公开内容、应用或使用。虽然已经在实施例中描述过并且在附图中描述了实施例，但本发明不限制由附图示例和在实施例中描述的作为目前认为的最佳模式以实施本发明的教导的特定例子，本发明的范围将包括落入前面的说明书和所附的权利要求的任何实施例。