专利名称：空间六自由度运动的六位移传感器动态测量法的制作方法
技术领域：
本发明涉及一种空间六自由度运动的六位移传感器动态测量法，利用六位移传感器并联对运动物体进行空间六自由度运动的动态测量。空间六自由度运动包括三自由度运动位移X (t)、y (t)、z (t)及三自由度运动角度0 X (t)、0 y (t)、0 z (t),运动位移及角度微分后可转换成运动速度、运动加速度、运动角速度、运动角加速度。
背景技术：
现有工业、军事对物体空间运动的测量 要求越来越高，并且环境越来越复杂，利用原有的测量方式，已不能满足测量精度、环境、频率、耦合等要求。比如进行火箭弹飞行试验时，发射产生的大推力、强冲击、高温高压、气浪等一系列原因使发射装置处于恶劣的环境中，发射装置对火箭弹(导弹)发射的初始扰动影响其飞行轨迹、命中精度及密集度，甚至导致整个部队的战斗力下降。这就需要有一种能够适应特殊环境下的测量机构，能够精确测量出测量点的六个自由度移动量，需要对发射过程中的初始扰动各主要因素进行动态测试和研究，尤其需要能够适应特殊环境下的全程准确测量发射装置空间六自由度运动(轴向移动、平移、升沉、俯仰、偏航、滚转)的测量方法及装置。精度是衡量测量装置或方法的主要标准之一，但目前如振动加速度传感器或振动速度传感器直接安装在发射装置上，经积分成速度或位移，由于量程、频响及积分误差等造成误差较大；基于机器视觉的测量受高温气浪的空气折射波动及烟雾粉尘使该方法测量误差大，不能适应发射时的烟尘、高温环境，甚至完全不能使用；采用三轴陀螺仪测量空间三轴角速度，积分成角位移，该方法不能测量三轴位移，由于量程、频响及积分误差等造成误差较大等造成误差较大。在工业、军事以及航天航空的其它工程应用中，目前国内外测量物体运动的方法并不能同时测量出运动物体的六自由度运动规律，积分误差大，测量复杂精度低，不能准确同时得到运动物体的六自由度运动。
发明内容
本发明所要解决的技术问题在于提供一种空间六自由度运动的六位移传感器动态测量法，能够对运动物体同时进行空间六自由度运动高精度测量。空间六自由度运动包括三自由度运动位移X (t)、y (t)、z (t)及三自由度运动角度0 X (t)、0 y (t)、0 z (t),运动位移及角度微分后可转换成运动速度、运动加速度、运动角速度、运动角加速度。本发明的的技术方案如下一种空间六自由度运动的六位移传感器动态测量法，其特征在于包括以下步骤—种空间六自由度运动的六位移传感器动态测量法，其特征在于包括以下步骤I)搭建六位移传感器并联测量机构搭建的六位移传感器并联测量机构包括上平台、下平台和六个拉线式位移传感器，上平台和下平台上各有六个安装点用于安装拉线式位移传感器，同一平台上的六个安装点在一个圆上或者六角形的六个角处，上平台的六个安装点与下平台的六个安装点一一对应，上平台的安装点与对应的下平台的安装点之间按照最短距离原则连接拉线式位移传感器，六个拉线式位移传感器无触碰，所述下平台固定在基座上，上平台上固定被测物体，并随被测物体一起运动；2)建立坐标系在上平台上建立动坐标系o' -X' Y1 Z1 ,下平台上建立静坐标系0-xyz, Ai, Bi分别为六个拉线式位移传感器在上平台和下平台中的接触点，Ai,Bi在直角坐标系o-xyz中的向量表不分别为A (Aix, Aiy, Aiz)、B (Bix, Biy, Biz), Ii表不AiBi之间的位移,求解过程中，运动物体的六自由度 x(t)、y (t)、z (t)、0 x(t)、0 y (t)、0 z (t)表示为 x, y, z, 0 x, 0 y, 0 z,便于计算；3)位置逆解当上平台改变时，根据平面与平面上点的关系求出此时新点的坐标值A，A = T*A/ +P
权利要求
1.一种空间六自由度运动的六位移传感器动态测量法，其特征在于包括以下步骤 .1)搭建六位移传感器并联测量机构 搭建的六位移传感器并联测量机构包括上平台、下平台和六个拉线式位移传感器，上平台和下平台上各有六个安装点用于安装拉线式位移传感器，同一平台上的六个安装点在一个圆上或者六角形的六个角处，上平台的六个安装点与下平台的六个安装点--对应，上平台的安装点与对应的下平台的安装点之间按照最短距离原则连接拉线式位移传感器，六个拉线式位移传感器无触碰，所述下平台固定在基座上，上平台上固定被测物体，并随被测物体一起运动； .2)建立坐标系 在上平台上建立动坐标系o' -X' Y' Z',下平台上建立静坐标系O-XyzjpBi分别为六个拉线式位移传感器在上平台和下平台中的接触点，Ai, Bi在直角坐标系o-xyz中的向量表示分别为A(Aix，Aiy, Aiz)、B(Bix，Biy, Biz)，Ii表示AiBi之间的位移，求解过程中，运动物体的六自由度 x(t)、y (t)、z (t)、Θ x(t)、Θ y ⑴、θ ζ (t)表示为 χ, y, ζ, θ χ, θ y, θ ζ,便于计算； .3)位置逆解 当上平台改变时，根据平面与平面上点的关系求出此时新点的坐标值A，
2.根据权利要求I所述的空间六自由度运动的六位移传感器动态测量法，其特征在于所述上平台和下平台均为正六边形或圆形，上平台位于下平台的正上方。
全文摘要
本发明公开了一种空间六自由度运动的六位移传感器动态测量法，利用六位移传感器并联对运动物体进行空间六自由度运动的动态测量，主要包括构搭建六位移传感器并联测量机构、建立坐标系、坐标变换、位置逆解、位置正解等一系列步骤。测量机构包括上平台、拉线式位移传感器和下平台。测量机构构建好以后，建立适当坐标系经坐标变换找到拉线长度和上平台位姿关系，经逆解计算出初始拉线长度，再通过拉线长度的变化正解计算出被测物体空间六自由度运动的变化规律。本发明可同时测出被测运动物体六个自由度的运动规律，测量精度高，并且算法易于实现，可靠性强；应用范围广，可应用到并联机床、飞行模拟器、风洞试验模型装置、空间对接设备等国防重点领域中。
文档编号G01B21/04GK102636139SQ201210106028
公开日2012年8月15日 申请日期2012年4月12日 优先权日2012年4月12日
发明者倪卫, 宋代平, 熊迁, 王成程, 石万凯, 袁晓东, 谢志江, 谭宁, 郑万国 申请人:中国工程物理研究院激光聚变研究中心, 重庆大学