被约束体微小姿态动态测试装置以及解算方法与流程

本发明涉及微小姿态动态测试领域，具体是一种被约束体微小姿态动态测试装置以及解算方法，通过对被约束体安装加速度测试装置和激光阵列发射装置，设计相应的光电位置传感阵列接收装置，组成微小姿态的动态测试系统。实现对狭窄空间内被约束体的加速度、速度、位移、俯仰角、偏摆角、滚动角等姿态参数的全过程测试和解算。

背景技术：

被约束体微小姿态的动态测试，要求在不干扰被约束体状态性质的前提下测试其全过程动态姿态变化。考虑到这些直观环境，对测试系统要求具备特性进行总结：要求测试系统具有测试短时间动态参量和丰富频率成分的高性能；要求测试系统在能在被约束体上安装的前提下还需保证测试装置不能破坏和影响被约束体的运动规律；要求测试系统考虑测试中测试装置的重复使用，采取有效的措施来提高测试系统的抗高过载性能；要求测试系统能通过数据处理得到有关姿态的多参数高精度表述。

目前，主要国内外对于动态姿态的测试方法，包括微波干涉法、视觉坐标测量法、激光反射测轴心姿态等。微波干涉法有一定的局限性，会受到微波自身波长的影响，当被测对象的运动速度比较小时，使用该方法得到测量结果的准确度就相对较低。视觉坐标测量法由于高速摄影技术空间分辨率有限，在测量精度上难以满足要求，同时摄影设备在测试中使用不稳定，引入的误差掩盖微小姿态测试信号。激光反射测轴心姿态多次使用平面镜反射激光，使得光路复杂，对测试顺利完成要求高，所获取的数据量太少，难以用于后续的分析与处理，不易求解轴心姿态，同时测试参数单一，无法做到对多参数(如：位移、俯仰角、偏摆角、滚动角)的参数解算。

技术实现要素：

本发明为了解决对处于持续微小姿态变化运动状态的被约束体姿态进行测试的问题，同时克服现有微波干涉法测试应用的局限性，视觉坐标测量测量精度的不足，激光反射测试参数单一的问题，本发明提供一种微小姿态动态变化测试及解算方法。使用加速度测试装置测试被约束体的加速度参数，采用高精度的光电传感器阵列接收激光阵列传达的轨迹信息，对被约束体的加速度、速度、位移、俯仰角、偏摆角、滚动角等姿态参数的全过程测试和解算。

本发明是通过以下技术方案实现的：被约束体微小姿态动态测试装置，包括安装于被约束体上的加速度测试传感器，安装于被约束体被约束体尾部上的激光阵列发射装置，安装于约束体尾部外侧的光电位置阵列接收装置，

所述激光阵列发射装置包括激光发射器ⅰ、激光发射器ⅱ以及外围电路，所述光电位置阵列接收装置包括二维光电位置传感器ⅰ、二维光电位置传感器ⅱ以及外围电路，所述二维光电位置传感器ⅱ相对于二维光电位置传感器ⅰ更加靠近被约束体，且二维光电位置传感器ⅰ与二维光电位置传感器ⅱ相互错开，二维光电位置传感器ⅱ与激光发射器ⅱ相对，二维光电位置传感器ⅰ与激光发射器ⅰ相对，所述二维光电位置传感器ⅰ和二维光电位置传感器ⅱ之间相平行且均位于垂直平面内。

本发明进一步提供了一种被约束体微小姿态动态测试解算方法，该解算方法是通过所述的被约束体微小姿态动态测试装置实现的，

所述解算方法包括：

s1，确定参数

运动状态的被约束体相比初始位置的俯仰角记为θ2、偏摆角记为θ1、滚动角记为θ3，运动状态的被约束体相比初始位置在垂直方向位移记为y，运动状态的被约束体相比初始位置在水平方向位移记为x，运动状态的被约束体相比初始位置在轴向位移记为z，建立x、y、z坐标体系，加速度测试传感器输出加速度记为az，两二维光电位置传感器之间的间距记为l，二维光电位置传感器ⅱ与被约束体初始位置的距离记为d，二维光电位置传感器ⅰ接收激光发射器ⅰ的激光信号，并输出轨迹坐标(x1,y1)，二维光电位置传感器ⅱ接收激光发射器ⅱ的激光信号，并输出轨迹坐标(x2,y2)；

s2，解算步骤

①通过对加速度az积分计算轴向位移z：

②根据三角几何性质，在二维光电位置传感器ⅱ虚拟放置二维光电位置传感器ⅲ，虚拟的二维光电位置传感器ⅲ接收激光发射器ⅰ发射的激光光路m，输出轨迹坐标(x3,y3)，

在yoz平面，根据相似三角形定理，虚拟的二维光电位置传感器ⅲ的输出轨迹坐标y3减去垂直方向位移y的值与二维光电位置传感器ⅰ的输出轨迹坐标y1减去垂直方向位移y的值之间具有比例关系：

同理用于xoz平面：

二维光电位置传感器ⅱ输出的轨迹坐标(x2,y2)，二维光电位置传感器ⅲ输出的轨迹坐标(x3,y3)，通过δx、δy利用三角函数计算滚动角θ3：

③计算偏摆角θ1和俯仰角θ2：

④计算水平方向位移x和垂直方向位移y：

x＝x2-δx-(z+d)tanθ1

y＝y2+δy-(z+d)tanθ2

综合利用步骤②、③、④中的公式运算获得运动状态的被约束体的位移、θ1、θ2、θ3。本发明相对于现有技术具有如下有益效果：

1.测试装置对被测对象的空气动力学没有影响，同时环境因素对测试过程以及结果的影响小；

2.高精度，针对量程改变装置的安装距离，可以使得测试精度优于1″；

3.利用光学杠杆原理对各参数实现不同的增益，采集的光路轨迹根据不同增益完成对各参数的解耦，能完成对姿态的多个参数经行解算。

4.通过对被约束体安装的加速度测试装置和激光阵列发射装置，使用对应设计的光电位置传感阵列接收装置，实现对狭窄空间内被约束体的加速度、速度、位移、俯仰角、偏摆角、滚动角等姿态参数的全过程测试和解算。

附图说明

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

图1为本发明所述被约束体微小姿态动态测试装置的原理图。

图2为参数的定义图。

图3为各二维光电位置传感器的布置示意图。

图4为yoz平面计算示意图。

图5为xoy平面计算示意图。

图中：1-激光发射器ⅰ，2-被约束体，3-加速度测试传感器，4-约束体，5-激光阵列发射装置，6-激光发射器ⅱ，7-光电位置阵列接收装置，8-二维光电位置传感器ⅰ，9-二维光电位置传感器ⅱ，10-二维光电位置传感器ⅲ。

具体实施方式

为使本发明的目的、技术方案和优点更加清楚，下面将对本发明的技术方案进行详细的描述。显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动的前提下所得到的所有其它实施方式，都属于本发明所保护的范围。

下面结合附图对本发明的技术方案进行详细的说明。

被约束体微小姿态动态测试装置，包括安装于被约束体2上的加速度测试传感器3，安装于被约束体2被约束体2尾部上的激光阵列发射装置5，安装于约束体4尾部外侧的光电位置阵列接收装置7，

所述激光阵列发射装置5包括激光发射器ⅰ1、激光发射器ⅱ6以及外围电路，所述光电位置阵列接收装置7包括二维光电位置传感器ⅰ8、二维光电位置传感器ⅱ9以及外围电路，所述二维光电位置传感器ⅱ9相对于二维光电位置传感器ⅰ8更加靠近被约束体2，且二维光电位置传感器ⅰ8与二维光电位置传感器ⅱ9相互错开，二维光电位置传感器ⅱ9与激光发射器ⅱ6相对，二维光电位置传感器ⅰ8与激光发射器ⅰ1相对，所述二维光电位置传感器ⅰ8和二维光电位置传感器ⅱ9之间相平行且均位于垂直平面(如下坐标体系的xoy平面)内。

在本发明中，所述被约束体2与约束体4之间呈间隙配合。其中，所述激光阵列发射装置5的外围电路包括电源电路，所述光电位置阵列接收装置7的外围电路包括电源电路、模拟信号调理电路和数字信号存储电路。这些外围电路是本领域技术人员容易实现的。

为了更清楚的说明本发明的测试装置，本发明进一步提供了一种被约束体微小姿态动态测试解算方法，该解算方法是通过所述的被约束体微小姿态动态测试装置实现的，

所述解算方法包括：

s1，确定参数

运动状态的被约束体2相比初始位置的俯仰角记为θ2、偏摆角记为θ1、滚动角记为θ3，运动状态的被约束体2相比初始位置在垂直方向位移记为y，运动状态的被约束体2相比初始位置在水平方向位移记为x，运动状态的被约束体2相比初始位置在轴向位移记为z，建立x、y、z坐标体系，加速度测试传感器3输出加速度记为az，两二维光电位置传感器之间的间距记为l，二维光电位置传感器ⅱ9与被约束体2初始位置的距离记为d，二维光电位置传感器ⅰ8接收激光发射器ⅰ1的激光信号，并输出轨迹坐标(x1,y1)，二维光电位置传感器ⅱ9接收激光发射器ⅱ6的激光信号，并输出轨迹坐标(x2,y2)；

其中，所述俯仰角θ2所在的平面位于垂直方向的yoz平面内，所述偏摆角θ1所在的平面位于水平面内(xoz平面)，所述滚动角θ3所在的平面位于垂直方向的xoy平面内，具体可参见图2所定义的方向。激光发射器ⅰ1输出的轨迹坐标(x1,y1)的坐标原点为初始位置的被约束体2的激光发射器ⅰ1在二维光电位置传感器ⅰ8上的初始激光信号点。激光发射器ⅱ6输出的轨迹坐标(x2,y2)的坐标原点为初始位置的被约束体2的激光发射器ⅱ6在二维光电位置传感器ⅱ9上的初始激光信号点。

s2，解算步骤

①通过对加速度az积分计算轴向位移z：

加速度az积分可获得运动状态的被约束体2的速度v，速度v再积分获得轴向位移z。

②根据三角几何性质，在二维光电位置传感器ⅱ9虚拟放置二维光电位置传感器ⅲ10，虚拟的二维光电位置传感器ⅲ10接收激光发射器ⅰ1发射的激光光路m，输出轨迹坐标(x3,y3)。

其中，所述虚拟的二维光电位置传感器ⅲ10的竖直方向上与二维光电位置传感器ⅱ9位于同一平面内，且位于二维光电位置传感器ⅱ9的上方，虚拟的二维光电位置传感器ⅲ10在水平方向上位于二维光电位置传感器ⅰ8与激光发射器ⅰ1之间，如图3所示。所述轨迹坐标(x3,y3)的坐标原点为初始位置的被约束体2的激光发射器ⅰ1在二维光电位置传感器ⅰ8上的激光信号在虚拟的二维光电位置传感器ⅲ10上所对应的点。

在yoz平面，根据相似三角形定理，虚拟的二维光电位置传感器ⅲ的输出轨迹坐标y3减去垂直方向位移y的值与二维光电位置传感器ⅰ的输出轨迹坐标y1减去垂直方向位移y的值之间具有比例关系：

同理用于xoz平面：

二维光电位置传感器ⅱ9输出的轨迹坐标(x2,y2)，虚拟的二维光电位置传感器ⅲ10输出的轨迹坐标(x3,y3)，如图5所示，通过δx、δy利用三角函数计算滚动角θ3：

③计算偏摆角θ1和俯仰角θ2：

④计算水平方向位移x和垂直方向位移y：

x＝x2-δx-(z+d)tanθ1

y＝y2+δy-(z+d)tanθ2

综合利用步骤②、③、④中的公式运算获得运动状态的被约束体(2)的位移、θ1、θ2、θ3。

在本发明中，俯仰角θ2和偏摆角θ1测试量量程与安装距离d、l和二维光电位置传感器的尺寸有关，可以通过调整这三个值来改变量程。如果二维光电位置传感器尺寸无限大或者d无限近，那么理论是无限量程，但是分辨率会有所牺牲。当限定条件是d、l为2.5m，各个二维光电位置传感器20×20mm，不考虑滚动角θ3，这时的俯仰角θ2和偏摆角θ1测试量程是±0.06°，分辨率优于1″。滚动角θ3测试量量程与二维光电位置传感器的尺寸和两个激光发射器安装间距有关，如果二维光电位置传感器尺寸无限大或者安装间距无限近，那么理论是无限量程，当限定条件是传感器20×20mm，安装间距80mm，不考虑俯仰角θ2和偏摆角θ1，这时的旋转角θ3测试量程是±14°，分辨率优于1″。总的说就是可以改变量程以适应测试需求，上面的数据(俯仰角θ2、偏摆角θ1、滚动角θ3的量程)是我们在上述测试条件(d、l以及二维光电位置传感器的尺寸)下获得的数据。当改变上述测试条件后，相应的俯仰角θ2、偏摆角θ1、滚动角θ3的量程也会发生变化。

以上所述，仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应以所述权利要求的保护范围为准。