xxxx18一60岁hd中国/日韩女同互慰一区二区/西西人体扒开双腿无遮挡/日韩欧美黄色一级片 - 色护士精品影院www

  • 大小: 2KB
    文件類型: .cpp
    金幣: 1
    下載: 0 次
    發布日期: 2021-05-12
  • 語言: C/C++
  • 標簽: Ubuntu??C++??

資源簡介

C++寫的一個Ubuntu下擴展卡爾曼濾波程序，狀態方程為線性，觀測方程非線性，最后輸出圖片以便觀察是否收斂，有比較詳細的注釋，分享給大家參考。還會上傳一個matlab版本的。

資源截圖

代碼片段和文件信息 

#include?
#include?
#include?
#include?
#include?
#include?
using?namespace?std;
using?namespace?cv;

int?main（int?argc?char?**argv）?{
????
????int?k=0;
????Point?lasta?lastb?lastc;
????Eigen::Vector3d?x_up（030M_PI/6）??x_pre（000）??xn（00M_PI/6）?Rn（0.10.10.1）;??//沿x軸直線運動
????Eigen::Vector3d?s_con（0.9*cos（M_PI/6）?0.9*sin（M_PI/6）?0）;
????Eigen::Matrix3d?A=Eigen::Matrix3d::Identity（）;??//狀態轉移矩陣
????Eigen::Matrix3d?R??P?P_pre;?//狀態噪聲方差觀測噪聲方差總協方差
????Eigen::Matrix2d?Q?S;
????Eigen::Matrix?H;?//觀測方程雅克比矩陣
????Eigen::MatrixXd?K;?//卡爾曼增益
????Eigen::Vector2d?z（01）;
????RNG?gaus;??//高斯分布對象
????Mat?img（500500CV_8UC3Scalar（255255255））;
????R<<0.10000.10000.1;
????Q<<0.1000.1;
????P<<0.10000.10000.1;
????//開始迭代
????for（int?i=0;?i<300;?i++）
????{
?????double?gs=gaus.gaussian（1）;??//0均值，協方差為1的高斯分布中的隨機數
??????xn+=s_con+Rn*gs;???//真實值
??????z<??????
??????//預測
??????x_pre=x_

評論

共有 條評論