CN110873558B - 一种距离和姿态角的测量装置及测量方法 - Google Patents

Abstract

本发明属于光电测量技术领域，提供了一种距离和姿态角的测量装置及测量方法，所述测量装置包括测量设备和目标板；测量设备包括连接架，设置在所述连接架上的图像传感器、投射激光器以及光学镜头；目标板固定在被测物体上；投射激光器用于向所述目标板发出激光光束，目标板在被所述激光光束照射后，形成目标点测量点；光学镜头将所述目标点测量点成像到所述图像传感器上，所述图像传感器对所述目标点测量点的图像进行探测后发送到处理器；所述处理器根据探测数据计算被测物体到所述测量设备的距离和被测物体的姿态角。本申请在同一套光机电***中实现距离和姿态角的同时同步测量，使得测量设备结构简单，体积小，可以实现较远距离非接触测量。

Description

一种距离和姿态角的测量装置及测量方法

技术领域

本发明涉及光电测量技术领域，尤其涉及一种距离和姿态角的测量装置及测量方法。

背景技术

距离及姿态测量属于计量科学的重要组成部分，在航空航天、汽车制造、工业测量、精密加工以及仪器制造等许多领域都具有极其重要的意义和作用。由于其广泛的应用，国内外各研究单位进行了大量的研究，开发了多种测量方法。应用于距离测量的方法主要有：脉冲式激光测距技术、相位式激光测距技术以及双目交会式测距技术等。通常对距离和姿态角同时测量时，针对不同环境下的测量需求，选取其中的一种或多种技术进行组合，以满足测量需求。但以上这些方法在具体的测量环境中往往会遇到一些常见的问题，例如测量结构复杂，测量设备成本高、抗干扰性差以及测量设备体积较大，难以实现小型嵌入式设备应用等。

具体而言，虽然位置及姿态测量方法有多种，但是要实现两者的同时测量时，各自采用不同的测量手段，测量过程独立，使得测量结构非常复杂。另外采用如陀螺仪、加速度计等方法测量姿态时，往往需要多个传感器，使得设备成本增高。采用经纬仪交会测量不仅成本高而且设备体积较大，难以实现结构简单的测量。另外，现有的激光测距技术，都是基于激光点测量，如果测量背景中存在较强的干扰光源，例如太阳直射，灯光直射以及被各种反射面反射的杂光等。这些光斑形态各异，只要处于接收视场中，就会造成干扰，从而大大影响测量精度。再者，现有设备往往将测距与测量姿态分开，采用不同的传感器，数据不能共享。因此，测量设备体积相对较大。由于受到体积限制，很难将之应用于小型的嵌入式设备中，这将影响该技术在某些领域的推广应用。

故有必要提出一种新的技术方案，以解决上述技术问题。

发明内容

本发明实施例提供一种距离和姿态角的测量装置及测量方法，以解决现有距离和姿态角测量方法中存在的测量设备体积大、不能兼容嵌入式设备以及抗干扰性差的问题。

本发明实施例的第一方面提供了一种距离和姿态角的测量装置，所述测量装置包括测量设备和目标板；

所述测量设备包括连接架，设置在所述连接架上的图像传感器、投射激光器以及光学镜头，所述图像传感器和所述投射激光器处于同一水平面内，且相对位置固定；所述目标板为一具有指定反射率和大小的金属平板，固定在被测物体上；

所述投射激光器用于向所述目标板发出激光光束，所述目标板在被所述激光光束照射后，形成目标点测量点；所述光学镜头将所述目标点测量点成像到所述图像传感器上，所述图像传感器对所述目标点测量点的图像进行探测，并将探测数据发送到处理器；

所述处理器在接收到所述探测数据后，根据所述图像传感器、投射激光器以及所述目标点测量点之间的三角关系计算所述被测物体到所述测量设备的距离，通过角度标定计算所述被测物体的姿态角。

可选地，所述投射激光器发出的激光光束为十字激光光束，相应地，所述目标板在被所述激光光束照射后形成十字线，所述十字线的交叉点为所述目标测量点。

可选地，所述投射激光器为红色半导体激光器。

可选地，所述根据所述图像传感器、投射激光器以及所述目标点测量点之间的三角关系计算所述被测物体到所述测量设备的距离，包括：

获取所述图像传感器和所述投射激光器之间的直线距离AC；

根据所述目标测量点与所述图像传感器和所述投射激光器之间的位置关系绘制三角形ABC，其中A为所述图像传感器所在位置，B为所述目标测量点所在位置，C为所述投射激光器所在位置；

获取AC与BC之间的夹角α，CA与AB之间夹角β以及AB与BC之间夹角θ；

通过公式

计算所述被测物体到所述测量设备的距离BD。

所述姿态角φ采用标定的方式获得，首先根据所述图像传感器上获得的十字交叉图像，即直线a和直线b，通过图像处理获得其夹角ω，同时标定此时的所述姿态角φ，经过多次标定获得其一一对应关系。

可选地，所述处理器为通用DSP图像处理平台。

本发明实施例的第二方面提供了一种距离和姿态角的测量方法，应用于上述第一方面所述的任一项测量装置，包括：

测量装置通电后，投射激光器向目标板投射激光光束；

所述目标板在被所述激光光束照射后，形成目标点测量点；

光学镜头将所述目标点测量点成像到图像传感器上，以使所述图像传感器对所述目标点测量点的图像进行探测，并将探测数据发送到处理器；

所述处理器在接收到所述探测数据后，根据所述图像传感器、投射激光器以及所述目标点测量点之间的三角关系计算所述被测物体到所述测量设备的距离，通过角度标定计算所述被测物体的姿态角。

可选地，所述投射激光器发出的激光光束为十字激光光束，相应地，所述目标板在被所述激光光束照射后形成十字线，所述十字线的交叉点为所述目标测量点。

可选地，所述投射激光器为红色半导体激光器。

可选地，所述根据所述图像传感器、投射激光器以及所述目标点测量点之间的三角关系计算所述被测物体到所述测量设备的距离，包括：

获取所述图像传感器和所述投射激光器之间的直线距离AC；

根据所述目标测量点与所述所述图像传感器和所述投射激光器之间的位置关系绘制三角形ABC，其中A为所述图像传感器所在位置，B为所述目标测量点所在位置，C为所述投射激光器所在位置；

获取AC与BC之间的夹角α，CA与AB之间夹角β以及AB与BC之间夹角θ；

通过公式

计算所述被测物体到所述测量设备的距离BD。

可选地，所述处理器为通用DSP图像处理平台。

本发明实施例与现有技术相比存在的有益效果：本申请提供的距离和姿态角测测量装置，在同一套光机电***中实现距离和姿态角的同时同步测量，使得测量设备结构简单，体积小，可以实现较远距离非接触测量，测量距离最远可10m；采用激光法照射确定目标测量点，可以滤除图像中其它光斑的干扰，实现在日光、灯光下的全天室外测量；另外，采用主动投射激光的方法进行姿态测量，可以避免采用诸如陀螺仪、加速度计等受测量环境影响严重的传感器，使得测量数据具有更高的可靠性。

附图说明

为了更清楚地说明本发明实施例的技术方法，下面将实施例或现有技术描述中所需要的附图作简单介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图得到其他的附图。

图1为本发明实施例提供的一种距离和姿态角的测量装置的结构示意图；

图2为本发明提供的测量原理图；

图3为本发明实施例提供的姿态角测量原理图；

图4为本发明另一实施例提供的距离和姿态角的测量方法实现流程示意图。

具体实施方式

以下描述中，为了说明而不是为了限定，提出了诸如特定结构、技术之类的具体细节，以便透彻理解本发明提供的实施例。然而，本领域技术人员应当清楚，在没有这些具体细节的其他实施例中也可以实现本发明。在其他情况中，省略对众所周知的***、装置、电路以及方法的详细说明，以免不必要的细节妨碍本发明的描述。

图1是本发明实施例提供的一种距离和姿态角的测量装置示意图，该装置包括测量设备1和目标板2；

所述测量设备1包括连接架11，设置在所述连接架上的图像传感器12、投射激光器13以及光学镜头14，所述图像传感器12和所述投射激光器13处于同一水平面内，且相对位置固定；所述目标板2为一具有指定反射率和大小的金属平板，固定在被测物体上；

所述投射激光器13用于向所述目标板2发出激光光束，所述目标板2在被所述激光光束照射后，形成目标点测量点；所述光学镜头14将所述目标点测量点成像到所述图像传感器12上，所述图像传感器12对所述目标点测量点的图像进行探测，并将探测数据发送到处理器15；

所述处理器15在接收到所述探测数据后，根据所述图像传感器12、投射激光器13以及所述目标点测量点之间的三角关系计算所述被测物体到所述测量设备的距离，通过角度标定计算所述被测物体的姿态角。

具体地，本发明的距离及姿态角测量装置组成如附图1所示，因为需要测量两个相距较远点的相对距离及姿态角，因此分为测量装置和目标板两部分。测量设备主要包括光学镜头14、图像传感器12、处理平台15、投射激光器13以及用于承载的连接架11；目标板2只包含合作目标板21。

进一步地，光学镜头14可以选择成熟的工业镜头，根据测量环境选择适当的焦距和口径即可，本例采用200mm焦距，20mm口径的光学镜头。图像传感器12同样可以选择通用工业相机，根据测量环境选择适当的像元大小及分辨率，本例选择6μm像元大小，1024×1024分辨率相机。处理平台15为通用DSP图像处理平台，可以实时采集图像数据。投射激光器13采用十字激光光束。连接架11为定制机械框架，主要作用是承载以上部件并保持结构稳定。目标板2为光滑平整具有一定反射率的金属平板。本例采用铝板喷漆，对激光光波段反射率为10％的平板。

下面结合附图对本发明主要部件构造作进一步详细说明，整个***主要部件构造及其功能如下所示：

测量设备1部分为测量装置主体部分，完成的功能为投射激光光束，优选为，投射出十字线激光，接收目标板反射回的图像并对其进行数据处理，获得测量结果。下面对各个组成部分进行详细介绍。

光学镜头14、图像传感器12和投射激光器13安装并固定于连接架11上，处理平台15可以安装在连接架11上，也可以设置在其他位置。其中图像传感器12和投射激光器13为测量主要执行部件，其安装位置及角度对测量精度有直接的影响。其安装位置点如附图2所示。

图2中xCy平面为水平面，点A为投射激光器13发光点位置，点B为激光十字线中心照射到目标板2上像点，AB方向为激光投射方向；点C为图像探测器等效中心，CB方向为光学镜头光轴方向。

投射激光器13为测量提供十字线标记，可以采用红色半导体激光器。既保证清晰可探测，又具有良好的大气透过性。光源功率推荐为1mW，既具有较高的强度，又可以保证测量范围内不会造成人眼伤害。

光学镜头14是成像部件，将投射到目标板上的十字线图像成像到图像传感器上，其成像质量和焦距长度是测量精度的主要决定因素。根据所需测量距离及测量精度要求选择合适焦距。

图像传感器12采集通过光学镜头成像的十字线图像数据，并将该数据发送到处理平台15。图像传感器12的主要参数是图像分辨率和像元大小，根据需要测量距离范围选择，在10m测量范围内，推荐1024×1024分辨率，像元大小6μm。处理平台15需要具有图像输入接口并且具有图像处理能力的硬件平台，可以采用DSP处理平台。

目标板2放置于被测点，是具有一定反射率的平板。该平板需要具有一定的大小，以保证投射激光器投射出十字线激光能够投射到该平面上，表面平整，投射激光器投射出十字线激光打在合作目标板上，形成一个具有一定夹角的十字图像。该平板通过调节水平的方式保证垂直于水平面。

图4示出了本申请提供的测量装置对应的测量方法的流程图，包括：

步骤41，测量装置通电后，投射激光器向目标板投射激光光束。

步骤42，所述目标板在被所述激光光束照射后，形成目标点测量点。

步骤43，光学镜头将所述目标点测量点成像到图像传感器上，以使所述图像传感器对所述目标点测量点的图像进行探测，并将探测数据发送到处理器；

步骤44，所述处理器在接收到所述探测数据后，根据所述图像传感器、投射激光器以及所述目标点测量点之间的三角关系计算所述被测物体到所述测量设备的距离，通过角度标定计算所述被测物体的姿态角。

具体地，本申请的测量对象分别为目标点到测量端的距离和目标点平面同测量端平面间夹角。结合附图2-3对距离测量原理进行介绍：

根据三角形关系可以看出，BD即为目标到测量设备间的距离。其计算公式如下：

其中，AC是固定值可以精确标定出数值，β是固定值可以精确标定出数值，α角通过图像传感器位置进行计算，θ角通过三角形内角和进行计算。

目标板通过调节水平的方式垂直地面放置，因此其姿态φ角为一维量，即沿垂直于地面的旋转角。由于该角度的变换会同步影响激光十字线的夹角，因此该角度量的测量采用标定的方法，即分别测量激光十字线的夹角和相对应的旋转角，通过数据拟合的方法确定其对应关系。目前这种一维姿态角测量方法主要有自准直法、双目测量法和光电编码器法。自准直法测量精度高，但测量范围很小；双目测量测量精度较高，测量范围较大，缺点是设备较为庞大，需要较长基线，通常作为单独设备使用，很少能集成到单个设备中；光电编码器测量精度高，但是属于非接触测量，不能实现空间远距离测量。

因此，本例采用标定的方法获得姿态角。首先根据所述图像传感器上获得的十字交叉图像，即直线a和直线b，通过图像处理获得其夹角ω，同时标定此时的所述姿态角φ，经过多次标定获得其一一对应关系。

结合图4介绍具体测量过程：

通电后，投射激光器投射出十字激光光束到目标板，测量端通过光学镜头接收目标板上的十字激光图像。图像传感器采集图像信息，产生数据并发送到就处理平台。处理平台进行软件处理，首先，将获取到的十字线图像进行边缘处理，获得十字线边缘，拟合这两条线得到相交点图像数据。然后，对该交点数据进行重心处理，获得交点的位置坐标，根据该坐标计算可得∠DCB大小，用于距离计算。接着，通过图像处理获取两直线的斜率，并计算两条直线的夹角，通过该夹角进行姿态角测量。将处理好的结果输出显示。

经过搭建实验平台后多次试验表明，该发明方法测量可行，精度符合预期效果；距离量测量范围：1m～10m；距离量测量精度：0.02mm；姿态角度测量范围：±5°；姿态角度测量精度为：1′。

需要说明的是，本发明采用的光学镜头、图像传感器及投射激光器均为可购买到的通用工业设备，如果对测量设备体积重量有要求可以进行定制。其中光学镜头焦距、口径均可适当修改；图像传感器像面大小可以更改为更大面阵的器件；投射激光器也可以根据需要对波长进行更改。

本申请提供的距离和姿态角测测量装置，在同一套光机电***中实现距离和姿态角的同时同步测量，使得测量设备结构简单，体积小，可以实现较远距离非接触测量，测量距离最远可10m；采用激光法照射确定目标测量点，可以滤除图像中其它光斑的干扰，实现在日光、灯光下的全天室外测量；另外，采用主动投射激光的方法进行姿态测量，可以避免采用诸如陀螺仪、加速度计等受测量环境影响严重的传感器，使得测量数据具有更高的可靠性。

以上实施例仅用于对本发明进行说明，而非限定；尽管参照前述实施例对本发明进行了详细说明，本领域普通技术人员应该理解：其依然可以对前述各实施例所记载的技术方案进行修改，或对其中部分技术特征进行等同替换；而这些修改或替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。

Claims (9)

1.一种距离和姿态角的测量装置，其特征在于，所述测量装置包括测量设备和目标板；

所述测量设备包括连接架，设置在所述连接架上的图像传感器、投射激光器以及光学镜头，所述图像传感器和所述投射激光器处于同一水平面内，且相对位置固定；所述目标板为一具有指定反射率和大小的金属平板，固定在被测物体上；

所述投射激光器用于向所述目标板发出激光光束，所述目标板在被所述激光光束照射后，形成目标点测量点；所述光学镜头将所述目标点测量点成像到所述图像传感器上，所述图像传感器对所述目标点测量点的图像进行探测，并将探测数据发送到处理器；

所述处理器在接收到所述探测数据后，根据所述图像传感器、投射激光器以及所述目标点测量点之间的三角关系计算所述被测物体到所述测量设备的距离，通过处理所述图像传感器上获得的十字线的夹角，同时标定此时被测物体的姿态角，并多次标定获得其一一对应关系的角度标定方法，计算所述被测物体的姿态角，图像探测器等效中心与所述目标板上像点连线方向为光学镜头光轴方向；

所述投射激光器发出的激光光束为十字激光光束，相应地，所述目标板在被所述激光光束照射后形成所述十字线，所述十字线的交叉点为目标测量点，利用所述交叉点的位置坐标计算出反射角大小，用于距离计算。

2.根据权利要求1所述的距离和姿态角的测量装置，其特征在于，所述投射激光器为红色半导体激光器。

3.根据权利要求2所述的距离和姿态角的测量装置，其特征在于，所述根据所述图像传感器、投射激光器以及所述目标点测量点之间的三角关系计算所述被测物体到所述测量设备的距离，包括：

获取所述图像传感器和所述投射激光器之间的直线距离AC；

根据所述目标测量点与所述图像传感器和所述投射激光器之间的位置关系绘制三角形ABC，其中A为所述图像传感器所在位置，B为所述目标测量点所在位置，C为所述投射激光器所在位置；

获取AC与BC之间的夹角为反射角α，CA与AB之间夹角β以及AB与BC之间夹角θ；

通过公式

计算所述被测物体到所述测量设备的距离BD。

4.根据权利要求3所述的距离和姿态角的测量装置，其特征在于，所述处理器为通用DSP图像处理平台。

5.一种距离和姿态角的测量方法，其特征在于，应用于如权利要求1-4任一项所述的测量装置，包括：

测量装置通电后，投射激光器向目标板投射激光光束；

所述目标板在被所述激光光束照射后，形成目标点测量点；

光学镜头将所述目标点测量点成像到图像传感器上，以使所述图像传感器对所述目标点测量点的图像进行探测，并将探测数据发送到处理器；

所述处理器在接收到所述探测数据后，根据所述图像传感器、投射激光器以及所述目标点测量点之间的三角关系计算所述被测物体到所述测量设备的距离，通过角度标定计算所述被测物体的姿态角。

6.根据权利要求5所述的距离和姿态角的测量方法，其特征在于，所述投射激光器发出的激光光束为十字激光光束，相应地，所述目标板在被所述激光光束照射后形成十字线，所述十字线的交叉点为所述目标测量点。

7.根据权利要求5或6所述的距离和姿态角的测量方法，其特征在于，所述投射激光器为红色半导体激光器。

8.根据权利要求7所述的距离和姿态角的测量方法，其特征在于，所述根据所述图像传感器、投射激光器以及所述目标点测量点之间的三角关系计算所述被测物体到所述测量设备的距离，包括：

获取所述图像传感器和所述投射激光器之间的直线距离AC；

根据所述目标测量点与所述图像传感器和所述投射激光器之间的位置关系绘制三角形ABC，其中A为所述图像传感器所在位置，B为所述目标测量点所在位置，C为所述投射激光器所在位置；

获取AC与BC之间的夹角α，CA与AB之间夹角β以及AB与BC之间夹角θ；

通过公式

计算所述被测物体到所述测量设备的距离BD。

9.根据权利要求7所述的距离和姿态角的测量方法，其特征在于，所述处理器为通用DSP图像处理平台。

Images