一种基于四面体构型的距离传感器法矢测量方法技术

一种基于四面体构型的距离传感器法矢测量方法，其特征是：首先，在机床或机器人的末端执行器上安装有呈等边三角形布置的三个激光测距传感器，并且固定三个激光测距传感器的测量方向，使得其激光束汇聚于同一点，与三个激光测距传感器构成一个空间四面体；其次，利用空间四面体顶点与待测曲面的三种位置关系：顶点在曲面内、顶点在曲面上、顶点在曲面外，结合激光测距传感器测量的数值，可以求得待测制孔曲面的法矢n；最后，根据上述测量计算所得到的待制孔法矢信息，通过反解算法，求得机床或机器人各轴的驱动量，用于控制系统实现调姿运动。发明专利技术具有求解精度高，可高效快速地响应控制系统的需求。

【技术实现步骤摘要】
一种基于四面体构型的距离传感器法矢测量方法
本专利技术涉及一种法矢测量技术，尤其是一种用于飞机蒙皮制孔的法矢测量方法，具体地说是一种基于四面体构型的距离传感器法矢测量方法。
技术介绍
一架大型飞机上大约有150～200万个连接孔，飞机结构主要通过在这些孔处的铆接和螺接来实现机械连接。据统计，飞机机体疲劳失效事故的70％是源于结构连接部位，其中80％的疲劳裂纹产生于连接孔处。波音公司对紧固件连接使用进行分析表明，当紧固件沿外载荷作用方向倾斜大于2°时，疲劳寿命降低约47％；倾斜大于5°时，疲劳寿命降低95％，从而可以看出连接孔质量极大的影响着飞机的寿命。因此，为保证飞机装配质量，提高机体的疲劳寿命，越来越多的自动化设备被用在大型飞机的装配过程中，如自动钻铆机、柔性轨道制孔机构、爬行机器人制孔机构及机械臂制孔机构等。在自动化设备制孔过程中，孔的垂直度取决于钻头轴线是否与制孔点的法线重合。目前，设备很难靠自身控制使钻头沿钻孔点的法矢方向钻孔，需要利用法矢测量与末端调姿装置来调整钻头的姿态。对于曲面的法矢测量，常见的有向量叉积法、二次曲面拟合法、NURBS曲线法和三角网格法等。以上方法在工程应用时，需要测量大量的点才能达到较高的精度，不适合实时的精确测量。本专利技术针对以上出现的问题提出了一种基于四面体构型的三个激光测距传感器的非接触法矢测量方法，此方法测量精度高、速度快，且不会损伤被测物体表面。
技术实现思路
本专利技术的目的是针对现有法矢测量方法中存在的精度不高，实时性差的问题，专利技术一种基于四面体构型的距离传感器法矢测量方法，它借助三个激光测距传感器来实现对飞机蒙皮制孔的孔法矢的快速实现测量。本专利技术的技术方案是：一种基于四面体构型的距离传感器法矢测量方法，其特征是它包括以下步骤：首先，在机床或机器人的末端执行器上安装呈等边三角形布置的三个激光测距传感器，并且固定三个激光测距传感器的测量方向，使得其激光束汇聚于同一点，与三个激光测距传感器构成一个空间四面体；其次，利用空间四面体顶点与待测曲面的三种位置关系：顶点在曲面内、顶点在曲面上、顶点在曲面外，结合激光测距传感器测量的数值，可以求得待测制孔曲面的法矢n；最后，根据上述测量计算所得到的待制孔法矢信息，通过反解算法，求得机床或机器人各轴的驱动量，用于控制系统实现调姿运动。为了使得待测制孔曲面法矢n的测量结果更加精确，作如下条件约束：lmin≤li≤lmax(i＝1,2,3)式中li为三个激光测距传感器激光发射点到待测制孔曲面的距离，lmin和lmax分别为满足制孔法矢精度要求时li的最小距离和最大距离，其具体数值可由激光测距传感器激光发射点到激光束汇聚点的距离和待制孔法矢的精度等级求出。当li满足上述约束后，待测制孔曲面的法矢n可根据如下三种情况具体求解。情况一：四面体顶点在待测曲面内当空间四面体与待检测位置所在曲面相交时，建立如图2所示的坐标系，将坐标原点建立在刀具端点，所述的3个激光测距传感器A、B、C呈正三角形分布在刀具四周，设定xt方向为过Ot点平行于AB且由A指向B方向，yt方向为OtC方向，zt方向根据右手定理获得。首先，根据设计和安装，确定3个激光测距传感器的安装位置，并使得3个激光测距传感器3条激光汇聚于一点D，即在激光测距传感器对曲面法矢进行测量之前，通过机械结构及装配保证四面体D-ABC构型已知。则A、B、C在Otxtytzt坐标系下的坐标分别为C(0,CD·cos∠DCOt,0)，当待检测位置所在曲面与四面体相交，根据几何关系可以求得A1(-A1D·cos∠DAOt·cos∠OtAB,-A1D·cos∠DAOt·sin∠OtAB,AA1·sin∠DAOt)B1(B1D·cos∠DBOt·cos∠OtBA,1B1D·cos∠DBOt·sin∠OtBA,BB1·sin∠DBOt)C1(0,DC1·cos∠DCOt,CC1·sinDCOt)令A1(xa1,ya1,za1)，B1(xb1,yb1,zb1)，C1(xc1,yc1,zc1)，则A1B1(xb1-xa1,yb1-ya1,zb1-za1)，A1C1(xc1-xa1,yc1-ya1,zc1-za1)，B1C1(xb1-xc1,yb1-yc1,zb1-zc1)，设平面A1B1C1的法向坐标为(l1,m1,n1)，则，根据法向量的定义通过上式，可以求解(l1,m1,n1)，其中n1即为待加工孔位置法矢量。情况二：顶点在曲面上当四面体顶点与待检测位置所在曲面重合时，如图所示。可以认为A1，B1，C1三点与D点重合，即通过情况一中式(1)，求解出的(l1,m1,n1)有无穷多种组合，故情况二下待加工孔位置法矢量不可求解。情况三：顶点在曲面外当待检测位置所在曲面相交于空间四面体顶点的延长线上时，如图所示，根据几何关系可以求得A2(DA2·cos∠DAOt·cos∠OtAB,DA2·cos∠DAOt·sin∠OtAB,AA2·sin∠DAOt)B2(-DB2·cos∠DBOt·cos∠OtBA,DB2·cos∠DBOt·sin∠OtBA,BB2·sin∠DBOt)C2(0,-DC2·cos∠DCOt,CC2·sinDCOt)令A2(xa2,ya2,za2)，B2(xb2,yb2,zb2)C2(xc2,yc2,zc2)，则A2B2(xb2-xa2,yb2-ya2,zb2-za2)，A2C2(xc2-xa2,yc2-ya2,zc2-za2)，B2C2(xb2-xc2,yb2-yc2,zb2-zc2)，设平面A2B2C2的法向坐标为(l2,m2,n2)，则，根据法向量的定义通过上式(3)，可以求解(l2,m2,n2)，其中n2即为待加工孔位置法矢量。本专利技术的有益效果是：本专利技术方法简单，通过预先布置好的基于四面体构型的几何关系及激光测距传感器测得的数据即可实现对待加工孔的法矢测量。再通过反解算法，可以很方便的实现对机床或机器人实现制孔加工的各轴的驱动量，用于控制系统实现调姿运动。因此，本专利技术具有求解精度高，可高效快速地响应控制系统的需求。附图说明图1是本专利技术的法矢测量流程。图2是本专利技术的四面体顶点在待测曲面内的法矢求解示意图。图3是本专利技术的四面体顶点在曲面上的法矢求解示意图。图4是本专利技术的四面体顶点在待测曲面外的法矢求解示意图。具体实施方式下面结合附图和实施例对本专利技术作进一步的说明。参见示出本专利技术实施例的附图，下文将更详细地描述本专利技术。然而，本专利技术可以以许多不同形式实现，并且不应解释为受在此提出之实施例的限制。相反，提出的这些实施例是为了充分及完整公开，并且使本
的技术人员完全了解本专利技术的范围。如图1-4所示，一种基于四面体构型的距离传感器法矢测量方法，它包括以下步骤：首先，在进行待加工零件法矢测量之前，对已安装的三个激光测距传感器进行精度标定，调整激光测距传感器的装配精度，使三个激光测距传感器汇聚于同一个点，即构成一个四面体。其次，由于预先设置的三个激光测距传感器构成的四面体在空间中的尺寸有限，且激光测距传感器测量精度与测量距离呈反比，因此，驱动机床或机器人，使得激光测量传感器与待检测零件初步实现法矢对准，并调整至适当距离，满足距离约束条件。第三，利用三个激光测距传感器所测的值，进行法矢算法的选择，如本文档来自技高网...

【技术保护点】
一种基于四面体构型的距离传感器法矢测量方法，其特征是它包括以下步骤：首先，在机床或机器人的末端执行器上安装呈等边三角形布置的三个激光测距传感器，并且固定三个激光测距传感器的测量方向，使得其激光束汇聚于同一点，由三个激光测距传感器和所述的汇聚点共同构成一个空间四面体；将坐标原点建立在刀具末端点，三个激光测距传感器呈正三角形分布在刀具四周；其次，利用空间四面体顶点与待测曲面的三种位置关系：顶点在曲面内、顶点在曲面上、顶点在曲面外，结合激光测距传感器测量的数值，求得待测制孔曲面上待制孔中心点的法矢n；最后，根据上述测量计算所得到的待制孔中心点的法矢信息，通过反解算法，求得机床或机器人各轴的驱动量，用于控制系统实现调姿运动，使刀具轴线与求得的法矢一致。

【技术特征摘要】
1.一种基于四面体构型的距离传感器法矢测量方法，其特征是它包括以下步骤：首先，在机床或机器人的末端执行器上安装呈等边三角形布置的三个激光测距传感器，并且固定三个激光测距传感器的测量方向，使得其激光束汇聚于同一点，由三个激光测距传感器和所述的汇聚点共同构成一个空间四面体；将坐标原点建立在刀具末端点，三个激光测距传感器呈正三角形分布在刀具四周；其次，利用空间四面体顶点与待测曲面的三种位置关系：顶点在曲面内、顶点在曲面上、顶点在曲面外，结合激光测距传感器测量的数值，求得待测制孔曲面上待制孔中心点的法矢n；最后，根据上述测量计算所得到的待制孔中心点的法矢信息，通过反解算法，求得机床或机器人各轴的驱动量，用于控制系统实现调姿运动，使刀具轴线与求得的法矢一致。2.根据权利要求1所述的方法，其特征是：为了使得待测制孔曲面法矢n的测量结果更加精确，作如下条件约束：lmin≤li≤lmax(i＝1,2,3)式中li为三个激光测距传感器激光发射点到待测制孔曲面的距离，lmin和lmax分别为满足制孔法矢精度要求时li的最小距离和最大距离，其具体数值可由激光测距传感器激光发射点到激光束汇聚点的距离和待制孔法矢的精度等级求出；当li满足上述约束后，待测制孔曲面的法矢n应根据四面体顶点在待测曲面内、四面体顶点在待测曲面外和四面体顶点在待测曲面上三种情况具体求解。3.根据权利要求1所述的方法，其特征是四面体顶点在待测曲面内时，设定xt方向为过坐标原点Ot点平行于AB且由A指向B方向，yt方向为OtC方向，zt方向根据右手定理获得；首先，根据设计和安装，确定三个激光测距传感器的安装位置，并使得三个激光测距传感器三条激光汇聚于一点D，即在激光测距传感器对曲面法矢进行测量之前，通过机械结构及装配保证四面体D-ABC构型已知；则A、B、C在Otxtytzt坐标系下的坐标分别为AC(0,CD·cos∠DCOt,0)，当待检测位置所在曲面与四面体相交，根据几何关系可以求得：A1(-A1D·cos∠DAOt·cos∠OtAB,-A1D·cos∠DAOt·sin∠OtAB,AA1·sin∠DAOt)B1(B1D·cos∠DBOt·cos∠OtBA,1B1D·cos∠DBOt·sin∠OtBA,BB1·sin∠DBOt)C1(0,DC1·cos∠DCOt,CC1·sinDCOt)令A1(xa1,ya1,za1)，B1(xb1,yb1,zb1)，C1(xc1,yc1,zc1)，则A1B1(xb1-xa1,yb1-ya1,zb1-za1)，A1C1(xc1-xa1,...

【专利技术属性】
技术研发人员：陈文亮，潘国威，齐振超，王珉，丁力平，屈龙强，
申请(专利权)人：南京航空航天大学，
类型：发明
国别省市：江苏;32