jngwe的博客

#include <stdlib.h>#include <stdio.h>float data[101][3] = { 0, -49.5300285913927, 22.0522882008860, 0, -47.3171283081363, 21.3171649980885, 0, -48.4247431409728, 23.1785056041819, 0, -46.9647519096169, 21.566.

一个简单说明这是我在做车辆速度估算中所用到的技术做个总结，并附上仿真代码。主要用途为，知道了每一帧小车的二维位置信息 (posX, posY)，经过kalman滤波，输出更新后的小车位置信息 (posX, posY)以及它分解速度信息 (Vx, Vy)。一、预测在首帧数据来之前，我们是不知道小车的状态的，所以随便猜一个它的初始状态（或者滤波后，滤波结果就是状态），X=[1, 1, 0, 0]'，(表示初始位置为(1, 1)，x,y方向的速度为(0, 0))，X是一个需要更新的量...