java 二维卡尔曼滤波_卡尔曼滤波（Kalman filtering）算法学习小记

动画和视频

一个例子

import numpy as np

# 模拟数据

t = np.linspace(1, 100, 100)

a = 0.5

position = (a * t ** 2) / 2

position_noise = position + np.random.normal(0, 120, size=(t.shape[0]))

import matplotlib.pyplot as plt

plt.plot(t, position, label='truth position')

plt.plot(t, position_noise, label='only use measured position')

# 初试的估计导弹的位置就直接用GPS测量的位置

predicts = [position_noise[0]]

position_predict = predicts[0]

predict_var = 0

odo_var = 120 ** 2 # 这是我们自己设定的位置测量仪器的方差，越大则测量值占比越低

v_std = 60 # 测量仪器的方差

for i in range(1, t.shape[0]):

dv = (position[i] - position[i - 1]) + np.random.normal(0, 50) # 模拟从IMU读取出的速度

position_predict = position_predict + dv # 利用上个时刻的位置和速度预测当前位置

predict_var += v_std ** 2 # 更新预测数据的方差

# 下面是Kalman滤波

position_predict = position_predict * odo_var / (predict_var + odo_var) + position_noise[i] * predict_var / (

predict_var + odo_var)

predict_var = (predict_var * odo_var) / (predict_var + odo_var) ** 2

predicts.append(position_predict)

plt.plot(t, predicts, label='kalman filtered position')

plt.legend()

plt.show()

java 二维卡尔曼滤波_卡尔曼滤波（Kalman filtering）算法学习小记相关推荐

java二维数组杨辉三角_java数组学习：使用二维数组输出杨辉三角
import java.util.Scanner; /* 输出二维数组"杨辉三角" i\j0 1 2 3 4 5 01 11 1 21 2 1 31 3 3 1 41 4 ...
java 二维表格_实现二维表
create or replace function getGoodsMsgForProtocol( str_in in varchar2,str_classId in varchar2)--分类字 ...
java二维数组的创建,java二维数组创建方法
java动态创建二维数组,从零学java笔录-第31篇图解二位数组在内存中存储,java二维数组动态赋值,java二维数组创建方法二维数组的定义 type arrayName[ ][ ]; typ ...
java二维数组杨辉三角_实验----Java的二维数组的应用及杨辉三角的编写
(1) 编写一个程序,生成一个10*10的二维随机整数数组,并将该数组的每行最大值保存于一个一维数组中,将每列平均值保存于另外一个一维数组中并分别输出. (2) 编程输出杨辉三角的前10行. 找出一个 ...
java 二维数组排序_二维数组排序
参考: https://www.cnblogs.com/rujianming/p/11779922.html https://blog.csdn.net/westwewe/article/detail ...
Atitit java 二维码识别图片识别
Atitit java 二维码识别图片识别 1.1. 解码1 1.2. 首先,我们先说一下二维码一共有40个尺寸.官方叫版本Version.1 1.3. 二维码的样例:2 1.4. 定位图案2 1. ...
java二维数组存储数据，从键盘上录入学生人数，考试科目数，以及每个学生每科分数，输出每个学生的最高分、最低分、总分、平均分
java二维数组存储数据,从键盘上录入学生人数,考试科目数,以及每个学生每科分数,输出每个学生的最高分.最低分.总分.平均分 import java.util.Scanner;/* * 二维数组存储数 ...
java二维数组的遍历
java二维数组的遍历 /* * java二维数组的遍历 * 二维数组,数组座位数组元素类型的数组,数组的数组 * */ public class Test14 {public static void ...
案例演示Python二维列表与Java二维数组
1.Python二维列表案例演示运行程序,结果如下: 2.案例演示Java二维数组 package net.hw.test;/*** 功能:二维数组用法示例* 作者:华卫* 日期:2013年12月1 ...
java二维码生成-谷歌（Google.zxing）开源二维码生成学习及实例
java二维码生成-谷歌(Google.zxing)开源二维码生成的实例及介绍这里我们使用比特矩阵(位矩阵)的QR码编码在缓冲图片上画出二维码实例有以下一个传入参数 OutputStream o ...

java 二维卡尔曼滤波_卡尔曼滤波（Kalman filtering）算法学习小记

java 二维卡尔曼滤波_卡尔曼滤波（Kalman filtering）算法学习小记相关推荐

最新文章

热门文章