1.本发明涉及机器人路径规划技术领域，更具体地说，涉及一种基于特征引导的三维测量机器人扫描轨迹优化方法。
背景技术：2.航空制造业作为关系国家安全和国民经济命脉的战略性产业，能够衡量一个国家工业整体发展水平，具有技术密集度高、产业关联范围广、军民融合性强、辐射效应大等特点。飞机装配是飞机制造的重要组成部分，飞机装配的技术水平很大程度上决定了飞机的最终质量、制造成本和生产周期。
3.在飞机装配过程中，为了保证装配的质量，需要对构件的表面外形进行高精度的测量。在传统制造中，飞机气动外形测量依赖模拟量检测，依靠工人肉眼判断，检测精度与工人经验有关，对工人的操作要求高，测量效率低，无法满足飞机数字化制造和精益生产的需求。
技术实现要素：4.针对现有技术中存在的问题，本发明提供了一种基于特征引导的三维测量机器人扫描轨迹优化方法，对三维数模进行待测特征提取，生成待测特征的初始扫描轨迹，构建三维测量机器人的约束模型，以约束模型为优化目标，对初始扫描轨迹进行优化，得到各待测特征的局部最优扫描轨迹后，经过计算得到各待测特征的全局最优扫描路径。该三维测量机器人扫描轨迹优化方法具有高效、自动化的特点，提高了扫描轨迹的准确度。
5.为实现上述目的，本发明采用如下技术方案：一种基于特征引导的三维测量机器人扫描轨迹优化方法，包括以下步骤：步骤s1：建立飞机表面的三维数模，获得三维数模的尺寸，提取待测特征，并将待测特征进行分类；步骤s2：针对每一类待测特征，计算特征几何参数，生成该待测特征的初始扫描轨迹；步骤s3：构建三维测量机器人的约束模型，将每一类待测特征的初始扫描轨迹优化成局部最优扫描轨迹；步骤s4：根据每一类待测特征的局部最优扫描轨迹，利用改进的蚁群算法规划飞机表面的每类待测特征的全局最优扫描路径。
6.进一步地，步骤s2的具体实现过程如下：设置三维测量扫描仪的扫描宽度和扫描深度，针对分类的待测特征，选取待扫描曲面，采用行切法在待扫描曲面上生成轨迹，轨迹之间的间隔为扫描宽度，生成距离待扫描曲面为扫描深度的平行平面，通过平行平面与待扫描曲面上轨迹的法线求交获得初始扫描轨迹。
7.进一步地，所述三维测量机器人的约束模型具体为：（a）所述三维测量机器人的运动轨迹满足其设计要求；
（b）所述三维测量扫描仪的有效扫描宽度大于初始扫描轨迹之间的宽度；（c）所述三维测量扫描仪的面外角不能超过扫描仪的设计值；（d）所述三维测量扫描仪的面内角不能超过三维测量扫描仪的设计值。
8.进一步地，步骤s3包括如下子步骤：步骤s31、以三维测量机器人的法兰坐标系为基础，将三维测量机器人扫描过程中姿态变化转换为扫描深度d、偏转角α、俯仰角β、回转角ω的变化，并构建三维测量机器人的约束模型；步骤s32、以三维测量机器人的约束模型为基础，遍历每一类待测特征的初始扫描轨迹，构建轨迹优化评估函数e：其中，表示面外角，表示面内角，为评估函数惩罚因子，为面内角的惩罚因子，表示最大扫描深度，表示最小面外角；步骤s33、依次以扫描深度、面内角、面外角作为单一变量，重复步骤s32使轨迹优化评估函数e最小，得到每一类待测特征的局部最优扫描轨迹：其中，为扫描仪的有效扫描宽度，为初始轨迹之间的宽度，为面内角的最小、最大的取值。
9.进一步地，所述扫描深度d的取值范围为，偏转角α的取值范围为，俯仰角β的取值范围为，回转角ω的取值范围为。
10.进一步地，步骤s4包括如下子步骤：步骤s41构建飞机表面的三维工作环境：确定起始的待测特征s和目标待测特征d，初始化各处待测特征节点的信息素、搜索路径、禁忌表；步骤s42搜索最优路径：在起始的待测特征s处放置m只蚂蚁，并将起始的待测特征s放入禁忌表中，计算每只蚂蚁对下一平面中各处待测特征节点的状态转移概率，并采用轮盘赌法随机选择下一待测特征节点；步骤s43更新禁忌表：判断是否到达目标待测特征d，当所有蚂蚁完成到达目标特征d后完成一次搜索，将所有蚂蚁爬行的路径长度按照从小到大的顺序排列，更新的蚂蚁数量，同时更新相应路径上各处待测特征节点的信息素值；步骤s44检验最优解的更新情况：设置更新次数v，若在连续v次迭代中，全局最优扫描路径未发生变化，调整信息素的挥发因子，再执行步骤s42；所述信息素的挥发因子的调整过程具体为：
其中，n为目前迭代次数，为信息素的最小值；步骤s45判断是否达到最大迭代次数：若达到最大迭代次数，输出全局最优路径长度；若否，则清空禁忌表，继续执行步骤s42。
11.进一步地，所述各处待测特征节点的信息素的初始化过程为：其中，为各处待测特征节点的初始信息素；l为连接起始的待测特征s和目标待测特征d的线段，为飞机表面的三维工作环境中垂直于线段l的面的宽度；为待测特征节点到l的距离；为地图比例因子。
12.进一步地，所述状态转移概率的计算过程具体为：其中，k表示第k只蚂蚁，n表示当前迭代次数，n
max
表示最大迭代次数， 为第k只蚂蚁在待测特征节点a与待测特征节点a+1之间的信息素，为第k只蚂蚁在待测特征节点a与待测特征节点a+1之间的启发函数，表示待测特征节点a与待测特征节点a+1之间的距离；为第n次迭代下信息素因子，为第n次迭代下启发函数因子，表示三维工作环境的可行域。
13.进一步地，所述蚂蚁数量的更新过程具体为：
所述各处待测特征节点的信息素值的更新过程具体为：，其中，为第k只蚂蚁走过的距离；为第k只蚂蚁所处的排名；为更新蚂蚁的数量；为信息素的挥发因子。
14.与现有技术相比，本发明具有如下有益效果：对三维数模进行待测特征提取，生成待测特征的初始扫描轨迹，构建三维测量机器人的约束模型，以约束模型为优化目标，对初始扫描轨迹进行优化，得到各待测特征的局部最优扫描轨迹后，经过计算得到各待测特征的全局最优扫描路径。该三维测量机器人扫描轨迹优化方法，提高了扫描轨迹生成的效率，降低了整体扫描的误差。
附图说明
15.图1为本发明基于特征引导的三维测量机器人扫描轨迹优化方法的流程图；图2为本发明中利用改进的蚁群算法规划飞机表面的每类待测特征的全局最优扫描路径的流程图；图3为三维测量机器人扫描轨迹优化方法获取的全局最优扫描路径示意图。
具体实施方式
16.为了更清楚地说明本发明，下面结合附图对本发明的技术方案作进一步地解释说明。本领域技术人员应当理解，下面所具体描述的内容是说明性的而非限制性的，不应以此限制本发明的保护范围。
17.如图1为本发明基于特征引导的三维测量机器人扫描轨迹优化方法的流程图，该三维测量机器人扫描轨迹优化方法包括如下步骤：步骤s1：建立飞机表面的三维数模，获得三维数模的尺寸，提取待测特征，并将待测特征进行分类；步骤s2：针对每一类待测特征，计算特征几何参数，生成该待测特征的初始扫描轨迹；具体地，设置三维测量扫描仪的扫描宽度和扫描深度，针对分类的待测特征，选取待扫描曲面，采用行切法在待扫描曲面上生成轨迹，轨迹之间的间隔为扫描宽度，生成距离待扫描曲面为扫描深度的平行平面，通过平行平面与待扫描曲面上轨迹的法线求交获得初始扫描轨迹，生成的初始轨迹间隔明确，且切合曲面，为后续的轨迹优化奠定了基础。
18.步骤s3：构建三维测量机器人的约束模型，将每一类待测特征的初始扫描轨迹优化成局部最优扫描轨迹；具体包括如下子步骤：步骤s31、以三维测量机器人的法兰坐标系为基础，将三维测量机器人扫描过程中姿态变化转换为扫描深度d、偏转角α、俯仰角β、回转角ω的变化，并构建三维测量机器人的约束模型，由于三维测量扫描仪通过自身与待测曲面计算得到初始轨迹，扫描时保持三维测量仪与待测曲面垂直即可，但支持三维测量扫描仪的三维测量机器人的运动存在一定的限制。假设不存在这种限制，那么对于光滑曲面的扫描，可在三维测量扫描仪的扫描参数可行域内以任意姿态实现扫描，完全可以在初始轨迹生成的过程中，生成最优姿态，实现降低
扫描误差的目的；但是由于机器人运动限制的存在，限制了扫描参数的可行域，扫描参数定义域中误差最小的扫描参数不一定满足约束条件；因此，本发明中三维测量机器人的约束模型具体为：（a）所述三维测量机器人的运动轨迹满足其设计要求；（b）所述三维测量扫描仪的有效扫描宽度大于初始扫描轨迹之间的宽度；（c）所述三维测量扫描仪的面外角不能超过扫描仪的设计值；（d）所述三维测量扫描仪的面内角不能超过三维测量扫描仪的设计值。
19.本发明中扫描深度d的取值范围为，偏转角α的取值范围为，俯仰角β的取值范围为，回转角ω的取值范围为。
20.步骤s32、以三维测量机器人的约束模型为基础，遍历每一类待测特征的初始扫描轨迹，构建轨迹优化评估函数e。通过多次实验，得出以下结论：当扫描深度不变，扫描误差随着面外角的增大而增大；当扫描深度越大，面外角对系统误差的影响越小，扫描误差随着面外角线性变化，而随着扫描深度增加，线性趋势的斜率减小；扫描误差近似与扫描深度和面外角之间呈双线性关系。
21.因此，本发明中轨迹优化评估函数e为：其中，表示面外角，表示面内角，为评估函数惩罚因子，为面内角的惩罚因子，表示最大扫描深度，表示最小面外角。
22.步骤s33、依次以扫描深度、面内角、面外角作为单一变量，重复步骤s32使轨迹优化评估函数e最小，得到每一类待测特征的局部最优扫描轨迹：其中，为扫描仪的有效扫描宽度，为初始轨迹之间的宽度，为面内角的最小、最大的取值。
23.步骤s4：根据每一类待测特征的局部最优扫描轨迹，由于每个特征之间具有一定的距离，可简化为一个个的待测特征节点，可利用改进的蚁群算法规划飞机表面的每类待测特征的全局最优扫描路径，如图2，具体包括如下子步骤：步骤s41构建飞机表面的三维工作环境：确定起始的待测特征s和目标待测特征d，初始化各处待测特征节点的信息素、搜索路径、禁忌表；由于全局最优扫描路径一般集中于起始的待测特征s和目标待测特征d连接的线段l附近，因此，本发明中各处待测特征节点的信息素的初始化根据各个特征节点距离线段l的距离来进行分配其信息素，这种分配方式
比随机分配减少其计算迭代次数，提高了优化效率，其过程为：其中，为各处待测特征节点的初始信息素；l为连接起始的待测特征s和目标待测特征d的线段，为飞机表面的三维工作环境中垂直于线段l的面的宽度；为待测特征节点到l的距离；为地图比例因子。
24.步骤s42搜索最优路径：在起始的待测特征s处放置m只蚂蚁，并将起始的待测特征s放入禁忌表中，计算每只蚂蚁对下一平面中各处待测特征节点的状态转移概率，并采用轮盘赌法随机选择下一待测特征节点；在路径迭代计算中，随着次数的增加，信息素因子对路径选择的重要程度逐渐下降。在初期，由于各特征节点的信息素浓度不同，信息素因子对路径选择影响较大，此时的值应较大，的值应较小。后期，最优路径上的信息素浓度逐渐远高于其他路径，为防止算法陷入局部最优，应逐渐减小信息素浓度在路径选择中的重要程度，即值逐渐减小，值相应增加，从而有助于找到全局最优解。因此，本发明的状态转移概率将信息素因子和启发函数因子的值改为动态参数，分别采用余弦和正弦函数进行赋值，使其随着迭代的进行而做出改变，本发明中状态转移概率的计算过程具体为：其中，k表示第k只蚂蚁，n表示当前迭代次数，n
max
表示最大迭代次数， 为第k只蚂蚁在待测特征节点a与待测特征节点a+1之间的信息素，为第k只蚂蚁在待测特征节点a与待测特征节点a+1之间的启发函数，表示待测特征节点a与待测特征
节点a+1之间的距离；为第n次迭代下信息素因子，为第n次迭代下启发函数因子，表示三维工作环境的可行域。
25.步骤s43更新禁忌表：判断是否到达目标待测特征d，当所有蚂蚁完成到达目标特征d后完成一次搜索，将所有蚂蚁爬行的路径长度按照从小到大的顺序排列，更新的蚂蚁数量，同时更新相应路径上各处待测特征节点的信息素值，使得下次迭代时，路径上的信息素值越大，蚂蚁选择该路径的概率越大，以此寻找出全局最优扫描路径；本发明中蚂蚁数量的更新过程具体为：本发明中各节点的信息素值的更新过程具体为：，其中，为第k只蚂蚁走过的距离；为第k只蚂蚁所处的排名；为更新蚂蚁的数量；为信息素的挥发因子。
26.步骤s44检验最优解的更新情况：为防止路径陷入局部最优的情况，设置更新次数v，若在连续v次迭代中，全局最优扫描路径未发生变化，调整信息素的挥发因子，再执行步骤s42；本发明中信息素的挥发因子的调整过程具体为：其中，n为目前迭代次数，为信息素的最小值；步骤s45判断是否达到最大迭代次数：若达到最大迭代次数，输出全局最优路径长度；若否，则清空禁忌表，继续执行步骤s42。
27.如图3为本发明三维测量机器人扫描轨迹优化方法获取的全局最优扫描路径示意图，其中虚线为优化出来的全局最优扫描路径。针对每类特征生成初始轨迹，确定三维测量机器人扫描轨迹的基础，构建三维测量机器人的约束模型，对初始轨迹进行优化，使得整个轨迹符合三维测量机器人的运动规律。整个飞机具有多类特征，将多类特征的局部优化轨迹通过改进的蚁群算法规划得到整个飞机的全局最优机器人扫描轨迹。
28.以上仅是本发明的优选实施方式，本发明的保护范围并不仅局限于上述实施方式，凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理前提下的若干改进和润饰，应视为本发明的保护范围。
技术特征：1.一种基于特征引导的三维测量机器人扫描轨迹优化方法，其特征在于，包括以下步骤：步骤s1：建立飞机表面的三维数模，获得三维数模的尺寸，提取待测特征，并将待测特征进行分类；步骤s2：针对每一类待测特征，计算特征几何参数，生成该待测特征的初始扫描轨迹；步骤s3：构建三维测量机器人的约束模型，将每一类待测特征的初始扫描轨迹优化成局部最优扫描轨迹；步骤s4：根据每一类待测特征的局部最优扫描轨迹，利用改进的蚁群算法规划飞机表面的每类待测特征的全局最优扫描路径。2.根据权利要求1所述基于特征引导的三维测量机器人扫描轨迹优化方法，其特征在于，步骤s2的具体实现过程如下：设置三维测量扫描仪的扫描宽度和扫描深度，针对分类的待测特征，选取待扫描曲面，采用行切法在待扫描曲面上生成轨迹，轨迹之间的间隔为扫描宽度，生成距离待扫描曲面为扫描深度的平行平面，通过平行平面与待扫描曲面上轨迹的法线求交获得初始扫描轨迹。3.根据权利要求1所述基于特征引导的三维测量机器人扫描轨迹优化方法，其特征在于，所述三维测量机器人的约束模型具体为：（a）所述三维测量机器人的运动轨迹满足其设计要求；（b）所述三维测量扫描仪的有效扫描宽度大于初始扫描轨迹之间的宽度；（c）所述三维测量扫描仪的面外角不能超过扫描仪的设计值；（d）所述三维测量扫描仪的面内角不能超过三维测量扫描仪的设计值。4.根据权利要求1所述基于特征引导的三维测量机器人扫描轨迹优化方法，其特征在于，步骤s3包括如下子步骤：步骤s31、以三维测量机器人的法兰坐标系为基础，将三维测量机器人扫描过程中姿态变化转换为扫描深度d、偏转角α、俯仰角β、回转角ω的变化，并构建三维测量机器人的约束模型；步骤s32、以三维测量机器人的约束模型为基础，遍历每一类待测特征的初始扫描轨迹，构建轨迹优化评估函数e：其中，表示面外角，表示面内角，为评估函数惩罚因子，为面内角的惩罚因子，表示最大扫描深度，表示最小面外角；步骤s33、依次以扫描深度、面内角、面外角作为单一变量，重复步骤s32使轨迹优化评估函数e最小，得到每一类待测特征的局部最优扫描轨迹：
其中，为扫描仪的有效扫描宽度，为初始轨迹之间的宽度，为面内角的最小、最大的取值。5.根据权利要求4所述基于特征引导的三维测量机器人扫描轨迹优化方法，其特征在于，所述扫描深度d的取值范围为，偏转角α的取值范围为，俯仰角β的取值范围为，回转角ω的取值范围为。6.根据权利要求1所述基于特征引导的三维测量机器人扫描轨迹优化方法，其特征在于，步骤s4包括如下子步骤：步骤s41构建飞机表面的三维工作环境：确定起始的待测特征s和目标待测特征d，初始化各处待测特征节点的信息素、搜索路径、禁忌表；步骤s42搜索最优路径：在起始的待测特征s处放置m只蚂蚁，并将起始的待测特征s放入禁忌表中，计算每只蚂蚁对下一平面中各处待测特征节点的状态转移概率，并采用轮盘赌法随机选择下一待测特征节点；步骤s43更新禁忌表：判断是否到达目标待测特征d，当所有蚂蚁完成到达目标特征d后完成一次搜索，将所有蚂蚁爬行的路径长度按照从小到大的顺序排列，更新的蚂蚁数量，同时更新相应路径上各处待测特征节点的信息素值；步骤s44检验最优解的更新情况：设置更新次数v，若在连续v次迭代中，全局最优扫描路径未发生变化，调整信息素的挥发因子，再执行步骤s42；所述信息素的挥发因子的调整过程具体为：其中，n为目前迭代次数，为信息素的最小值；步骤s45判断是否达到最大迭代次数：若达到最大迭代次数，输出全局最优路径长度；若否，则清空禁忌表，继续执行步骤s42。7.根据权利要求6所述基于特征引导的三维测量机器人扫描轨迹优化方法，其特征在于，所述各处待测特征节点的信息素的初始化过程为：其中，为各处待测特征节点的初始信息素；l为连接起始的待测特征s和目标待测特
征d的线段，为飞机表面的三维工作环境中垂直于线段l的面的宽度；为待测特征节点到l的距离；为地图比例因子。8.根据权利要求6所述基于特征引导的三维测量机器人扫描轨迹优化方法，其特征在于，所述状态转移概率的计算过程具体为：其中，k表示第k只蚂蚁，n表示当前迭代次数，n
max
表示最大迭代次数， 为第k只蚂蚁在待测特征节点a与待测特征节点a+1之间的信息素，为第k只蚂蚁在待测特征节点a与待测特征节点a+1之间的启发函数，表示待测特征节点a与待测特征节点a+1之间的距离；为第n次迭代下信息素因子，为第n次迭代下启发函数因子，表示三维工作环境的可行域。9.根据权利要求6所述基于特征引导的三维测量机器人扫描轨迹优化方法，其特征在于，所述蚂蚁数量的更新过程具体为：所述各处待测特征节点的信息素值的更新过程具体为：，其中，为第k只蚂蚁走过的距离；为第k只蚂蚁所处的排名；为更新蚂蚁的数量；为信息素的挥发因子。
技术总结本发明公开了一种基于特征引导的三维测量机器人扫描轨迹优化方法，包括：建立飞机表面的三维数模，获得三维数模的尺寸，提取待测特征，并将待测特征进行分类；针对每一类待测特征，计算特征几何参数，生成该待测特征的初始扫描轨迹；构建三维测量机器人的约束模型，将每一类待测特征的初始扫描轨迹优化成局部最优扫描轨迹；根据每一类待测特征的局部最优扫描轨迹，利用改进的蚁群算法规划飞机表面的每类待测特征的全局最优扫描路径。该三维测量机器人扫描轨迹优化方法提高了三维测量机器人的工作效率，保证了扫描精度。保证了扫描精度。保证了扫描精度。
技术研发人员：汪俊 曾航彬 刘元朋 康正水 杨建平
受保护的技术使用者：南京航空航天大学
技术研发日：2022.05.25
技术公布日：2022/7/5
