CN1796932A - 微型磁红外姿态测量系统 - Google Patents
微型磁红外姿态测量系统 Download PDFInfo
- Publication number
- CN1796932A CN1796932A CN 200410103543 CN200410103543A CN1796932A CN 1796932 A CN1796932 A CN 1796932A CN 200410103543 CN200410103543 CN 200410103543 CN 200410103543 A CN200410103543 A CN 200410103543A CN 1796932 A CN1796932 A CN 1796932A
- Authority
- CN
- China
- Prior art keywords
- infrared
- angle
- carrier
- horizon
- axis
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000005259 measurement Methods 0.000 title claims abstract description 40
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 8
- 230000006698 induction Effects 0.000 claims abstract description 6
- 238000000034 method Methods 0.000 claims description 14
- 238000004364 calculation method Methods 0.000 claims description 13
- 238000006243 chemical reaction Methods 0.000 claims description 7
- 230000008030 elimination Effects 0.000 claims description 5
- 238000003379 elimination reaction Methods 0.000 claims description 5
- 239000011159 matrix material Substances 0.000 claims description 5
- 238000013341 scale-up Methods 0.000 claims description 4
- 238000003384 imaging method Methods 0.000 abstract 1
- 238000012536 packaging technology Methods 0.000 abstract 1
- 230000001133 acceleration Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 5
- 239000000969 carrier Substances 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000005265 energy consumption Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000005457 Black-body radiation Effects 0.000 description 1
- 230000036772 blood pressure Effects 0.000 description 1
- 238000005538 encapsulation Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000036039 immunity Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
Images
Landscapes
- Navigation (AREA)
Abstract
本发明涉及一种微型磁红外姿态测量系统,包括三轴正交红外地平仪、三轴正交磁强计、微处理器及电源管理器;三轴正交红外地平仪测量载体的对地俯仰角和滚转角信号,三轴正交磁强计用来测量地磁感应强度在X、Y和Z轴上分量;结合红外地平仪得到的俯仰角和滚转角解算出载体的航向角;本发明可以测得载体的全姿态信息,是一种绝对的姿态测量系统;具有固态结构、体积小、算法简单,重量轻和成本低的优点;无论白天、夜间都能正常工作;其使用的传感器可采用一体化MEMS芯片集成封装技术,可更加小型化。
Description
技术领域
发明涉及姿态测量领域中的测量装置,特别涉及一种用于微型飞行器、无人机或轮船等载体的微型磁红外姿态测量系统,可测得运动载体的全姿态(包括俯仰、滚转、偏航角)信息,具有全固态结构、体积小、重量轻、低功耗、启动快、成本低等特点。
背景技术
姿态测量方法及装置有很多,大体上分为惯性姿态测量装置和绝对姿态测量装置两种。惯性姿态测量装置主要是对惯性器件输出信号进行积分得到载体的姿态。常用的惯性器件有陀螺和加速度计。常规陀螺由于重量太大,只能用在大的飞机上,微型飞行器和无人机上采用的速率陀螺测量得到的是载体运动的角速度,必须对其进行积分运算才能得到姿态角。但是微机电速率陀螺存在严重零点漂移问题,因此经过积分计算得到的姿态角将不再准确,这种测量装置受陀螺漂移影响严重,不能准确地得到飞行器的姿态。加速度计受惯性的影响,当载体的以一定姿态平稳运动时,利用该测量装置得到的姿态角精度较高。但是当载体以加速度运动时或者在运动过程中受到扰动时,例如飞行器在飞行过程中受气流影响而具有某种加速度时,则三轴加速度计测量的加速度中既包括重力加速度还包括有载体的运动加速度,此时利用该方法计算得到的姿态角就具有相当大的误差。
红外地平仪是基于普朗克黑体辐射定律工作的。它利用天空和地面辐射波长的不同来感知飞行器的姿态变化,是一种绝对姿态测量装置,它不存在积分环节,响应时间快,不受加速度的影响。在申请号为ZL01110135.0的中国专利“基于微机电技术的微型导航系统”中提供了一种由三轴磁强计和三轴加速度计组成的传感器测量载体姿态的装置;三轴磁强计测量地磁感应强度在载体坐标系上三个正交轴的分量,根据地磁感应强度在地理坐标系中的表示,利用表述地理坐标系和载体坐标系之间相互转换关系的方向余弦矩阵建立方程组,结合三轴加速度计求得的俯仰角信息可以算出航向角;由于载体有运动加速度时,三轴加速度计不能准确反映载体的俯仰角信息。
发明内容
本发明目的在于提供一种结构简单,易于微型化的适用于无人机、微型飞行器或轮船等活动载体的磁红外姿态测量系统。
本发明提供的用于微型飞行器、无人机或轮船载体的微型磁红外姿态测量系统,包括三轴正交红外地平仪20、三轴正交磁强计10、微处理器30及电源管理器;
所述电源管理器为该微型磁红外姿态测量系统提供稳压电源;
所述三轴正交红外地平仪20包括:分别平行配制于载体直角坐标系X、Y和Z轴的由一对红外传感器组成的用以测量载体的对地俯仰角和滚转角信号的单轴红外地平仪组;将所测对地俯仰角和滚转角信号进行运算放大的运算放大器21、滤去传感器输出信号中的高频噪声的滤波器22,以及将滤波后的输出信号转化为数字信号的A/D转换器23;
所述三轴正交磁强计10包括分别平行配制于载体直角坐标系X、Y和z轴的用以测量地磁感应强度在X、Y和Z轴上分量的第一磁强计11、第二磁强计12和第三磁强计13;将所测信号进行运算放大的运算放大器14、滤去输出信号中的高频噪声的滤波器15,以及将滤波后的输出信号转化为数字信号的A/D转换器16;
所述的微处理器30带有载体姿态计算程序,分别与所述三轴正交红外地平仪30和三轴正交磁强计10的A/D转换器16和23相连,对获取的A/D转换器转换后的数字信号进行载体姿态的计算,分别得出载体的俯仰角、滚转角和航向角。
所述的单轴红外地平仪组包括:平行配置于Z轴上的由红外传感器201和211组成的第一轴地平仪组、平行配置于Y轴的由红外传感器202和212组成的第二轴地平仪组,和平行配置于配置在X轴的由红外传感器203和213组成的第三轴地平仪组。
所述微处理器30带有计算载体的姿态信息的姿态解算模块,对三轴正交红外地平仪20的测量信息转换为载体坐标系下的俯仰、滚转角信息;并把三轴正交磁强计10的经A/D转换器转换得数字信号,结合计算得到的俯仰、滚转角信息,解算出载体的航向角信息;姿态解算方法如下:
所述微处理器30对第一轴地平仪组、第二轴地平仪组和第三轴地平仪组的对地倾斜角度和输出差动电压的关系为:θ=arcsin(k*Vout/Vmax)……(1);其中θ为倾斜角度,Vout为单轴红外地平仪组输出差动电压,Vmax为单轴红外地平仪组输出最大值,k为红外传感器采用的比例系数;
由坐标系转换矩阵:
sin x=-sinθ----1
sin y=cosθsinφ----2 ………(3)
sin z=cosθcosφ----3
x,y,z为三轴红外地平仪的各自的对地倾角,θ、φ分别为俯仰角和滚转角。
通过输出电压采用公式(2)中的其中两个轴对应的公式可以推算出θ、φ;根据第三轴的正负可以确定θ、φ所处的象限,从而可以实现俯仰:-90°~+90°,滚转:-180°~+180°范围内的测量;根据三轴红外地平仪信号中的哪两个轴进行俯仰角和滚转角进行解算,以及剩下的第三轴进行象限判断;其判断流程如下:
首先计算出分别平行配制于载体直角坐标系X、Y和Z轴的红外地平仪组倾斜45度时应该输出的差动电压Vx45,Vy45,Vz45;
判断X轴红外地平仪组的输出电压Vx的绝对值和Vx45的大小,如果|Vx|>Vx45,接下来判断Vx是否大于0;
如果Vx>0,通过公式(1)得到Y轴和Z轴红外地平仪组的对地倾角y,z;根据公式(3)中的2,3式可以得到载体的俯仰角和滚转角θ、φ,在上述判断条件满足下,解算出的θ、φ应限制在θ∈(45,90]∪[-90,-45),Φ∈[-90,90]范围内。……(a)
如果Vx《0,解算方法如(a),只是解算出的θ、φ应限制在θ∈(45,90]∪[-90,-45),Φ∈[-180,-90)∪(-90,180]范围内。
如果X轴红外地平仪组的输出电压Vx绝对值|Vx|《Vx45,接下来判断Y轴红外地平仪组的输出电压Vy的绝对值和Vy45的大小,如果|Vy|>Vy45,接下来判断Vz是否大于0;
如果Vz)0,通过公式(1)得到X轴和Y轴红外地平仪组的对地倾角x,y;根据公式(3)中的1,2式可以得到载体的俯仰角和滚转角θ、φ,在上述判断条件满足下,解算出的θ、φ应限制在θ∈[-45,45],Φ∈[-90,90])范围内。……(b)
如果Vz《0,解算方法如(b),只是解算出的θ、φ应限制在θ∈[-45,45],Φ∈[-180,-90)∪(-90,180]范围内。
如果|Vy|《Vy45,接下来判断Vy是否大于0;
如果Vy>0,通过公式(1)得到X轴和Y轴红外地平仪组的对地倾角x,z;根据公式(3)中的1,3式可以得到载体的俯仰角和滚转角θ、φ,在上述判断条件满足下,解算出的θ、φ应限制在θ∈[-45,45],Φ∈[-90,90])范围内。……(c)
如果Vy《0,解算方法如(b),只是解算出的θ、φ应限制在θ∈[-45,45],Φ∈[-180,-90)∪(90,180]范围内。
通过上面的流程解算,从而可以实现俯仰:-90°~+90°,滚转:-180°~+180°范围内的测量;
本发明的磁红外姿态测量系统,包括由六个分离的红外温度传感器构成的三个单轴红外地平仪,三个三轴磁强计,微处理器和电源管理电路。
所述六个红外温度传感器每两个组成一对,分别沿直角坐标系的轴对称布置,每对传感连线可以不通过直角坐标系的原点,但连线必须平行于相应轴线。六个红外温度传感器用来测量飞行器的俯仰角和滚转角。
受红外温度传感器的视场角影响,单轴红外地平仪组对地倾角在0~±55°范围内测量有效,三轴的单轴红外地平仪组由于必然同时有两个轴的对地倾角小于45°,根据输出电压的大小可以确定其中两个轴的单轴红外地平仪组,剩下的第三轴的单轴红外地平仪组可以判断姿态角的象限,从而实现俯仰:-90°~+90°,滚转:-180°~+180°范围内的测量。
所述三轴正交磁强计沿前述直角坐标系三轴布置,三轴磁强计结合红外地平仪测得的俯仰和滚转角信息,解算出载体的航向角。
所述微处理器30带有计算姿态信息的姿态解算模块,对三轴正交红外地平仪20的测量信息转换为机体坐标系下的俯仰、滚转角信息。并把三轴正交磁强计10的信号经A/D转换器转换为数字信号后,结合算得的俯仰、滚转角信息,解算出载体的航向角信息。它可以根据需要接收模拟的红外地平仪信号,经过A/D转换为数字信号,进行姿态解算。也可以利用SPI口接收数字的红外地平仪信号进行姿态解算。
所述电源管理电路包括电源接口和降压稳压器电路。用来为磁红外姿态测量仪提供所需的稳压电源。
利用红外地平仪解算方法如下:
单轴红外地平仪(由沿直角坐标系下同一轴线的一对红外温度传感器组成)的对地倾斜角度和输出差动电压的关系为:θ=arcsin(k*Vout/Vmax)。其中θ为倾斜角度,Vout为单轴红外地平仪输出差动电压,Vmax为红外地平仪输出最大值,k为红外传感器采用的比例系数。
由坐标系转换矩阵:
其中
为地面坐标,
为机体坐标。、θ、φ分别为偏航角、俯仰角和滚转角。可得:
sin x=-sinθ----1
sin y=cosθsinφ----2 .........(2)
sin z=cosθcosφ----3
x,y,z为三轴红外地平仪的各自的对地倾角,θ、φ分别为俯仰角和滚转角。
通过判断输出电压采用公式(2)中的其中两个轴对应的公式可以推算出θ、φ。根据第三轴的正负可以判断θ、φ所处的象限,从而可以实现俯仰:-90°~+90°,滚转:-180°~+180°范围内的测量。判断利用三轴红外地平仪信号中的哪两个轴进行俯仰角和滚转角进行解算,以及剩下的第三轴进行象限判断的流程见附图4。
本发明中利用三轴正交红外地平仪20测得的俯仰角和滚转角不受加速度的影响,结合三轴正交磁强计10最后求得载体的姿态角。可以满足微型飞行器姿态测量的要求。本发明除可以应用于微型飞行器,还可以应用于中、大型飞行器进行飞行姿态测量以及轮船等活动载体的姿态测量。
本发明采用集成度高、速度快、功耗低、自带A/D转换的微型处理器。既可以接受模拟的红外输人信号,也可以接受数字的红外输人信号。分离单元的红外温度传感器单元有抗干扰性强、安装灵活方便的特点。本发明具有体积小、重量轻、功耗低,使用方便、灵活、无论白天、夜间都能正常工作等特点。
附图说明
图1是本发明的结构示意框图;
图2(a)是地理坐标系示意图;图2(b)为载体坐标系示意图;
图3是图2的载体姿态测量装置中传感器的分布示意图;
图4是图2的载体姿态测量系统中的红外信号处理的流程图。
具体实施方式:
下面结合附图和具体实施方式对本发明作进一步详细描述。
在一个实例性的实施方式中,坐标系的建立如图1所示。图2(a)是以载体所在位置为原点建立三个正交轴组成的地理坐标系北-东-地(即N-E-D),其中N轴是由载体指向正北方,E轴是由载体指向正东方,D轴是由载体指向地心。图2(b)是固连于载体100的三轴正交载体坐标系X-Y-Z,其中X轴处于载体对称平面内,由载体质心指向载体运动前向,Y轴垂直于载体对称平面并指向右方;Z轴在载体对称平面内且垂直于X轴指向下方,图2(b)中是以飞机作为载体100的一个实例。
本发明的姿态测量系统如图1所示,它布置在如图2中的载体100上。该姿态测量系统中的传感器包括:三轴正交的磁强计10、三轴正交的红外地平仪20;传感器在载体100上的分布如图3所示,三轴正交的磁强计10包括第一磁强计11、第二磁强计12和第三磁强计13,这三个磁强计11、12和13分别与载体坐标系的三个正交轴X-Y-Z平行配置,用于分别测量地磁感应强度在载体坐标系三个正交轴X-Y-Z上的分量。三轴正交的红外地平仪20包括由201,211红外传感器组成的第一轴红外地平仪组、由202,212红外传感器组成的第二轴红外地平仪组和出203,213红外传感器组成的第三轴红外地平仪组。这三轴的六个红外传感器分别与载体坐标系的三个正交轴X-Y-Z平行配置,用于分别测量红外地平仪在地理坐标系下的倾斜角度。
三轴红外地平仪20和三轴磁强计10的输出为模拟的电压信号,分别经过仪表运放电路14、21对信号进行放大。然后经过滤波电路15、21滤去传感器输出信号中的高频噪声。滤波后的信号进入微处理器30里自带的A/D转换器转化为数字信号。微处理器带有载体姿态计算的程序,通过获取A/D转换后的数据进行载体姿态的计算。
单轴红外红外地平仪(由沿直角坐标系下同一轴线的一对红外温度传感器组成)的对地倾斜角度和输出差动电压的关系为:θ=arcsin(k*Vout/Vmax)。其中θ为倾斜角度,Vout为单轴红外地平仪输出差动电压,Vmax为红外地平仪输出最大值,k为红外传感器采用的比例系数。
由坐标系转换矩阵:
sin x=-sinθ----1
sin y=cosθsinφ----2 .........(2)
sin z=cosθcosφ----3
x,y,z为三轴红外地平仪的各自的对地倾角,θ、φ分别为俯仰角和滚转角。
通过判断输出电压采用公式(2)中的其中两个轴对应的公式可以推算出θ、φ。根据第三轴的正负可以判断θ、φ所处的象限,从而可以实现俯仰:-90°~+90°,滚转:-180°~+180°范围内的测量。判断利用三轴红外地平仪信号中的哪两个轴进行俯仰角和滚转角进行解算,以及剩下的第三轴进行象限。其判断流程(图4)如下:
首先计算出分别平行配制于载体直角坐标系X、Y和Z轴的红外地平仪组倾斜45度时应该输出的差动电压Vx45,Vy45,Vz45;
判断X轴红外地平仪组的输出电压Vx的绝对值和Vx45的大小,如果|Vx|>Vx45,接下来判断Vx是否大于0;
如果Vx>0,通过公式(1)得到Y轴和Z轴红外地平仪组的对地倾角y,z;根据公式(3)中的2,3式可以得到载体的俯仰角和滚转角θ、φ,在上述判断条件满足下,解算出的θ、φ应限制在θ∈(45,90]∪[-90,-45),Φ∈[-90,90]范围内。 ……(a)
如果Vx《0,解算方法如(a),只是解算出的θ、φ应限制在θ∈(45,90]∪[-90,-45),Φ∈[-180,-90)∪(-90,180]范围内。
如果X轴红外地平仪组的输出电压Vx绝对值|Vx|《Vx45,接下来判断Y轴红外地平仪组的输出电压Vy的绝对值和Vy45的大小,如果|Vy|>Vy45,接下来判断Vz是否大于0;
如果Vz>0,通过公式(1)得到X轴和Y轴红外地平仪组的对地倾角x,y;根据公式(3)中的1,2式可以得到载体的俯仰角和滚转角θ、φ,在上述判断条件满足下,解算出的θ、φ应限制在θ∈[-45,45],Φ∈[-90,90])范围内。......(b)
如果Vz《0,解算方法如(b),只是解算出的θ、φ应限制在θ∈[-45,45],Φ∈[-180,-90)∪(-90,180]范围内。
如果|Vy|《Vy45,接下来判断Vy是否大于0;
如果Vy>0,通过公式(1)得到X轴和Y轴红外地平仪组的对地倾角x,z;根据公式(3)中的1,3式可以得到载体的俯仰角和滚转角θ、φ,在上述判断条件满足下,解算出的θ、φ应限制在θ∈[-45,45],Φ∈[-90,90])范围内。......(c)
如果Vy《0,解算方法如(b),只是解算出的θ、φ应限制在θ∈[-45,45],Φ∈[-180,-90)∪(90,180]范围内。
通过上面的流程解算,从而可以实现俯仰:-90°~+90°,滚转:-180°~+180°范围内的测量;
本发明是一种绝对的姿态测量系统,不存在陀螺的积分飘移问题,响应时间快,从而得到的载体姿态动态精度和稳定性优于现有的姿态测量系统。本发明可以实现载体的全姿态测量,即俯仰角测量范围为-90°~+90°,滚转角测量范围为-180°~+180°,航向角测量范围为0°~360°。进一步的,本发明中的传感器采用一体化MEMS芯片集成封装技术,使仪器更加小型化。
Claims (4)
1、一种用于微型飞行器、无人机或轮船载体的活动微型磁红外姿态测量系统,包括三轴正交红外地平仪(20)、三轴正交磁强计(10)、微处理器(30)及电源管理器;
所述电源管理器为该微型磁红外姿态测量系统提供稳压电源;
所述三轴正交红外地平仪(20)包括:分别平行配置于载体直角坐标系X、Y和z轴的由一对红外传感器组成的用以测量载体的对地俯仰角和滚转角信号的单轴红外地平仪组;将所测对地俯仰角和滚转角信号进行运算放大的运算放大器(21)、滤去传感器输出信号中的高频噪声的滤波器(22),以及将滤波后的输出信号转化为数字信号的A/D转换器(23);
所述三轴正交磁强计(10)包括分别平行配置于载体直角坐标系X、Y和z轴的用以测量地磁感应强度在X、Y和Z轴上分量的第一磁强计(11)、第二磁强计(12)和第三磁强计(13);将所测信号进行运算放大的运算放大器(14)、滤去输出信号中的高频噪声的滤波器(15),以及将滤波后的输出信号转化为数字信号的A/D转换器(16);
所述的微处理器(30)带有载体姿态计算程序,分别与所述三轴正交红外地平仪(20)和三轴正交磁强计(10)的A/D转换器(16,23)相连,对获取的A/D转换器转换后的数字信号进行载体姿态的计算,分别得出载体的俯仰角、滚转角和航向角。
2、按权利要求1所述的微型磁红外姿态测量系统,其特征在于,所述的单轴红外地平仪组包括:配置在Z轴上的由红外传感器(201)和(211)组成的第一轴地平仪组、配置在Y轴上的由红外传感器(202)和(212)组成的第二轴地平仪组,和配置在X轴上的由红外传感器(203)和(213)组成的第三轴地平仪组。
3、按权利要求1所述的微型磁红外姿态测量系统,其特征在于:所述微处理器(30)带有计算载体的姿态信息的姿态解算模块,对三轴正交红外地平仪(20)的测量信息转换为载体坐标系下的俯仰、滚转角信息;并把三轴正交磁强计(10)的经A/D转换器转换得数字信号,结合计算得到的俯仰、滚转角信息,解算出载体的航向角信息;姿态解算方法如下:
所述微处理器对第一轴地平仪组、第二轴地平仪组和第三轴地平仪组的对地倾斜角度和输出差动电压的关系为:θ=arcsin(k*Vout/Vmax);其中θ为倾斜角度,Vout为单轴红外地平仪输出差动电压,Vmax为红外地平仪输出最大值,k为红外传感器采用的比例系数;
由坐标系转换矩阵:
其中
为地面坐标,
为载体坐标。、θ、φ分别为偏航角、俯仰角和滚转角;可得:
sinx=-sinθ ----1
siny=cosθsinφ ----2 ………(2)
sinz=cosθcosφ ----3
x,y,z为三轴红外地平仪的各自的对地倾角,θ、φ分别为俯仰角和滚转角。
通过输出电压采用公式(2)中的其中两个轴对应的公式可以推算出θ、φ;根据第三轴的正负可以确定θ、φ所处的象限,从而可以实现俯仰:-90°~+90°,滚转:-180°~+180°范围内的测量;根据三轴红外地平仪信号中的哪两个轴进行俯仰角和滚转角进行解算,以及剩下的第三轴进行象限判断;其判断流程如下:
首先计算出分别平行配制于载体直角坐标系X、Y和Z轴的红外地平仪组倾斜45度时应该输出的差动电压Vx45,Vy45,Vz45;
判断X轴红外地平仪组的输出电压Vx的绝对值和Vx45的大小,如果|Vx|)Vx45,接下来判断Vx是否大于0;
如果Vx>0,通过公式(1)得到Y轴和Z轴红外地平仪组的对地倾角y,z;根据公式(3)中的2,3式可以得到载体的俯仰角和滚转角θ、φ,在上述判断条件满足下,解算出的θ、φ应限制在θ∈(45,90]∪[-90,-45),φ∈[-90,90]范围内。……(a)
如果Vx《0,解算方法如(a),只是解算出的θ、φ应限制在θ∈(45,90]∪[-90,-45),φ∈[-180,-90)∪(-90,180]范围内。
如果X轴红外地平仪组的输出电压Vx绝对值|Vx|<<Vx45,接下来判断Y轴红外地平仪组的输出电压Vy的绝对值和Vy45的大小,如果|Vy|>Vy45,接下来判断Vz是否大于0;
如果Vz>0,通过公式(1)得到X轴和Y轴红外地平仪组的对地倾角x,y;根据公式(3)中的1,2式可以得到载体的俯仰角和滚转角θ、φ,在上述判断条件满足下,解算出的θ、φ应限制在θ∈[-45,45],φ∈[-90,90])范围内。……(b)
如果Vz《0,解算方法如(b),只是解算出的θ、φ应限制在θ∈[-45,45],φ∈[-180,-90)∪(-90,180]范围内。
如果|Vy|<<Vy45,接下来判断Vy是否大于0;
如果Vy>0,通过公式(1)得到X轴和Y轴红外地平仪组的对地倾角x,z;根据公式(3)中的1,3式可以得到载体的俯仰角和滚转角θ、φ,在上述判断条件满足下,解算出的θ、φ应限制在θ∈[-45,45],φ∈[-90,90])范围内。……(c)
如果Vy<<0,解算方法如(b),只是解算出的θ、φ应限制在θ∈[-45,45],φ∈[-180,-90)∪(90,180]范围内。
通过上面的流程解算,从而可以实现俯仰:-90°~+90°,滚转:-180°~+180°范围内的测量。
4、按权利要求1所述的微型磁红外姿态测量系统,其特征在于,所述的单轴红外地平仪组的对地倾角在0-55°范围内,其中,两个轴的单轴红外地平仪组的对地倾角小于45°。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2004101035432A CN100365383C (zh) | 2004-12-29 | 2004-12-29 | 微型磁红外姿态测量系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2004101035432A CN100365383C (zh) | 2004-12-29 | 2004-12-29 | 微型磁红外姿态测量系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1796932A true CN1796932A (zh) | 2006-07-05 |
CN100365383C CN100365383C (zh) | 2008-01-30 |
Family
ID=36818151
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CNB2004101035432A Expired - Fee Related CN100365383C (zh) | 2004-12-29 | 2004-12-29 | 微型磁红外姿态测量系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN100365383C (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102022986A (zh) * | 2009-09-14 | 2011-04-20 | 上海诸光机械有限公司 | 姿态仪标定装置 |
CN106546204A (zh) * | 2016-09-22 | 2017-03-29 | 北京空间飞行器总体设计部 | 一种舱间分离相对位置与姿态测量方法 |
CN107067873A (zh) * | 2016-11-25 | 2017-08-18 | 上海航空电器有限公司 | 基于can总线控制的航空模拟飞行地平表 |
CN107990794A (zh) * | 2017-11-28 | 2018-05-04 | 南京理工大学 | 一种基于红外与地磁复合的旋转弹体姿态测试装置 |
CN108375375A (zh) * | 2018-03-04 | 2018-08-07 | 西北工业大学 | 一种基于pir被动式红外辐射接收的三旋翼无人机姿态检测系统及检测方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1152237C (zh) * | 2001-03-30 | 2004-06-02 | 清华大学 | 基于微机电技术的微型导航系统 |
US6760664B1 (en) * | 2001-06-25 | 2004-07-06 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Autonomous navigation system based on GPS and magnetometer data |
-
2004
- 2004-12-29 CN CNB2004101035432A patent/CN100365383C/zh not_active Expired - Fee Related
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102022986A (zh) * | 2009-09-14 | 2011-04-20 | 上海诸光机械有限公司 | 姿态仪标定装置 |
CN106546204A (zh) * | 2016-09-22 | 2017-03-29 | 北京空间飞行器总体设计部 | 一种舱间分离相对位置与姿态测量方法 |
CN106546204B (zh) * | 2016-09-22 | 2018-12-18 | 北京空间飞行器总体设计部 | 一种舱间分离相对位置与姿态测量方法 |
CN107067873A (zh) * | 2016-11-25 | 2017-08-18 | 上海航空电器有限公司 | 基于can总线控制的航空模拟飞行地平表 |
CN107067873B (zh) * | 2016-11-25 | 2022-03-29 | 上海航空电器有限公司 | 基于can总线控制的航空模拟飞行地平表 |
CN107990794A (zh) * | 2017-11-28 | 2018-05-04 | 南京理工大学 | 一种基于红外与地磁复合的旋转弹体姿态测试装置 |
CN107990794B (zh) * | 2017-11-28 | 2019-11-15 | 南京理工大学 | 一种基于红外与地磁复合的旋转弹体姿态测试装置 |
CN108375375A (zh) * | 2018-03-04 | 2018-08-07 | 西北工业大学 | 一种基于pir被动式红外辐射接收的三旋翼无人机姿态检测系统及检测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN100365383C (zh) | 2008-01-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104848859B (zh) | 一种三轴惯性稳定平台及其自定位定向的控制方法 | |
CN110108279B (zh) | 一种杆塔倾斜测量系统及倾斜解算方法 | |
CN106767805B (zh) | 基于mems传感器阵列的高精度惯性量测量方法及测量系统 | |
CN106767804A (zh) | 一种运动物体的多维数据测量装置及方法 | |
CN201561759U (zh) | 惯性姿态方位测量装置 | |
CN1695042A (zh) | 移动电子三维罗盘 | |
CN103743378B (zh) | 一种管道检测器姿态检测系统 | |
CN1664506A (zh) | 一种载体姿态测量方法及其系统 | |
CN206514864U (zh) | 一种无人机惯性测量装置及含其的无人机 | |
CN1669874A (zh) | 一种用于飞行器的自动驾驶仪 | |
CN2681997Y (zh) | 一种具有双处理器的飞行器自动驾驶仪 | |
CN111688949B (zh) | 一种无人机悬停姿态测量装置及方法 | |
CN107270902B (zh) | 一种带有交叉轴耦合误差补偿的mems惯性测量单元 | |
CN1687709A (zh) | 汽车运动状态测量系统 | |
CN112325879A (zh) | 一种基于多源传感器集成的仿生复合导航授时微系统 | |
CN104677355B (zh) | 基于多传感器融合的虚拟陀螺及方法 | |
CN109827580A (zh) | 一种汽车姿态数据采集系统 | |
CN104833864B (zh) | 空中三维电场可定向无线测量装置 | |
CN107255475B (zh) | 一种对称结构加速度计寻北仪与动态差分寻北方法 | |
CN1796932A (zh) | 微型磁红外姿态测量系统 | |
CN108469251B (zh) | 一种基于图像识别的球形倾角传感器 | |
CN103454449A (zh) | 一种三轴微机械加速度计 | |
CN201327390Y (zh) | 一种基于can总线的微机械惯性测量仪 | |
CN204631139U (zh) | 空中三维电场可定向无线测量装置 | |
CN205317213U (zh) | 一种面向房地一体的不动产单元实地调查测量装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C19 | Lapse of patent right due to non-payment of the annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |