深入浅出 GNSS 之序贯最小二乘:与批处理最小二乘、Kalman 滤波的关系

深入浅出 GNSS 之抗差 Kalman 滤波:原理及公式推导 sucy 20260716抗差 Kalman 滤波(Robust Kalman Filter,RKF)不是某一个唯一固定的公式,而是一类方法。常见路线包括:本文重点讲解测量平差和 GNSS 中最常见的 M 估计—等效权抗差 Kalman 滤波。它的核心思想是:本文重点讨论观测抗差:根据观测残差动态调整观测权值或观测协方差。针对过程模型异常的抗差方法,需要另外处理状态预测或过程噪声。标准线性 Kalman 滤波通常要求:需要注意:实际 GNSS 数据经常不满足这些条件,例如:抗差 Kalman 滤波的作用,就 阅读详情

问题:什么是“序贯”?序贯最小二乘与批处理最小二乘何时等价?它与 Kalman 滤波是什么关系?


1. 什么是序贯最小二乘

序贯最小二乘是指:

观测数据分批到达时,不重新处理全部历史观测,而是在上一批估值及其不确定度的基础上,吸收新观测并更新结果。

可以把“序贯”理解为:

  • 序:观测按先后顺序到达;
  • 贯:上一阶段的结果继续传递给下一阶段。

两种计算方式的区别如下。

批处理最小二乘

收集全部观测
→ 组成完整观测方程
→ 一次求解全部未知参数

序贯最小二乘

处理已有观测
→ 保存当前估值和协方差
→ 新观测到达
→ 更新估值和协方差

序贯最小二乘没有改变最小二乘准则,只改变了数据进入计算的方式。


2. 批处理加权最小二乘

2.1 线性观测模型

设线性观测模型为:

z=Hx+v\mathbf z = \mathbf H\mathbf x + \mathbf vz=Hx+v

其中:

  • z∈Rm\mathbf z\in\mathbb R^mz∈Rm:观测向量;
  • H∈Rm×n\mathbf H\in\mathbb R^{m\times n}H∈Rm×n:设计矩阵;
  • x∈Rn\mathbf x\in\mathbb R^nx∈Rn:待估参数向量;
  • v∈Rm\mathbf v\in\mathbb R^mv∈Rm:观测误差向量;
  • mmm:观测方程数;
  • nnn:未知参数数。

假设:

E(v)=0E(\mathbf v)=\mathbf 0E(v)=0

Cov⁡(v)=R\operatorname{Cov}(\mathbf v)=\mathbf RCov(v)=R

其中:

  • E(⋅)E(\cdot)E(⋅):数学期望;
  • Cov⁡(⋅)\operatorname{Cov}(\cdot)Cov(⋅):协方差;
  • R\mathbf RR:观测误差协方差矩阵,假设为正定矩阵。

2.2 加权最小二乘目标函数

加权最小二乘最小化:

J(x)=(z−Hx)TR−1(z−Hx)J(\mathbf x) = (\mathbf z-\mathbf H\mathbf x)^{\mathrm T} \mathbf R^{-1} (\mathbf z-\mathbf H\mathbf x)J(x)=(z−Hx)TR−1(z−Hx)

其中:

  • J(x)J(\mathbf x)J(x):加权残差平方和;
  • z−Hx\mathbf z-\mathbf H\mathbf xz−Hx:观测残差;
  • 上标 T\mathrm TT:矩阵转置;
  • R−1\mathbf R^{-1}R−1:观测权阵。

令目标函数对 x\mathbf xx 的导数为零:

HTR−1H x^=HTR−1z\mathbf H^{\mathrm T}\mathbf R^{-1}\mathbf H\,\hat{\mathbf x} = \mathbf H^{\mathrm T}\mathbf R^{-1}\mathbf zHTR−1Hx^=HTR−1z

定义信息矩阵和信息向量:

Λ=HTR−1H\boldsymbol\Lambda = \mathbf H^{\mathrm T}\mathbf R^{-1}\mathbf HΛ=HTR−1H

η=HTR−1z\boldsymbol\eta = \mathbf H^{\mathrm T}\mathbf R^{-1}\mathbf zη=HTR−1z

其中:

  • Λ\boldsymbol\LambdaΛ:信息矩阵,也就是正规矩阵;
  • η\boldsymbol\etaη:信息向量,也就是正规方程右端项。

若 H\mathbf HH 满列秩,则:

x^=Λ−1η=(HTR−1H)−1HTR−1z\boxed{ \hat{\mathbf x} = \boldsymbol\Lambda^{-1}\boldsymbol\eta = (\mathbf H^{\mathrm T}\mathbf R^{-1}\mathbf H)^{-1} \mathbf H^{\mathrm T}\mathbf R^{-1}\mathbf z }x^=Λ−1η=(HTR−1H)−1HTR−1z​

当 R\mathbf RR 是真实观测协方差时,估值协方差为:

Cx^=(HTR−1H)−1=Λ−1\boxed{ \mathbf C_{\hat x} = (\mathbf H^{\mathrm T}\mathbf R^{-1}\mathbf H)^{-1} = \boldsymbol\Lambda^{-1} }Cx^​=(HTR−1H)−1=Λ−1​

其中 Cx^\mathbf C_{\hat x}Cx^​ 表示参数估值 x^\hat{\mathbf x}x^ 的协方差矩阵。


3. 序贯最小二乘的信息形式

3.1 将观测分批

设第 iii 批观测模型为:

zi=Hix+vi\mathbf z_i = \mathbf H_i\mathbf x + \mathbf v_izi​=Hi​x+vi​

其中:

  • zi\mathbf z_izi​:第 iii 批观测;
  • Hi\mathbf H_iHi​:第 iii 批设计矩阵;
  • vi\mathbf v_ivi​:第 iii 批观测误差;
  • x\mathbf xx:各批共同估计的同一个静态参数向量。

先假设不同批次的误差互不相关:

Cov⁡(vi,vj)=0,i≠j\operatorname{Cov}(\mathbf v_i,\mathbf v_j) = \mathbf 0, \qquad i\ne jCov(vi​,vj​)=0,i=j

第 iii 批观测协方差为:

Cov⁡(vi)=Ri\operatorname{Cov}(\mathbf v_i) = \mathbf R_iCov(vi​)=Ri​

3.2 信息逐批累加

处理完前 k−1k-1k−1 批后:

Λk−1=∑i=1k−1HiTRi−1Hi\boldsymbol\Lambda_{k-1} = \sum_{i=1}^{k-1} \mathbf H_i^{\mathrm T} \mathbf R_i^{-1} \mathbf H_iΛk−1​=i=1∑k−1​HiT​Ri−1​Hi​

ηk−1=∑i=1k−1HiTRi−1zi\boldsymbol\eta_{k-1} = \sum_{i=1}^{k-1} \mathbf H_i^{\mathrm T} \mathbf R_i^{-1} \mathbf z_iηk−1​=i=1∑k−1​HiT​Ri−1​zi​

加入第 kkk 批观测:

Λk=Λk−1+HkTRk−1Hk\boxed{ \boldsymbol\Lambda_k = \boldsymbol\Lambda_{k-1} + \mathbf H_k^{\mathrm T} \mathbf R_k^{-1} \mathbf H_k }Λk​=Λk−1​+HkT​Rk−1​Hk​​

ηk=ηk−1+HkTRk−1zk\boxed{ \boldsymbol\eta_k = \boldsymbol\eta_{k-1} + \mathbf H_k^{\mathrm T} \mathbf R_k^{-1} \mathbf z_k }ηk​=ηk−1​+HkT​Rk−1​zk​​

如果 Λk\boldsymbol\Lambda_kΛk​ 可逆,则:

x^k=Λk−1ηk\boxed{ \hat{\mathbf x}_k = \boldsymbol\Lambda_k^{-1} \boldsymbol\eta_k }x^k​=Λk−1​ηk​​

Ck=Λk−1\boxed{ \mathbf C_k = \boldsymbol\Lambda_k^{-1} }Ck​=Λk−1​​

其中:

  • x^k\hat{\mathbf x}_kx^k​:吸收前 kkk 批观测后的参数估值;
  • Ck\mathbf C_kCk​:该估值的协方差。

这就是序贯最小二乘的信息形式:

新观测提供的新信息,直接累加到已有信息上。


4. 为什么信息可以相加

把全部观测堆叠为:

z=[z1z2⋮zk],H=[H1H2⋮Hk]\mathbf z = \begin{bmatrix} \mathbf z_1\\ \mathbf z_2\\ \vdots\\ \mathbf z_k \end{bmatrix} ,\qquad \mathbf H = \begin{bmatrix} \mathbf H_1\\ \mathbf H_2\\ \vdots\\ \mathbf H_k \end{bmatrix}z= ​z1​z2​⋮zk​​ ​,H= ​H1​H2​⋮Hk​​ ​

如果各批误差互不相关,总协方差为分块对角阵:

R=diag⁡(R1,R2,…,Rk)\mathbf R = \operatorname{diag} \left( \mathbf R_1, \mathbf R_2, \ldots, \mathbf R_k \right)R=diag(R1​,R2​,…,Rk​)

其中 diag⁡(⋅)\operatorname{diag}(\cdot)diag(⋅) 表示由各矩阵组成的分块对角矩阵。

于是:

HTR−1H=∑i=1kHiTRi−1Hi\mathbf H^{\mathrm T}\mathbf R^{-1}\mathbf H = \sum_{i=1}^{k} \mathbf H_i^{\mathrm T} \mathbf R_i^{-1} \mathbf H_iHTR−1H=

GNSS精密单点定位技术(PPP)与Kalman滤波优化实践 本文深入探讨了GNSS精密单点定位技术(PPP)及其Kalman滤波优化实践,重点分析了PPP技术在单台接收机高精度定位中的应用与挑战。通过多系统融合和自适应Kalman滤波策略,显著提升了定位精度和收敛速度,特别是在动态场景下的PPP-RTK技术表现突出。文章还介绍了模糊度固定(PPPAR)技术的突破,为厘米级定位提供了可靠解决方案。 阅读详情

相关推荐

深入浅出GNSS之加权最小二乘(WLS):从原理到 GNSS 定位公式推导

xATPA−1ATPyxATPA−1ATPy​P≈R−1P≈R−1​Pii1σi2Pii​σi2​1​​高质量观测给大权重;低质量观测给小权重;权重通过vTPvvTPv进入目标函数;法方程来自目标函数最小化;是否能稳定解算取决于观测数量、矩阵秩、卫星几何和权重设置;工程实现中应优先使用矩阵分解或线性方程组求解。加权最小二乘就是让不同质量的观测按可靠性分配“话语权”。

星垂平野阔, 月涌大江流 543

GNSS算法学习系列教程 - 文章列表

有时会将代码 或者资源放在个人公众号上,有问题,在公众号后台回复,也回答的比较快一些,欢迎关注 GNSS和自动驾驶。

dong20081991的博客 2161

GNSS导航定位中的抗差估计:为什么你的GPS数据需要‘防抖’技术?

本文深入探讨了GNSS导航定位中的抗差估计技术,这是一种关键的‘数据防抖’方法。通过对比传统最小二乘法的脆弱性,文章阐释了抗差估计如何通过动态调整权重来抑制多路径效应、电磁干扰等产生的异常值,从而在无人机、自动驾驶等动态复杂环境中提供更稳定、可靠的定位结果。

weixin_29309213的博客 446

车载导航定位为什么突然漂移?用抗差估计原理分析GNSS异常场景

本文深入分析了车载导航定位漂移现象,揭示了GNSS信号在城市复杂环境中的四大干扰源,并详细解读抗差估计理论如何有效应对这些异常场景。通过对比实验数据,展示了抗差Kalman滤波相比传统最小二乘法可将定位误差降低84%,显著提升导航系统的稳定性和可靠性。

weixin_29234423的博客 398

北斗导航 | GNSS数据处理:预处理与参数估计模型

GNSS观测值将不可避免的受到外界环境的干扰,影响观测值的质量。在GNSS高精度定位中,需要对数据进行**预处理**。GNSS数据预处理的主要目的是进行**粗差的探测**与**剔除**以及**周跳的探测**等工作。在经过数据预处理获得相对较高精度观测值后,即可按照某种估计理论进行参数估计。

尘世冰封的专栏 1375

让GNSS&RTK不再难【第16讲 伪距差分定位流程 - Kalman滤波--第2部分】

3天学完GNSS理论。公式全面推导

sinat_39783664的博客 1023

让GNSS&RTK不再难【第16讲 伪距差分定位流程 - Kalman滤波--第1部分】

3天学完GNSS理论。公式全面推导。

sinat_39783664的博客 879

傻白入门芯片设计,wafer/die/chip/cell(一)

芯片设计的一些基本概念

qq_46675545的博客 2万+

PX4实战指南:通过遥控器通道直连实现舵机PWM控制

本文详细介绍了如何通过PX4飞控实现遥控器通道直连控制舵机PWM输出的完整流程。从硬件准备、遥控器配对到PX4参数配置和硬件连接,提供了实战技巧和常见问题解决方案,帮助无人机爱好者快速掌握舵机控制技术。重点讲解了AUX Passthrough模式设置和PWM参数调整等关键步骤。

weixin_29195217的博客 153

从零开始用QP框架开发STM32:事件驱动编程实战指南(附状态机设计技巧)

本文详细介绍了如何使用QP框架在STM32上实现事件驱动编程,包括状态机设计技巧和嵌入式开发实践。通过对比传统前后台系统和RTOS,展示了QP框架在资源占用、实时性和代码可维护性方面的优势,并提供了从环境搭建到高级状态机设计的完整指南。

h6i7j8的博客 1173

非洲秃鹫优化算法(AVOA)详解:从原理到实战

非洲秃鹫优化算法(AVOA)是一种模拟秃鹫觅食行为的元启发式算法。该算法通过数学建模秃鹫的群体分工、饥饿感知和食物竞争等行为,将优化问题转化为智能觅食过程。AVOA包含四个关键阶段:(1)种群初始化与最佳秃鹫选择;(2)饥饿率控制探索与开发平衡;(3)探索阶段模拟远距离飞行搜索;(4)开发阶段模拟食物源附近的竞争行为。算法采用饥饿率函数实现自适应搜索,初期偏向全局探索,后期转向局部开发。实验表明AVOA在标准测试函数和工程设计问题上表现出优越性能,其创新性在于将秃鹫独特的生物学特性转化为高效的优化机制。

qq_42212808的博客 225

Python爬虫实战:研究Pandas,构建车质网各车型数据采集和分析系统

研究结果表明,通过网络爬虫技术可以有效地获取公开的汽车投诉数据,这些数据经过适当的清洗和处理后,可以揭示出丰富的汽车质量信息。)作为国内专业的汽车质量投诉受理平台,自 2010 年成立以来,已累计接收消费者投诉信息超过 200 万条,这些数据包含了车型、投诉时间、投诉问题、处理状态等多维度信息,具有极高的分析价值。:通过对车质网数据的分析,能够挖掘出有价值的汽车质量信息,为消费者购车提供参考,为汽车厂商改进产品质量和服务提供依据,同时也能为相关监管部门提供数据支持。

ylfhpy的博客 937

立项书8分钟定生死?手把手教你用ChatGPT辅助打造高水平申报书,让评审专家一看就想打高分!

宏大叙事、空话堆砌只会让评审绕晕,不如聚焦一个具体问题,拿出清晰的研究路径、扎实的设计方案,把“我想做什么、为什么做、打算怎么做”讲明白。对评审来说,关键不在你读了多少,而在你能否看清领域的共识、争议和空白,GPT的作用就在于帮你理清研究脉络,发现问题结构,聚焦那些还没被充分讨论的变量或方法,去提升综述的深度。之前要用到ProcessOn、Draw.io等工具画流程图,现在有了ai虽然方便了,但也需要多次调教,如果嫌麻烦,七哥给大家准备了课题申报常用的流程图,技术路线图,方便大家直接拿来编辑填空使用。

智能AI让学术科研更容易 289

13、离散时间系统建模与分析

本文系统介绍了离散时间系统的建模与分析方法,涵盖连续时间模型的离散化过程、系统稳定性判断准则、输入输出模型转换方法以及有限脉冲响应和阶跃响应模型的应用。通过多个示例详细展示了不同系统在离散化过程中的特性变化,并探讨了采样间隔对系统动态特性的影响。此外,文章还分析了时间延迟的处理方法,并总结了关键知识点及操作步骤,为离散时间系统的实际应用提供了理论基础和实践指导。

2w3e4r5t6y的博客 187

YOLO26涨点改进 | 全网独家创新,注意力改进篇| SCI一区Top | 引入AFCA自适应细粒度通道注意力,联合建模全局与局部通道依赖关系,适合目标检测、图像去雾、关键点检测、图像分类、图像分割

🔥本文提出了一种基于AFCA(自适应细粒度通道注意力)模块改进的YOLO26目标检测网络。AFCA通过联合建模全局与局部通道依赖关系,实现了更精细的通道注意力分配,能够增强目标相关特征并抑制背景噪声。该模块采用自适应融合策略动态平衡通道权重,在保持轻量级结构的同时,显著提升了小目标和复杂背景下的检测性能。文章详细介绍了AFCA的结构原理、实现优势,并提供了完整的代码实现和YAML配置文件,指导读者如何将该模块集成到YOLO26框架中。实验结果表明,AFCA在检测精度和鲁棒性方面优于传统注意力机制。

Ai缝合怪、助力小伙伴高效发论文 294

jre9下载 jdk9

(Java SE Runtime Environment 9.0) 9.0u175 官方最新版 【x86|x64】

华为的C语言编程规范.pdf

华为技术有限公司内部技术规范。本规范制定了编写C语言程序的基本原则、规则和建议。从代码的清晰、简洁、可测试、安全、程序效率、可移植各个方面对C语言编程作出了具体指导。

visio安装包

Microsoft Office Visio 是一款专业的制图软件。利用经过更新的形状、协作工具和数据链接图表,创建专业级图表以简化复杂的信息。

Statistics and Machine Learning Toolbox

Statistics and Machine Learning Toolbox(带书签),MATLAB统计学习工具

上一篇: RTKLIB timeget() 获取 UTC 的原理与离线授时方法
下一篇: 网络通信入门:网口、MAC 地址、IP 地址与网络准入
云卷云苏~
博客等级 码龄2年 33粉丝 83原创
评论
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付:10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

云卷云苏~

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值