一种基于激光测距的特大型工件位姿高精度定位方法与流程

摘要: 本技术属于定位领域,尤其涉及一种基于激光测距的特大型工件位姿高精度定位方法。背景技术:1、非接触式激光定位技术具有测量速度快、作用距离远、适应工业现场环境能力较...
一种基于激光测距的特大型工件位姿高精度定位方法与流程

本技术属于定位领域,尤其涉及一种基于激光测距的特大型工件位姿高精度定位方法。

背景技术:

1、非接触式激光定位技术具有测量速度快、作用距离远、适应工业现场环境能力较强等特点,已广泛应用于大型工件的空间位置与姿态检测。现有激光定位系统通常基于飞行时间测量原理,通过获取激光脉冲从发射、经工件表面反射至接收器接收所经历的传播时间计算距离,并结合光束偏转角解算测量点的三维坐标。然而,在高速瞬态回波信号检测过程中,传统测量系统的时钟同步、触发锁存和采样控制能力有限,容易产生触发延迟、计时分辨率不足以及波形截取不完整等问题,使单点距离测量精度受到限制,难以满足特大型工件高精度位姿定位的需求。

2、在复杂工业环境下,工件表面材质、粗糙度、加工纹理及环境噪声等因素会导致激光回波出现展宽、畸变和幅值波动,使传统基于固定阈值或单一峰值的时间提取方式难以稳定反映真实飞行时间。同时,在多测点位姿解算过程中,不同测量点受局部表面状态和回波质量影响,其可靠程度并不相同;若仍将所有测量点等权参与数模曲面配准,低质量测量点可能对整体位姿求解产生不利影响,降低定位结果的稳定性和准确性。因此,有必要提供一种能够在硬件层面提高时间测量一致性,并结合回波波形特征评价测点置信度,从而实现特大型工件六自由度位姿高精度定位的方法。

技术实现思路

1、为了解决现有技术中激光回波触发计时同步性不足、畸变回波真实飞行时间提取不稳定,以及多测点位姿解算中低质量测点等权参与导致定位精度下降的问题,第一方面,本发明提供了一种基于激光测距的特大型工件位姿高精度定位方法,包括以下步骤:

2、发射激光至工件测量点,记录扫描偏转角,启动与模数转换器共享时钟的主计时器,模数转换器对回波信号循环采样存入环形缓冲器,当回波幅度超过设定阈值时产生触发事件并锁存主计时器计数值和采样相位计数值,得到触发基准时间,控制模数转换器继续采集预设后置采样点数的数据后停止写入,并结合地址回环机制截取完整回波波形数据;

3、基于截取的完整回波波形数据与预先存储的参考波形,采用正则化反卷积计算信道冲击响应函数,对信道冲击响应函数主峰进行亚采样插值,补偿参考波形对齐偏移,求得精细索引偏移量,基于信道冲击响应函数主峰半高全宽确定测量点的置信度权重因子;

4、将触发基准时间与精细索引偏移量转换的时间相加,并扣除固定延迟得到总飞行时间,结合记录的扫描偏转角解算空间三维坐标,对工件表面至少三个非共线点分别获取三维坐标及置信度权重因子,形成三维坐标集及置信度权重因子集,构建各测量点到工件数模曲面的正交投影距离平方与对应置信度权重因子乘积总和的加权目标函数,利用基于李代数的非线性优化算法求取使加权目标函数最小化的位姿变换矩阵确定工件位姿。

5、可选地,所述模数转换器对回波信号循环采样存入环形缓冲器,包括:

6、利用数据写入控制逻辑或直接内存存取控制器,将模数转换器产生的离散数字信号顺序写入采样数据存储空间中的环形缓冲器;

7、当写入指针达到环形缓冲器最高物理地址边界时,将下一次写入地址指针自动映射重置至环形缓冲器最低物理基地址,实现旧数据的无缝循环覆盖。

8、可选地,所述当回波幅度超过设定阈值时产生触发事件并锁存主计时器计数值和采样相位计数值,得到触发基准时间,控制模数转换器继续采集预设后置采样点数的数据后停止写入,并结合地址回环机制截取完整回波波形数据,包括:

9、监测回波信号电压,当回波信号电压达到设定阈值时,锁存主计时器计数值及当前写入地址指针,同步锁存触发采样点在当前主计时器周期内的采样相位计数值,并继续采集预设数量的后置采样数据后停止写入;

10、以锁存的写入地址指针对应的触发位置为基准,分别向历史方向和后续方向偏移预设的前置采样点数和后置采样点数,确定逻辑起始地址和逻辑结束地址;

11、对超出环形缓冲器物理边界的逻辑地址进行取模映射,按照逻辑顺序读取对应物理地址中的采样数据,得到完整回波波形数据。

12、可选地,所述基于截取的完整回波波形数据与预先存储的参考波形,采用正则化反卷积计算信道冲击响应函数,包括:

13、分别对截取的完整回波波形数据及预先存储的参考波形执行快速傅里叶变换,得到系统回波频域向量和参考脉冲频域向量;

14、采用防除零正则化常数,按照维纳滤波法则构建频域反卷积计算公式,使得频域冲击响应向量为系统回波频域向量与参考脉冲频域向量的共轭复数之积除以参考脉冲频域向量模的平方与防除零正则化常数之和,据此求得频域冲击响应向量;

15、对频域冲击响应向量执行快速傅里叶逆变换处理,提取所述向量实部生成时间序列上的信道冲击响应函数。

16、可选地,所述对信道冲击响应函数主峰进行亚采样插值,补偿参考波形对齐偏移,求得精细索引偏移量,包括:

17、遍历信道冲击响应函数找到数值最大的离散数据点,提取所述离散数据点及左右紧邻的各一个离散数据点;

18、以补偿预先存储的参考波形对齐偏移后的位置为相对原点,利用提取出的三个离散数据点的幅值与相对索引构建一元二次方程;

19、约束一元二次方程的二次项系数小于零,令所述一元二次方程关于索引变量的一阶导数为零,求得一元二次方程极值点对应的索引变量值,将所述索引变量值作为精细索引偏移量。

20、可选地,所述将触发基准时间与精细索引偏移量转换的时间相加,并扣除固定延迟得到总飞行时间,包括:

21、将触发事件锁存得到的主计时器计数值与主时钟单周期时长相乘,并将触发采样相位计数值与模数转换器单次采样周期间隔相乘,二者相加得到触发采样点的触发基准时间;

22、将精细索引偏移量与模数转换器单次采样周期间隔相乘得到精细索引偏移量转换的时间,将触发基准时间与精细索引偏移量转换的时间相加,并扣除系统预先标定的双程固定延迟时间常数,计算得到实际光路传输的总飞行时间。

23、可选地,所述构建各测量点到工件数模曲面的正交投影距离平方与对应置信度权重因子乘积总和的加权目标函数,包括:

24、将获取的三维坐标集中的各个三维坐标点经待求的位姿变换矩阵转换后,沿工件标称数模曲面的法线方向计算最近的正交投影点坐标;

25、计算每个三维坐标点经转换后的坐标与对应的正交投影点坐标之间欧几里得距离的平方作为正交投影距离平方;

26、将每个测量点的正交投影距离平方与所述测量点对应的置信度权重因子相乘,遍历所有测量点将乘积结果进行求和运算,得到加权目标函数。

27、可选地,所述利用基于李代数的非线性优化算法求取使加权目标函数最小化的位姿变换矩阵确定工件位姿,包括:

28、将待求的三维旋转矩阵与平移向量构建为三维特殊欧几里得群上的初始刚体变换矩阵;

29、基于当前位姿估计计算各个测量点的投影残差向量,并推导投影残差向量对三维特殊欧几里得群对应李代数的雅可比矩阵;

30、利用高斯牛顿法或列文伯格马夸尔特法计算李代数增量,所述李代数增量的计算过程纳入由置信度权重因子组成的对角权重矩阵、阻尼系数以及单位矩阵;

31、通过李群与李代数的指数映射关系,将李代数增量经楔算子转换为对应的李代数矩阵后进行指数映射,并以乘法形式更新当前位姿变换矩阵以保证旋转矩阵的正交性;

32、重复迭代上述投影残差向量与李代数增量计算过程,直至李代数增量的模长小于预设收敛阈值,输出更新的位姿变换矩阵作为确定的工件位姿。

33、另一方面,本发明还提供了一种基于激光测距的特大型工件位姿高精度定位系统,包括以下模块:

34、截取模块,用于发射激光至工件测量点,记录扫描偏转角,启动与模数转换器共享时钟的主计时器,模数转换器对回波信号循环采样存入环形缓冲器,当回波幅度超过设定阈值时产生触发事件并锁存主计时器计数值和采样相位计数值,得到触发基准时间,控制模数转换器继续采集预设后置采样点数的数据后停止写入,并结合地址回环机制截取完整回波波形数据;

35、计算模块,用于基于截取的完整回波波形数据与预先存储的参考波形,采用正则化反卷积计算信道冲击响应函数,对信道冲击响应函数主峰进行亚采样插值,补偿参考波形对齐偏移,求得精细索引偏移量,基于信道冲击响应函数主峰半高全宽确定测量点的置信度权重因子;

36、确定模块,用于将触发基准时间与精细索引偏移量转换的时间相加,并扣除固定延迟得到总飞行时间,结合记录的扫描偏转角解算空间三维坐标,对工件表面至少三个非共线点分别获取三维坐标及置信度权重因子,形成三维坐标集及置信度权重因子集,构建各测量点到工件数模曲面的正交投影距离平方与对应置信度权重因子乘积总和的加权目标函数,利用基于李代数的非线性优化算法求取使加权目标函数最小化的位姿变换矩阵确定工件位姿。

37、进一步地,所述模数转换器对回波信号循环采样存入环形缓冲器,包括:

38、利用数据写入控制逻辑或直接内存存取控制器,将模数转换器产生的离散数字信号顺序写入采样数据存储空间中的环形缓冲器;

39、当写入指针达到环形缓冲器最高物理地址边界时,将下一次写入地址指针自动映射重置至环形缓冲器最低物理基地址,实现旧数据的无缝循环覆盖。

40、进一步地,所述当回波幅度超过设定阈值时产生触发事件并锁存主计时器计数值和采样相位计数值,得到触发基准时间,控制模数转换器继续采集预设后置采样点数的数据后停止写入,并结合地址回环机制截取完整回波波形数据,包括:

41、监测回波信号电压,当回波信号电压达到设定阈值时,锁存主计时器计数值及当前写入地址指针,同步锁存触发采样点在当前主计时器周期内的采样相位计数值,并继续采集预设数量的后置采样数据后停止写入;

42、以锁存的写入地址指针对应的触发位置为基准,分别向历史方向和后续方向偏移预设的前置采样点数和后置采样点数,确定逻辑起始地址和逻辑结束地址;

43、对超出环形缓冲器物理边界的逻辑地址进行取模映射,按照逻辑顺序读取对应物理地址中的采样数据,得到完整回波波形数据。

44、进一步地,所述基于截取的完整回波波形数据与预先存储的参考波形,采用正则化反卷积计算信道冲击响应函数,包括:

45、分别对截取的完整回波波形数据及预先存储的参考波形执行快速傅里叶变换,得到系统回波频域向量和参考脉冲频域向量;

46、采用防除零正则化常数,按照维纳滤波法则构建频域反卷积计算公式,使得频域冲击响应向量为系统回波频域向量与参考脉冲频域向量的共轭复数之积除以参考脉冲频域向量模的平方与防除零正则化常数之和,据此求得频域冲击响应向量;

47、对频域冲击响应向量执行快速傅里叶逆变换处理,提取所述向量实部生成时间序列上的信道冲击响应函数。

48、进一步地,所述对信道冲击响应函数主峰进行亚采样插值,补偿参考波形对齐偏移,求得精细索引偏移量,包括:

49、遍历信道冲击响应函数找到数值最大的离散数据点,提取所述离散数据点及左右紧邻的各一个离散数据点;

50、以补偿预先存储的参考波形对齐偏移后的位置为相对原点,利用提取出的三个离散数据点的幅值与相对索引构建一元二次方程;

51、约束一元二次方程的二次项系数小于零,令所述一元二次方程关于索引变量的一阶导数为零,求得一元二次方程极值点对应的索引变量值,将所述索引变量值作为精细索引偏移量。

52、进一步地,所述将触发基准时间与精细索引偏移量转换的时间相加,并扣除固定延迟得到总飞行时间,包括:

53、将触发事件锁存得到的主计时器计数值与主时钟单周期时长相乘,并将触发采样相位计数值与模数转换器单次采样周期间隔相乘,二者相加得到触发采样点的触发基准时间;

54、将精细索引偏移量与模数转换器单次采样周期间隔相乘得到精细索引偏移量转换的时间,将触发基准时间与精细索引偏移量转换的时间相加,并扣除系统预先标定的双程固定延迟时间常数,计算得到实际光路传输的总飞行时间。

55、进一步地,所述构建各测量点到工件数模曲面的正交投影距离平方与对应置信度权重因子乘积总和的加权目标函数,包括:

56、将获取的三维坐标集中的各个三维坐标点经待求的位姿变换矩阵转换后,沿工件标称数模曲面的法线方向计算最近的正交投影点坐标;

57、计算每个三维坐标点经转换后的坐标与对应的正交投影点坐标之间欧几里得距离的平方作为正交投影距离平方;

58、将每个测量点的正交投影距离平方与所述测量点对应的置信度权重因子相乘,遍历所有测量点将乘积结果进行求和运算,得到加权目标函数。

59、进一步地,所述利用基于李代数的非线性优化算法求取使加权目标函数最小化的位姿变换矩阵确定工件位姿,包括:

60、将待求的三维旋转矩阵与平移向量构建为三维特殊欧几里得群上的初始刚体变换矩阵;

61、基于当前位姿估计计算各个测量点的投影残差向量,并推导投影残差向量对三维特殊欧几里得群对应李代数的雅可比矩阵;

62、利用高斯牛顿法或列文伯格马夸尔特法计算李代数增量,所述李代数增量的计算过程纳入由置信度权重因子组成的对角权重矩阵、阻尼系数以及单位矩阵;

63、通过李群与李代数的指数映射关系,将李代数增量经楔算子转换为对应的李代数矩阵后进行指数映射,并以乘法形式更新当前位姿变换矩阵以保证旋转矩阵的正交性;

64、重复迭代上述投影残差向量与李代数增量计算过程,直至李代数增量的模长小于预设收敛阈值,输出更新的位姿变换矩阵作为确定的工件位姿。

65、本发明通过共享时钟、采样相位锁存与硬件触发机制,结合环形缓冲器和地址回环处理,在回波达到阈值时同步记录计时信息、采样相位及触发地址,并在继续采集后置数据后截取完整回波波形,从而减少触发时序偏差和波形截断对飞行时间计算的影响。利用正则化反卷积与亚采样插值获得信道冲击响应主峰的精细时间偏移,并根据主峰半高全宽确定归一化置信度权重因子。结合总飞行时间和扫描偏转角解算三维坐标后,在位姿解算阶段构建带置信度权重的测点到数模曲面距离目标函数,并采用基于李代数的非线性优化方法求取工件位姿,从而减小低质量测量点对配准结果的不利影响,提高定位准确性和稳定性。