卡尔曼滤波
在卡尔曼滤波里,目标的当前状态估计考虑2个输入。一个是根据过去的状态估计当前的状态。如过去的位移为[0,3,6,9],则当前的状态估计就应该为12。一个是当前时刻的观测状态(即传感器读数、跟踪里的检测器检测到的位置等),因此实际中观测值是带有噪声的,不是百分百精准的。如需要估计物体的位移,则影响位移的因素有上一刻的位移,速度,外力(加速度)等。现在先忽略外力。根据过去的状态估计当前的状态如考虑状态向量xxx如下x=[位移速度]x = \left[ \begin{matrix} 位移\\









