专利名称：一种用于测量陀螺仪静平衡的基于双目视觉的空间位姿测量装置的制作方法
技术领域：
本发明涉及一种静平衡的测量装置，更特别地说，是指一种基于双目原理的、用于测量陀螺仪静平衡空间位姿的测量装置。
背景技术：
陀螺仪工作原理基于高速旋转刚体的运动轴所指的方向在不受外力影响时，相对于惯性空间是不会改变的。它能利用高速回转体的动量矩测量壳体相对惯性空间内的绕正交于自转轴的一个或二个轴的角运动的特殊检测装置。由于其检测结果不依赖于外界参考信号，陀螺仪在航空、航天、航海以及陆地自主导航上存在着广泛和难以替代的作用。
陀螺仪的质量不平衡会使其输出信号产生很大的零位误差(零漂)，而零位误差是影响惯性系统性能的最重要因素之一。因此，在陀螺仪的生产过程中，必须对其进行静平衡测试。传统的静平衡测试都是人工基于肉眼或者经纬仪实施，精度很难得到保证，生产效率也十分低。发明内容
本发明的目的是提供一种用于测量陀螺仪静平衡的基于双目视觉的空间位姿测量装置，该静平衡测量装置通过在三个方向对陀螺仪转子进行图像跟踪和识别，从而实现对陀螺仪转子的非接触式、高精度、高速实时测量。
本发明的一种用于测量陀螺仪静平衡的基于双目视觉的空间位姿测量装置，该测量装置包括有用于采集被测试样GO)的X轴方向上图像信息的X轴图像采集组件(10)、 用于采集被测试样GO)的Z轴方向上图像信息的Z轴图像采集组件(30)、以及支撑架(1) 和背景板；
支撑架(1)为一框形结构，支撑架(1)的第一板面(IA)的外侧上安装有第一丝杠架(11)；支撑架(1)的第二板面(IB)的外侧上安装有第四背景板(5)；支撑架(1)的第三板面(IC)的内侧上安装有第一背景板O)；支撑架(1)的第四板面(ID)的内侧上安装有第三背景板(3)；支撑架(1)的底板面(IE)上安装有第三背景板；支撑架(1)的上顶上安装有第五丝杠架(15)；
X轴图像采集组件(10)包括有第一丝杠架(11)、第一丝杠(11B)、第一电机 (IlA)、第二丝杠架(12)、第二丝杠(12B)、第二电机(12A)、第一滑块(21)、第二滑块(22) 和第一摄像头(17)；所述第一摄像头(17)用于采集被测试件GO)的主视第一丝杠(IlB)的一端安装在第一丝杠架(11)的A侧板(IlC)的A滚珠轴承 (IlE)内，该A滚珠轴承(IlE)安装在A侧板(IlC)的A通孔(IlF)内；第一丝杠(IlB)的另一端通过联轴器与第一电机(IlA)的输出轴连接；第一电机(IlA)安装在第一丝杠架(11) 的B侧板(IlD)上；
第二丝杠(12B)的一端安装在第二丝杠架(12)的A侧板(12C)的B滚珠轴承(12E)内，该B滚珠轴承(12E)安装在A侧板(12C)的B通孔(12F)内，第二丝杠(12B)的另一端通过联轴器与第二电机(12A)的输出轴连接；第二电机(12A)安装在第二丝杠架(12) 的B侧板(12D)上；
第一滑块安装在第二丝杠架(1 的背部，且第一滑块上的中心丝杠孔用于第一丝杠(IlB)穿过；第二滑块0 上安装有第一摄像头(17)；且第二滑块02)上的中心丝杠孔用于第二丝杠(12B)穿过；
Z轴图像采集组件(30)包括有第五丝杠架(15)、第五丝杠(15B)、第五电机 (15A)、第六丝杠架(16)、第六丝杠(16B)、第六电机(16A)、第五滑块(25)、第六滑块(26), 第二摄像头(18)、第三摄像头(19)和摄像头支架OO)；
摄像头支架OO)安装在第六滑块06)上，摄像头支架OO)上安装有第二摄像头 (18)和第三摄像头(19)，第二摄像头(18)用于采集被测试件GO)的左俯视图，第三摄像头(19)用于采集被测试件GO)的右俯视第五丝杠(15B)的一端安装在第五丝杠架(15)的A侧板(15C)的E滚珠轴承 (15E)内，该E滚珠轴承(15E)安装在A侧板(15C)的E通孔(15F)内，第五丝杠(15B)的另一端通过联轴器与第五电机(15A)的输出轴连接；第五电机(15A)安装在第五丝杠架(15) 的B侧板(15D)上；
第六丝杠(16B)的一端安装在第六丝杠架(16)的A侧板(16C)的F滚珠轴承 (16E)内，该F滚珠轴承(16E)安装在A侧板(16C)的F通孔(16F)内，第六丝杠(16B)的另一端通过联轴器与第六电机(16A)的输出轴连接；第六电机(16A)安装在第六丝杠架(16) 的B侧板(16D)上；
第五滑块0 安装在第六丝杠架(16)的背部，且第五滑块0 上的中心丝杠孔用于第五丝杠架(1 穿过；第六滑块06)上安装有摄像头支架(20)，且第六滑块06)上的中心丝杠孔用于第六丝杠(16B)穿过。
所述的用于测量陀螺仪静平衡的基于双目视觉的空间位姿测量装置，其四个电机的运动方式为通过第一电机(IlA)和第二电机(12A)分别控制第一丝杠(11)和第二丝杠 (12)产生同步运动，从而推动第一滑块和第二滑块(22)，使第一摄像头(17)产生Y 和Z方向上的联动；通过第五电机(15A)和第六电机(16A)分别控制第五丝杠(1 和第六丝杠(16)产生同步运动，从而推动第五滑块0 和第六滑块(沈)，使第二摄像头(18)和第三摄像头(19)产生X和Z方向上的联动。
本发明基于双目视觉的空间位姿测量装置的优点在于
(1)由于本测量装置基于视觉测量，无需和被测试样(陀螺仪)产生直接接触，因此不会对被测试样的姿态变化产生干扰，对于提高测量精度及其有利。
(2)由于目前视觉测量技术能达到亚像素的级别，利用该技术设计的静平衡测量装置的精度远远高于目前的人工测量方法。
(3)该测量装置能实现陀螺仪转子的动态、高速、实时测量，对于提高检测以及生产效率有巨大帮助。
(4)采用空腔六面体结构的支撑架作为空间位置定位，以及三个丝杠架与支撑架的垂直安装，保证了分布在三个轴位置上的摄像头对图像信息(正视图、侧视图、俯视图) 的采集。
(5)每个轴上的两个丝杠架采用两两垂直安装，有利于安装在丝杠架上的摄像头在安装面内运动，从而实现不同视角的图像采集。
图1是本发明静平衡测量装置的结构图。
图IA是未装配支撑架的本发明静平衡测量装置的结构图。
图IB是本发明支撑架的结构图。
图2是本发明X轴图像采集组件的结构图。
图3是本发明Z轴图像采集组件的结构图。
图4A是采用本发明测量装置中三个摄像头采集图像的示意图。
图4B是被测试件为圆柱、以及圆柱展开后的示意图。
图中编号1.支撑架；1A.第一板面；1B.第二板面；1C.第三板面；1D.第四板面； 1E.底板面；2.第一背景板；3.第二背景板；4.第三背景板；5.第四背景板；11.第一丝杠架；11A.第一电机；11B.第一丝杠；11C. A侧板；1 ID. B侧板；1 IE. A滚珠轴承；1 IF. A通孔； 12.第二丝杠架；12A.第二电机；12B.第二丝杠；12C.A侧板；12D.B侧板；12E.B滚珠轴承； 12F.B通孔；15.第五丝杠架；15A.第五电机；15B.第五丝杠；15C.A侧板；15D.B侧板；15E. E滚珠轴承；15F.E通孔；16.第六丝杠架；16A.第六电机；16B.第六丝杠；16C.A侧板；16D. B侧板；16E.F滚珠轴承；16F.F通孔；17.第一摄像头；18.第二摄像头；19.第三摄像头； 20.摄像头支架；21.第一滑块；22.第二滑块；25.第五滑块；26.第六滑块；10. X轴图像采集组件；30. Z轴图像采集组件；40.被测试样。
具体实施方式
下面将结合附图对本发明做进一步的详细说明。
参见图1、图IA所示，本发明是一种用于测量陀螺仪静平衡的基于双目视觉的空间位姿测量装置，该测量装置包括有用于采集被测试样40的X轴方向上图像信息的X轴图像采集组件10、用于采集被测试样40的Z轴方向上图像信息的Z轴图像采集组件30、以及支撑架1和背景板。
(一 )支撑架
参见图1、图IB所示，支撑架1为一框形结构，支撑架1选用钢化玻璃材质。
支撑架1的第一板面IA的外侧上安装有第一丝杠架11 ；
支撑架1的第二板面IB的外侧上安装有第四背景板5 ；
支撑架1的第三板面IC的内侧上安装有第一背景板2 ；
支撑架1的第四板面ID的内侧上安装有第三背景板3 ；
支撑架1的底板面IE上安装有第三背景板4 ；
支撑架1的上顶上安装有第五丝杠架15。
在本发明中，支撑架1用于支撑起整个测量装置。支撑架1设计为六面体结构，能够方便X轴和ζ轴上的摄像头对被测试件40图像信息的采集，同时也是在空间上实现被测试件40的空间定位部件。
( 二)背景板
参见图1、图IA所示，本发明中背景板用于增强图像对比度，提高测量装置的测量精度。背景板选用黑色铝材制作加工。
第一背景板2安装在支撑架1的第三板面IC的内侧上；
第二背景板3安装在支撑架1的第四板面ID的内侧上；
第三背景板4安装在支撑架1的底板面IE上；
第四背景板5安装在支撑架1的第二板面IB的内侧上。
(三)X轴图像采集组件10
参见图1、图1A、图2所示，X轴图像采集组件10包括有第一丝杠架11、第一丝杠 11B、第一电机11A、第二丝杠架12、第二丝杠12B、第二电机12A、第一滑块21、第二滑块22 和第一摄像头17。所述第一摄像头17用于采集被测试件40的主视图。
第一丝杠1IB的一端安装在第一丝杠架11的A侧板1IC的A滚珠轴承1IE (丝杠与滚珠轴承的连接为常规技术)内，该A滚珠轴承IlE安装在A侧板IlC的A通孔IlF内； 第一丝杠IlB的另一端通过联轴器(图中未示出，丝杠、联轴器与电机的连接为常规技术) 与第一电机IlA的输出轴连接；第一电机IlA安装在第一丝杠架11的B侧板IlD上。
第二丝杠12B的一端安装在第二丝杠架12的A侧板12C的B滚珠轴承12E (丝杠与滚珠轴承的连接为常规技术)内，该B滚珠轴承12E安装在A侧板12C的B通孔12F内， 第二丝杠12B的另一端通过联轴器(图中未示出，丝杠、联轴器与电机的连接为常规技术) 与第二电机12A的输出轴连接；第二电机12A安装在第二丝杠架12的B侧板12D上。
第一滑块21安装在第二丝杠架12的背部，且第一滑块21上的中心丝杠孔用于第一丝杠IlB穿过。在第一电机IlA驱动第一丝杠IlB运动的条件下，第一滑块21在第一丝杠IlB上也跟随运动，然而第一滑块21的运动使得第一摄像头17沿X轴方向平移运动。
第二滑块22上安装有第一摄像头17，且第二滑块22上的中心丝杠孔用于第二丝杠12B穿过。在第二电机12A驱动第二丝杠12B运动的条件下，第二滑块22在第二丝杠 12B上也跟随运动，然而第二滑块22的运动使得第一摄像头17沿Y轴方向平移运动。
第一滑块21上的中心丝杠孔用于第一丝杠IlB穿过。
第二滑块22上的中心丝杠孔用于第二丝杠12B穿过。
在本发明中，X轴图像采集组件10利用安装在支撑架1的第一板面1A(X安装面) 上的第一丝杠架11，实现第一摄像头17采集到的被测试件40的图像信息均为正视图。
(四)Z轴图像采集组件30
参见图1、图1A、图3所示，Z轴图像采集组件30包括有第五丝杠架15、第五丝杠 15B、第五电机15A、第六丝杠架16、第六丝杠16B、第六电机16A、第五滑块25、第六滑块沈、 第二摄像头18、第三摄像头19和摄像头支架20。
摄像头支架20安装在第六滑块沈上，摄像头支架20上安装有第二摄像头18和第三摄像头19，第二摄像头18用于采集被测试件40的左俯视图，第三摄像头19用于采集被测试件40的右俯视图。
第五丝杠15B的一端安装在第五丝杠架15的A侧板15C的E滚珠轴承15E (丝杠与滚珠轴承的连接为常规技术)内，该E滚珠轴承15E安装在A侧板15C的E通孔15F内， 第五丝杠15B的另一端通过联轴器(图中未示出，丝杠、联轴器与电机的连接为常规技术) 与第五电机15A的输出轴连接；第五电机15A安装在第五丝杠架15的B侧板15D上。
第六丝杠16B的一端安装在第六丝杠架16的A侧板16C的F滚珠轴承16E (丝杠与滚珠轴承的连接为常规技术)内，该F滚珠轴承16E安装在A侧板16C的F通孔16F内， 第六丝杠16B的另一端通过联轴器(图中未示出，丝杠、联轴器与电机的连接为常规技术) 与第六电机16A的输出轴连接；第六电机16A安装在第六丝杠架16的B侧板16D上。
第五滑块25安装在第六丝杠架16的背部，且第五滑块25上的中心丝杠孔用于第五丝杠15B穿过。在第五电机15A驱动第五丝杠15B运动的条件下，第五滑块25在第五丝杠15B上也跟随运动，然而第五滑块25的运动使得第二摄像头18和第三摄像头19沿Y轴方向平移运动。
第六滑块沈上安装有摄像头支架20，且第六滑块沈上的中心丝杠孔用于第六丝杠16B穿过。在第六电机16A驱动第六丝杠16B运动的条件下，第六滑块沈在第六丝杠 16B上也跟随运动，然而第六滑块沈的运动使得第二摄像头18和第三摄像头19沿X轴方向平移运动。
第五滑块25上的中心丝杠孔用于第五丝杠15B穿过。
第六滑块沈上的中心丝杠孔用于第六丝杠16B穿过。
在本发明中，Z轴图像采集组件30中的第五丝杠架15安装在支撑架1上方，且第五丝杠架15与支撑架1的底板面IE平行，从而实现第二摄像头18和第三摄像头19采集到的被测试件40的图像信息均为俯视图。
在本发明中，第一摄像头17、第二摄像头18和第三摄像头19选用相同性能的摄像头。如摄像头采用美国Point Grey公司的(iazelle 4. 0工业相机，图像分辨率为 2048 X 2048，帧速为170fps ；镜头采用日本Kowa的LM8HC百万像素镜头，焦距8. 5mm。
参见图4A、图4B所示，本发明测量装置的运动主要是根据被测试件40 (陀螺仪) 的转子的质心位置进行实时动态调整，其步骤为
第一步，在被测试件40 (陀螺仪转子)的侧面喷印一条螺旋线，该螺旋线等效于转子侧面的某一个展开矩形的对角线(如图4B所示)；
第二步，用第一摄像头17 (采集正视图)、第二摄像头18 (采集左俯视图)和第三摄像头19 (采集右俯视图)来采集图像信息；
第三步，图像信息被传输至计算机中，所述计算机中安装有边缘检测和轮廓识别处理软件；通过边缘检测和轮廓识别处理软件处理后，能够检测出陀螺转子在两幅俯视图和正视图上形成的侧边直线特征；通过计算正、俯视图的柱体侧边直线倾斜角度，就可换算出陀螺转子的俯仰、偏航角度；
第四步，通过对三个摄像头采集的各视图所检测到的轮廓特征，计算出陀螺转子的质心坐标；
第五步，通过边缘检测和轮廓识别处理软件检测出陀螺转子在侧视图上形成的圆、矩形和箭头等特征；结合正、俯视图中的表面喷印线与侧边直线的交点位置和侧视图中的圆、矩形和箭头位置，就可换算出陀螺转子的滚转角度。
本发明设计的测量装置，当陀螺仪转子位置发生变化时，第一摄像头17、第二摄像头18和第三摄像头19都需要动态追踪转子的质心位置。追踪过程为首先根据第一摄像头17的信息，经图像处理判断出转子的最新质心位置，之后计算出转子在X，Y，Z三个坐标轴上的位移量，然后通过四个电机控制摄像头的联动。即通过第一电机IlA和第二电机12A分别控制第一丝杠11和第二丝杠12产生同步运动，从而推动第一滑块21和第二滑块22， 使第一摄像头17产生Y和Z方向上的联动；通过第五电机15A和第六电机16A分别控制第五丝杠15和第六丝杠16产生同步运动，从而推动第五滑块25和第六滑块沈，使第二摄像头18和第三摄像头19产生X和Z方向上的联动。
权利要求
1. 一种用于测量陀螺仪静平衡的基于双目视觉的空间位姿测量装置，其特征在于该测量装置包括有用于采集被测试样GO)的X轴方向上图像信息的X轴图像采集组件(10)、 用于采集被测试样GO)的Z轴方向上图像信息的Z轴图像采集组件(30)、以及支撑架(1) 和背景板；支撑架(1)为一框形结构，支撑架(1)的第一板面(IA)的外侧上安装有第一丝杠架 (11)；支撑架(1)的第二板面(IB)的外侧上安装有第四背景板(5)；支撑架(1)的第三板面(IC)的内侧上安装有第一背景板O)；支撑架(1)的第四板面(ID)的内侧上安装有第三背景板(3)；支撑架(1)的底板面(IE)上安装有第三背景板；支撑架(1)的上顶上安装有第五丝杠架(15)；X轴图像采集组件(10)包括有第一丝杠架(11)、第一丝杠(IlB)、第一电机(IlA)、第二丝杠架(12)、第二丝杠(12B)、第二电机(12A)、第一滑块(21)、第二滑块0 和第一摄像头(17)；所述第一摄像头(17)用于采集被测试件GO)的主视图；第一丝杠(IlB)的一端安装在第一丝杠架(11)的A侧板(IlC)的A滚珠轴承(IlE) 内，该A滚珠轴承(IlE)安装在A侧板(IlC)的A通孔(IlF)内；第一丝杠(IlB)的另一端通过联轴器与第一电机(IlA)的输出轴连接；第一电机(IlA)安装在第一丝杠架(11)的B 侧板(IlD)上;第二丝杠(12B)的一端安装在第二丝杠架(12)的A侧板(12C)的B滚珠轴承(12E) 内，该B滚珠轴承(12E)安装在A侧板(12C)的B通孔(12F)内，第二丝杠(12B)的另一端通过联轴器与第二电机(12A)的输出轴连接；第二电机(12A)安装在第二丝杠架(1 的B 侧板(12D)上；第一滑块安装在第二丝杠架(1 的背部，且第一滑块上的中心丝杠孔用于第一丝杠(IlB)穿过；第二滑块0 上安装有第一摄像头(17)；且第二滑块0 上的中心丝杠孔用于第二丝杠(12B)穿过；Z轴图像采集组件(30)包括有第五丝杠架(15)、第五丝杠(15B)、第五电机(15A)、第六丝杠架(16)、第六丝杠(16B)、第六电机(16A)、第五滑块(25)、第六滑块( )、第二摄像头(18)、第三摄像头(19)和摄像头支架(20)；摄像头支架00)安装在第六滑块06)上，摄像头支架00)上安装有第二摄像头(18) 和第三摄像头(19)，第二摄像头(18)用于采集被测试件GO)的左俯视图，第三摄像头 (19)用于采集被测试件GO)的右俯视图；第五丝杠(15B)的一端安装在第五丝杠架(15)的A侧板(15C)的E滚珠轴承(15E) 内，该E滚珠轴承(15E)安装在A侧板(15C)的E通孔(15F)内，第五丝杠(15B)的另一端通过联轴器与第五电机(15A)的输出轴连接；第五电机(15A)安装在第五丝杠架(1 的B 侧板(15D)上；第六丝杠(16B)的一端安装在第六丝杠架(16)的A侧板(16C)的F滚珠轴承(16E) 内，该F滚珠轴承(16E)安装在A侧板(16C)的F通孔(16F)内，第六丝杠(16B)的另一端通过联轴器与第六电机(16A)的输出轴连接；第六电机(16A)安装在第六丝杠架(16)的B 侧板(16D)上；第五滑块0 安装在第六丝杠架(16)的背部，且第五滑块0 上的中心丝杠孔用于第五丝杠架(1 穿过；第六滑块06)上安装有摄像头支架(20)，且第六滑块06)上的中心丝杠孔用于第六丝杠(16B)穿过。
2.根据权利要求1所述的用于测量陀螺仪静平衡的基于双目视觉的空间位姿测量装置，其特征在于通过第一电机(IlA)和第二电机(12A)分别控制第一丝杠(11)和第二丝杠(1 产生同步运动，从而推动第一滑块和第二滑块(22)，使第一摄像头(17)产生 Y和Z方向上的联动；通过第五电机(15A)和第六电机(16A)分别控制第五丝杠(1 和第六丝杠(16)产生同步运动，从而推动第五滑块0 和第六滑块(沈)，使第二摄像头(18) 和第三摄像头(19)产生X和Z方向上的联动。
3.根据权利要求1所述的用于测量陀螺仪静平衡的基于双目视觉的空间位姿测量装置，其特征在于支撑架(1)选用钢化玻璃材质。
4.根据权利要求1所述的用于测量陀螺仪静平衡的基于双目视觉的空间位姿测量装置，其特征在于背景板选用黑色铝材制作加工。
5.根据权利要求1所述的用于测量陀螺仪静平衡的基于双目视觉的空间位姿测量装置，其特征在于第一摄像头17、第二摄像头18和第三摄像头19选用相同性能的摄像头， 其图像分辨率为2048 X 2048，帧速为170fps，焦距8. 5mm。
全文摘要
本发明公开了一种用于测量陀螺仪静平衡的基于双目视觉的空间位姿测量装置，该测量装置包括有用于采集被测试样(40)的X轴方向上图像信息的X轴图像采集组件(10)、用于采集被测试样(40)的Z轴方向上图像信息的Z轴图像采集组件(30)、以及支撑架(1)和背景板。X轴图像采集组件(10)和Z轴图像采集组件(30)安装在支撑架(1)的外部，背景板安装在支撑架(1)的内部。本发明测量装置通过三个摄像头对被测试样(40)进行正视图和俯视图的采集，无需和被测试样(陀螺仪)产生直接接触，因此不会对被测试样的姿态变化产生干扰，对于提高测量精度及其有利。
文档编号G01C25/00GK102519671SQ201110441129
公开日2012年6月27日 申请日期2011年12月26日 优先权日2011年12月26日
发明者严亮, 姚楠, 焦宗夏, 邹宇华 申请人:北京航空航天大学