算法-卡爾曼濾波之卡爾曼濾波的第二個方程:預測方程(狀態外推方程)

在上一節中,使用了靜態模型,我們推導出了卡爾曼濾波的狀態更新方程,但是在實際情況下,系統都是動態,預測階段,前后時刻的狀態是改變的,此時我們引入預測方程,也叫狀態外推方程;

同樣的我們通過一個例子來分析,在開始為什么要選擇卡爾曼濾波時,提出了一個例子;

在一維空間內使用雷達來追蹤勻速飛行的飛行器,此時系統狀態為飛行器的航程,速度是相對于時間的變化率,也就是距離的導數;

通過分析飛行器的一維物理模型,可以得到,速度恒定時,航程等于當前時刻的的航程加上時間變化*速度(距離的導數) ;

?得到的動態模型,我們稱為狀態外推方程或者預測方程;

具體化這個例子:

對于存在問題,我們分析得到兩種情況:一個是雷達的誤差,另外就是飛行器速度改變了;假設雷達的精度是20m,此時的誤差更可能是由于飛行器速度發生了改變,那么此時我們更信任雷達的測試結果,所以我們將系數調高(當系數β=1時,估計值結果=測量值);

?假設雷達的精度是150m,此時的誤差更可能是由于雷達誤差結果,那么此時我們更信任飛機速度變化,所以我們將系數調低(當系數β=0時,估計值結果=先驗估計值);

?具體流程:根據分析,我們設置權重因子,開始第0次迭代,首先依然是初始化,輸入估計值,與上一個例子不同是,此時我們是動態模型,預測后,先驗估計值與輸入值是不同的;

將預測的結果作為輸入給到狀態更新方程,同時輸入測量值,通過狀態更新方程計算當前估計值;

?

繼續預測下一刻的先驗估計值;?

?

不斷迭代:最終我們得到結果

?

?我們可以看出,可以看到估計算法對估計結果有平滑作用,并且估計結果趨近真實值。

嘗試改變權重因子:

結果并不理,所以濾波器系數的選擇是至關重要的;

濾波器系數的選擇:

對于這個案例,系統狀態為航程情況下,動態改變的除了速度還可能有加速度,例如現在來一架戰斗機,它先以50m/s 的恒定速度飛行 15 秒然后以 8 m/s2 的加速度勻加速飛行 35秒。入圖顯示了目標航程、速度、加速度隨時間的變化。此時α-β兩個系數將不能滿足我們的需求,依然使用該濾波器,分析:

會發現,誤差非常大:

?現在使用α-β-Γ濾波器來追蹤:

根據動力學分析,此時的系統狀態外推方程:

?

?

最終得到結果:航程的擬合還是不錯的;

?

?但是速度和加速度的擬合效果并不好:

?

?

?卡爾曼濾波器就可以處理動態情況下的問題;

總結:

卡爾曼濾波的第一個方程:通過先驗估計值和對殘差的權重求和得到當前估計值;

卡爾曼濾波的第二個方程:通過動態模型,得到狀態外推方程,去求得先驗估計值;

本文來自互聯網用戶投稿,該文觀點僅代表作者本人,不代表本站立場。本站僅提供信息存儲空間服務,不擁有所有權,不承擔相關法律責任。
如若轉載,請注明出處:http://www.pswp.cn/web/12067.shtml
繁體地址,請注明出處:http://hk.pswp.cn/web/12067.shtml
英文地址,請注明出處:http://en.pswp.cn/web/12067.shtml

如若內容造成侵權/違法違規/事實不符,請聯系多彩編程網進行投訴反饋email:809451989@qq.com,一經查實,立即刪除!

相關文章

企業為什么進行大數據遷移以及注意事項

在當今數字化時代,數據的遷移成為了企業優化其數據架構、提高數據處理能力、確保業務連續性和數據安全的關鍵步驟。企業可能出于多種原因,如成本效益、性能提升、系統升級、數據集中管理或云服務集成等,選擇將數據從一個存儲系統遷移到另一個…

Spring Boot 整合訊飛星火3.5通過接口Api接口實現聊天功能(首發)復制粘貼即可使用,后續更新WebSocket實現聊天功能

程序員必備網站&#xff1a; 天夢星服務平臺 (tmxkj.top)https://tmxkj.top/#/ 1.pom.xml <dependency><groupId>com.alibaba</groupId><artifactId>fastjson</artifactId><version>1.2.72</version></dependency><depen…

html5關于WebSocket的一些特點與用例

WebSocket通信機制是一種在單個TCP連接上進行全雙工通信的協議&#xff0c;它允許服務器主動向客戶端推送數據&#xff0c;而無需等待客戶端的請求。以下是WebSocket通信的主要機制&#xff1a; 握手協議&#xff1a;WebSocket通信的第一步是通過HTTP協議進行握手。當客戶端發…

C++ QT設計模式:訪問者模式

基本概念 訪問者模式&#xff08;Visitor Pattern&#xff09;是一種行為型設計模式&#xff0c;它允許你在不改變被訪問類的前提下&#xff0c;定義對其進行操作的新操作。 實現的模塊有&#xff1a; ObjectStructure&#xff08;對象結構&#xff09;&#xff1a;用于存儲…

輕松拿下指針(5)

文章目錄 一、回調函數是什么二、qsort使用舉例三、qsort函數的模擬實現 一、回調函數是什么 回調函數就是?個通過函數指針調?的函數。 如果你把函數的指針&#xff08;地址&#xff09;作為參數傳遞給另?個函數&#xff0c;當這個指針被?來調?其所指向的函數 時&#x…

計算模型的邊界

https://github.com/libigl/libigl.git 這是幾何計算庫&#xff0c;可以計算出模型的邊界 #define _CRT_SECURE_NO_WARNINGS#include <iostream>#include <igl/boundary_loop.h>#include <igl/list_to_matrix.h>int main(){std::vector<std::vector<…

肺部營養“救星”,讓每次呼吸更自由

?#肺科營養#朗格力#班古營養#復合營養素#肺部營養# 正常的健康人,每天自由幸福的呼吸。但是對于肺病患者來說,特別是慢阻肺人群,每一次呼吸都可能是一場挑戰,每一口氣都顯得彌足珍貴。 肺病患者號稱沉默的“呼吸殺手”,它雖然沉默,但不代表它沒能力,除了引起肺功能下降,氧氣…

云商店如何讓更多企業摘到技術普惠的“果實”?

文 | 智能相對論 作者 | 沈浪 現階段&#xff0c;越是工業體系發達的地區&#xff0c;越需要加速技術普惠的步伐。比如&#xff0c;在蘇州&#xff0c;華為云就在聯合當地政府、企業伙伴打造以華為云云商店為重要鏈接的智能化商業增長底座。 華為云云商店以“電商式”的購物…

Git學習——遷移單一倉庫至其他代碼托管平臺

Git學習——遷移單一倉庫至其他代碼托管平臺 簡介流程總結 簡介 因需遷移單一代碼倉庫至其他代碼托管平臺&#xff0c;要遷移的包括倉庫內容以及所有歷史記錄和推送日志。 本文中的方法同樣適用于在同一代碼托管平臺中克隆倉庫。 流程 1. 創建新倉庫&#xff1a; 在目的平臺…

軟件需求規格文檔 (SRS) 模版

文章目錄 軟件需求規格文檔 (SRS) - 范例1. 引言1.1 目的1.2 范圍1.3 定義、縮寫和術語1.4 參考文獻1.5 總體描述 2. 系統概述2.1 系統環境2.2 系統功能概述2.3 用戶特性2.4 假設與約束 3. 功能需求3.1 用戶身份驗證模塊3.1.1 總體概述3.1.2 具體需求3.1.2.1 登錄功能描述3.1.2…

OpenAI春季發布會-免費多模態GPT4O-簡介

前言 2024.5.14&#xff0c;OpenAI宣布即將發布一款性能更為強大的大模型GPT4o&#xff0c;雖然沒有爆出些超級酷炫無敵吊炸天的新玩意&#xff0c;但是這次的多模態模型&#xff0c;大家可以免費用了~~&#xff08;但是&#xff09; 雖然是免費使用&#xff0c;但官方發布會上…

逆向學習記錄--第一天

NSSCTF工坊逆向綜合基礎第二題 考查知識點&#xff1a;ida的使用與編程能力 wp&#xff1a; 運行一下&#xff0c;沒有東西&#xff1b; 查殼是64位&#xff0c;沒有殼 直接ida打開 代碼解析&#xff1a;輸入flag&#xff0c;對flag進行用key進行輪換之后再加12&#xff…

鴻蒙 DevEcoStudio:用戶名密碼獲取保存

【使用首選項實現用戶名密碼保存獲取】 打開src/main/ets/entryability路徑下的EntryAbility.ts文件 在 export default class EntryAbility extends UIAbility {onCreate(want, launchParam) {hilog.info(0x0000, testTag, %{public}s, Ability onCreate);下邊添加內容&…

C++:左值(引用)右值(引用)

〇、前言 本文會討論C中的左值&#xff0c;右值&#xff0c;左值引用&#xff0c;右值引用&#xff0c;以及會理清它們之間的關系。 一、左值與右值 &#xff08;一&#xff09;概述 1. 左值是一般指表達式結束后依然存在的持久化對象。右值指表達式結束時就不再存在的臨時…

334_C++_std::bind中使用shared_from_this()

std::bind(&HttpClient::getPwd, shared_from_this(), std::placeholders::_1, std::placeholders::_2);[ HttpClient繼承自NetObj,NetObj是父類,NetObj受到std::shared_pt

分析 vs2019 c++ 中的 decltype 與 declval

&#xff08;1&#xff09; decltype 可以讓推斷其參數的類型。按住 ctrl 點擊 decltype &#xff0c;會發現無法查閱 其定義 &#xff1a; &#xff08;2&#xff09; 但 STL 庫里咱們可以查閱函數 declval 的 定義&#xff0c;很短&#xff0c;摘抄如下&#xff1a; templat…

【氮化鎵】高溫GaN HEMTs大信號模型——ASM-HEMT

這篇文章的標題是《An ASM-HEMT for Large-Signal Modeling of GaN HEMTs in High-Temperature Applications》&#xff0c;由Nicholas C. Miller等人撰寫&#xff0c;發表于2023年9月29日。文章的主要內容是關于一種適用于高溫應用的GaN HEMTs&#xff08;高電子遷移率晶體管&…

Java 高級面試問題及答案1

Java 高級面試問題及答案 問題1: 請解釋Java中的垃圾回收機制&#xff0c;并描述其工作原理。 答案&#xff1a; Java中的垃圾回收&#xff08;Garbage Collection, GC&#xff09;是一種自動內存管理機制&#xff0c;用于識別和回收不再使用的對象&#xff0c;從而釋放內存資…

使用System.Drawing繪制基本幾何圖形

1.使用System.Drawing繪制一個正方形 using System; using System.Drawing; using System.Windows.Forms;public partial class MyForm : Form {public MyForm(){// 你可以在這里設置Form的雙緩沖&#xff0c;以避免繪制時出現的閃爍 this.DoubleBuffered true;}protected o…

LeetCode 每日一題 ---- 【1553.吃掉 N 個橘子的最少天數】

LeetCode 每日一題 ---- 【1553.吃掉 N 個橘子的最少天數】 1553.吃掉N個橘子的最少天數方法&#xff1a;記憶化搜索 1553.吃掉N個橘子的最少天數 方法&#xff1a;記憶化搜索 前兩天給樹澆水&#xff0c;原來澆的是橘子樹哇 今天直接來了個大的【困難】 class Solution {Ma…