EDA365电子论坛网

标题: 基于matlab UKF自行车状态估计 [打印本页]

作者: uperrua    时间: 2021-9-7 15:08
标题: 基于matlab UKF自行车状态估计
4 n& @* B" Y" C) j& ]
一、简介
. H# |2 d0 s2 W; ^  o7 i# q% ?! n6 B4 S著名学者Julier等提出近似非线性函数的均值和方差远比近似非线性函数本身更容易,因此提出了基于确定性采样的UKF算法。
' J( r2 K, d0 m# `2 R该算法的核心思想是:采用UT变换,利用一组Sigma采样点来描述随机变量的高斯分布,然后通过非线性函数的传递,再利用加权统计线性回归技术来近似非x线性函数的后验均值和方差。
- ?; x; X& x% P  S相比于EKF,UKF的估计精度能够达到泰勒级数展开的二阶精度。* E6 T' L0 Y4 n- u
6 M% r1 r7 [% B  r+ f
1 UT变换: \+ l6 l) ]7 T* m/ l) q

$ |7 t7 O1 ?4 p8 G
; b0 V; a% w" A% v) M5 l+ l
. V; _1 Y( I; ], P# Q$ g) ~* O7 F) `4 F4 t
2 采样策略
2 O* f" p& m* @+ B  |
+ l6 o+ n6 ?8 ?' o: h' Y; t根据Sigma点采样策略不同,相应的Sigma点以及均值权值和方差权值也不尽相同,因此UT变换的估计精度也会有差异,但总体来说,其估计精度能够达到泰勒级数展开的二阶精度。
& W& C! D5 q- V1 @为保证随机变量x经过采样之后得到的Sigma采样点仍具有原变量的必要特性,所以采样点的选取应满足:
) L( Y. \9 ?0 M# [3 F7 ?; ~8 s6 t6 g8 T) |5 B( [
2 i3 j! W) ]# P5 e9 j6 ~4 @

& F. z$ K6 W) W$ v9 j: ?
/ f7 H$ j3 Z8 y下面介绍两种经常使用的采样策略:比例采样和比例修正对称采样
. J+ s  c; K9 @2 p! H) R: k1 _. H) v; j. f7 R% l+ I) g
+ q7 T( o5 C% _* n+ J

/ I$ j, q- Z$ J! [% M+ V' _. W 6 U  U3 A- \5 N  T$ w

. A5 Z/ T( ~7 F ) Z8 |. P  D5 z# i' s5 q( {. O# q/ q
6 O. v) o7 h( W6 L) v. W. V
8 q' w9 p0 }9 _  m2 x
1 H/ a0 r  E+ Z  ~7 F- z! g

7 ?: @! }5 V, [& Z7 \- m# N3 UKF算法流程( [8 Q6 D1 A) @
: E; A: _8 g9 x2 I6 D, J$ z
! t7 ~* c+ r# f, G
1 ?( H/ P* g5 M4 X# V

  F, f) f" X; `( `( ~& B" b/ @5 }4 y  w& L: B6 V& f$ R0 v4 B; y) d( w

% x2 H4 s! z, e# [4 Y5 Y  }8 D) j二、源代码' c) `- G) b. [; e8 K

4 C, e: ]% V0 {9 ^& ]3 q7 F2 Q7 D) I

9 u+ h1 c. b4 i( Q' A5 b; F6 `三、运行结果0 k: L8 p: {1 _2 s6 J2 k& u
: t- r5 V* s* o6 y' i* w
" g2 k6 A5 r* z, Q. t9 v

  ]4 J: `4 p2 l; S3 ?# m7 ` 7 d) y4 _6 i7 Q' r+ L  E; L
5 E$ k! [  ?8 S2 q

4 E" h) |! V7 @' K& \
  H/ ?' c6 `$ f; o 7 N: h3 B' j  L" p6 `! r
* W! [" t/ T' I2 H- u: u
7 o* [2 }; k- L6 x( w+ j

作者: adogpp    时间: 2021-9-7 16:17
近似非线性函数的均值和方差远比近似非线性函数本身更容易,因此提出了基于确定性采样的UKF算法
作者: NNNei256    时间: 2021-9-7 16:32
相比于EKF,UKF的估计精度能够达到泰勒级数展开的二阶精度
作者: CCxiaom    时间: 2021-9-7 16:32
采用UT变换,利用一组Sigma采样点来描述随机变量的高斯分布,然后通过非线性函数的传递,再利用加权统计线性回归技术来近似非x线性函数的后验均值和方差




欢迎光临 EDA365电子论坛网 (https://bbs.eda365.com/) Powered by Discuz! X3.2