[发明专利]基于大气偏振模式空间特征的三维姿态获取方法有效
申请号: | 201210005641.7 | 申请日: | 2012-01-10 |
公开(公告)号: | CN102589544A | 公开(公告)日: | 2012-07-18 |
发明(设计)人: | 高隽;范之国;王昕;田柳;高丽娟;王波;王子谦 | 申请(专利权)人: | 合肥工业大学 |
主分类号: | G01C21/02 | 分类号: | G01C21/02 |
代理公司: | 安徽省合肥新安专利代理有限责任公司 34101 | 代理人: | 何梅生 |
地址: | 230009 *** | 国省代码: | 安徽;34 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 大气 偏振 模式 空间 特征 三维 姿态 获取 方法 | ||
1.一种基于大气偏振模式空间特征的三维姿态获取方法,其特征是按照如下过程进行:
a、建立描述理论大气偏振模式的三维空间坐标系OXYZ,以地面观测位置为原点O,地理正北方向为X轴,地理正东方向为Y轴,过天顶点z的垂线为Z轴,从原点O出发的所有方向上的偏振信息,在以地面观测位置为球心,半径为r的半球面M上描述;半球面M上任意一点的高度角为θ、方位角为所述方位角是以正北方向为0,正北往东为正值;太阳位置表示为θS表示太阳高度角,表示太阳方位角,太阳子午线在三维空间坐标系OXYZ中的位置以太阳方位角来表示;
b、对大气偏振模式中若干点的偏振信息进行采样,在所述半球面M上分布2×m×(n+1)个采样点,m、n为正整数,n不小于2,采样点阵列记作矩阵T,
采样点tij在所述三维空间坐标系OXYZ中的坐标记作采样点ti1,ti2...ti2(n+1)沿Z轴向O点看去顺时针方向分布在所述半球面M的同一条纬线上,1≤i≤m且i为正整数,采样点t1j,t2j...tmj分布在所述半球面M的同一条经线上,1≤j≤2(n+1)且j为正整数;以各采样点的采样值组成大气偏振模式采样响应矩阵R,rij表示采样点tij的采样值,
在大气偏振模式采样响应矩阵R={rij}中,分别用Rp表示采样响应矩阵的偏振度分布矩阵,Rχ表示采样响应矩阵的E-矢量分布矩阵,即:
c、实测获得起始r0时刻下的大气偏振模式采样响应矩阵Rt0,r0时刻下采样点的响应值为r0ij,导航载体在三维空间坐标系OXYZ中的空间位置用坐标表示,根据大气偏振模式的空间分布特性,从实测大气偏振模式采样响应矩阵Rt0中提取空间显著特征点Pt0;经Δt时间后,再次实测获得t1时刻下的大气偏振模式采样响应矩阵Rt1,t1时刻下采样点的响应值为r1ij,导航载体在三维空间坐标系中的空间位置用坐标表示,并从实测大气偏振模式采样响应矩阵Rt1中提取空间显著特征点Pt1;
t1=t0+Δt (4)
d、通过空间显著特征点Pt0与Pt1之间的空间坐标转换关系,求解映射矩阵C,获得导航载体t1时刻相对t0时刻的三维空间姿态角变化值(α,β,γ),其中α、β、γ分别表示t1时刻相对t0时刻导航载体横滚角、俯仰角及旋转角的变化值;
Pt1≈CPt0(5)
利用公式(6)进行全局寻优,寻找使Pt1与CPt0两者差值最小的导航载体三维空间姿态角变化值(α,β,γ),
(α,β,γ)=argmin∑|Pt1(tij)-CPt0(tij)|2(6)
e、已知起始t0时刻导航载体三维空间姿态用(α0,β0,γ0)表示,其中α0、β0、γ0分别表示t0时刻导航载体横滚角、俯仰角及旋转角的值,假设t1时刻导航载体三维空间姿态用(α1,β1,γ1)表示,其中α1、β1、γ1分别表示t1时刻导航载体横滚角、俯仰角及旋转角的值;导航载体t0时刻到t1时刻的三维空间姿态角变化值(α,β,γ)与已知的起始t0时刻导航载体三维空间姿态(α0,β0,γ0)作和,得到t1时刻导航载体三维空间姿态(α1,β1,γ1),
α1=α0+α(7)
β1=β0+β(8)
γ1=γ0+γ(9)。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于合肥工业大学,未经合肥工业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201210005641.7/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种储热装置
- 下一篇:用于冰箱的储物盒和具有该储物盒的冰箱