专利汇可以提供一种视觉辅助卫星完好性监测方法专利检索,专利查询,专利分析的服务。并且本 发明 公开了一种视觉辅助卫星完好性监测方法,包括步骤一:通过对视觉采集的图像进行处理,采用高 精度 的视觉导航模型获得导航观测量,并对视觉导航观测量的误差进行估计。步骤二:采用进近阶段高空相对较好的卫星 信号 对视觉观测量进行标定,抑制视觉观测量误差。步骤三:将被标定后的视觉伪距信息与卫星观测信息进行组合,对RAIM可用性进行判断。步骤四:对存在故障星的情况进行故障识别,从而确定并排除故障卫星。步骤五:采用排除过故障卫星后的卫星数据与视觉观测量进行融合,获得最终的组合 定位 结果。本发明通过利用视觉 传感器 提供的观测量作为辅助,丰富导航观测量,从而提高卫星完好性检测性能,提高导航定位结果的可靠性。,下面是一种视觉辅助卫星完好性监测方法专利的具体信息内容。
1.一种视觉辅助卫星完好性监测方法,具体包括以下步骤:
步骤一:对视觉采集的图像进行处理,采用高精度的视觉导航模型获得导航观测量,对视觉导航观测量的误差进行估计;
通过采用特征点检测匹配算法获取地标在计算机视觉设备提取的视觉图像中的二维坐标 其中下标i为第i个地标点的序号,上角标I代表图像平面直角坐标系;与此同时,计算获得地标齐次矢量 其中f为相机焦距;
将所有的地标在视觉图像中的二维坐标值和地标先验参数代入到高精度视觉模型中计算视觉伪距;
采用最小二乘法,通过求解如下二次方程求解视觉伪距:
其中视觉伪距矢量 是视觉伪距矢量的估计
矢量;Nl是先验地标的数量, 是地标视线的所有组合 视觉伪距对矢量
T
mij≡[mi,mj,1] ;式(2)中的系数矩阵为:
其中cij是地标i与地标j的视线夹角的余弦值,由地标齐次矢量求得,即:
其中<·>表示内积,||·||为范数;
视觉伪距误差由参数 和 的误差决定,分别对每个地标进行定位 ,然后采用位置差法求得地标之间的距离;
其中: 表示第j个地标在ECEF坐标系下的坐标;
根据位置差法的误差,获得 的误差 为:
其中 和 分别表示对地标i和地标j位置的估计误差;
假设地标定位误差服从独立高斯分布 其中 为地标定位误差的方差,则误差 也服从高斯分布,且均值为 方差为
两个地标视线夹角的余弦值cij的误差为:
其中 和 表示地标i和地标j在相机坐标系C中的坐标, 和 对应其误差变量;
假设地标检测误差服从独立高斯分布 其中 为地标检测误差的方差,则误差δcij同样服从高斯分布,其均值 归一化方差为:
(7)其中约束条件(8)保证地标i和对标j均在图像内;
视觉伪距误差δm与cij和 的关系可得:
上述方程可记为Tδm=δc+δd通过求解上述方程,可通过最小二乘法求得视觉伪距T -1 T
误差δm=(TT) T(δc+δd);由于在给定地标估计位置时,误差项δd是确定值,因此视觉伪距误差的互相关矩阵 E[·]为均值算子,从而获得视
觉伪距误差估计;
步骤二:采用进近阶段高空相对较好的卫星信号对视觉观测量进行标定,进一步抑制视觉观测量误差;
具体为:
a)采用RAIM算法对卫星信号数据进行验证,对卫星信号质量进行判断,如果RAIM可用且卫星完好时,则进行视觉误差标定,进入步骤b),否则,说明卫星信号出现完好性问题,因此,需要视觉辅助进行完好性检测,转到步骤三;
b)根据完好的卫星信号计算接收机准确的位置,利用地标先验信息计算接收机与地标之间的距离,从而获得准确的视觉伪距及余弦值,并与利用式(1)、式(2)中的视觉伪距矢量m和余弦值cij作差得到视觉伪距误差δm和余弦值误差δcij,将上述参数带入到式(9)中;以 为未知参数求解方程(9),得到距离平方偏差 然后用 纠正步骤一中地标距离平方参数
c)在进近着陆阶段,采用纠正后的地标距离平方参数 代入(3)中,通过求解式(1)、式(2)来获得标定后的视觉伪距;
步骤三:将被标定后的视觉伪距与卫星观测信息进行组合,对RAIM可用性进行判断;
若不可用时,输出不可用告警,结束;否者,采用视觉辅助RAIM方法,获得检测统计量;当检测统计量大于门限值时,认为存在故障,并进行报警,执行步骤四;否则,执行步骤五;
具体为:
a)建立卫星非线性观测方程:
其中:ρπ是第π颗可见卫星伪距, 是该卫星在ECEF坐标系下的位置,Cb是接收机钟差;
b)通过对(10)线性化,获得Ns颗卫星线性观测模型方程:
Z=Hx+ε+bj (11)
其中Z是Ns×1伪距残差矢量,H是Ns×4观测矩阵,x是状态误差矢量,包括三维位置[Δx,Δy,Δz],和接收机钟差ΔCb,ε是不确定独立高斯分布,方差矩阵为 为观测伪距方差;卫星故障模型bj=bej,其中j是故障卫星,ej是 的第j个标准基底矢量,b为故障大小;
c)对权重矩阵进行奇异值分解,得到:
其中 是视觉伪距误差互相关矩阵,奇异值分解为 其中Λ为对角矩
阵,其对角元素为 的奇异值的开方值,U为对应奇异值分解的酉矩阵;
d)将被标定后的视觉伪距与卫星观测信息进行组合,即将(1)-(2)和(11)-(12)进行组合,获得加权视觉/卫星组合扩展方程:
其中: 其中 为变量
在卫星方程上的扩展形式,为微分算子,x,y,z分别代表接收机在ECEF坐标系下的三个方向,xi代表地标i在ECEF坐标系下一个方向的坐标, 为大小为4×Ns的全1矩阵;
e)采用加权最小二乘估计用户位置信息:
其中鲁棒估计加权矩阵 有:
其中,为第i个视觉/卫星组合导航残差,其中k0=2σp和k1=6σp;
f)计算残差矢量:
g)通过计算HPL值进行可用性判断:
其中:Slopei为第i颗卫星的特征斜率,DT为该航路对应的RAIM阈值;若HPL大于门限时,即判断为不可用时,输出不可用报警,结束,否者,转至h)
h)利用残差矢量计算检测统计量,获得基于鲁棒估计的加权RAIM的检测统计量:
i)通过给定虚警率pFA,由下公式计算RAIM阈值:
其中:e自然常数, 为伽马分布,e为自然常数;
j)将检测统计量DS与RAIM阈值DT进行比较,如果DS≥DT,即视觉辅助RAIM告警,检测到故障,转至步骤四,进行故障检测;否则,说明无卫星故障,不进行告警,转至步骤五;
步骤四:对存在故障星的情况进行故障识别,从而确定并排除故障卫星;
对步骤三中,检测到的故障,通过采用极大似然法进行故障识别与排除,故障排除后,返回步骤三,继续进行故障检测,直到不再出现故障卫星;
步骤五:采用排除过故障卫星后的卫星数据与视觉观测量进行融合,获得最终的组合定位结果。
标题 | 发布/更新时间 | 阅读量 |
---|---|---|
一种基于深度学习的伽马放射性成像方法 | 2020-05-22 | 406 |
一种多伽马光子符合成像系统及方法 | 2020-05-19 | 197 |
人员携带放射性物质的实时检测系统及方法 | 2020-05-23 | 791 |
基于伽马相机的放射性物质探测方法及其装置和系统 | 2020-05-16 | 410 |
用于在使用时间编码的图案目标的情况下校准由至少一个传感器相机构成的图像采集传感器的方法 | 2020-05-23 | 22 |
一种基于双编码板的伽马相机及其用于放射性物质定位的方法 | 2020-05-14 | 615 |
相机伽马校正曲线提取方法 | 2020-05-13 | 291 |
手持式光学、伽马探测器一体化成像系统和方法 | 2020-05-20 | 44 |
用于伽马放射源定位仪的伽马相机及其伽马放射源定位仪 | 2020-05-14 | 78 |
伽马相机 | 2020-05-11 | 906 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。