卡尔曼滤波C语言代码

157 篇文章 110 订阅 ¥79.90 ¥99.00
25 篇文章 0 订阅

代码如下:

#include "stdio.h"
#include "stdlib.h"
#include "math.h"
double frand() 
以下是一个使用C语言编写的卡尔曼滤波算法的示例代码: ```c #include "stdio.h" #include "stdlib.h" #include "math.h" #define kal_Q 0.001 /*过程噪声协方差,Q增大,动态响应变快,收敛稳定性变坏*/ #define kal_R 0.36 /*观测噪声协方差,R增大,动态响应变慢,收敛稳定性变好*/ double Kalman(double measure, int op_flg) { double x_mid, kg, p_mid; static double x_last = 0, p_last = 0; double x_now, p_now; if(op_flg) /*非初始化*/ { x_mid = x_last; p_mid = p_last + kal_Q; kg = p_mid / (p_mid + kal_R); x_now = x_mid + kg * (measure - x_mid); p_now = (1 - kg) * p_mid; p_last = p_now; x_last = x_now; } else { x_last = measure; p_last = kal_Q; } return x_now; } int main() { float z_real = {5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5}; //此处替换成实际传感器采集数据,采集数据填充可以做成滑动的,先入先出 float z_measure, x_now; int i; Kalman(z_real<span class="em">1</span><span class="em">2</span><span class="em">3</span> #### 引用[.reference_title] - *1* [卡尔曼滤波C语言代码](https://download.csdn.net/download/limbom/10779110)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v93^chatsearchT3_2"}}] [.reference_item style="max-width: 33.333333333333336%"] - *2* [卡尔曼滤波--C语言实现](https://blog.csdn.net/lijigang100/article/details/128827555)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v93^chatsearchT3_2"}}] [.reference_item style="max-width: 33.333333333333336%"] - *3* [C语言实现卡尔曼滤波(附完整源码)](https://blog.csdn.net/it_xiangqiang/article/details/130780336)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v93^chatsearchT3_2"}}] [.reference_item style="max-width: 33.333333333333336%"] [ .reference_list ]
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

打赏作者

道亦无名

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

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

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

打赏作者

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

抵扣说明:

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

余额充值