其紧急……
卡尔曼滤波器
2视图(30天)
显示旧的评论
如何实现卡尔曼滤波器在锁相环吗?代码或算法是受欢迎的…
答案(1)
Ahmad Alnahlaui
2018年2月19日
首先你必须定义协方差矩阵。他们依靠测量和系统错误。Q = […];R = […];P = […];那么你应该计算先验的估计和先验估计误差的协方差矩阵。x1k + 1 = f (xk, u);P1 =广告* Pk *广告' + Q;现在你可以计算加权矩阵和最终的估计。L = P1 * C ' *发票(C * P1 * C + R); xk+1=x1k+1+L*((ZMeasurement-(x1k+1'*C'))'); Finally, you need to calculate the covariance matrices of the aposteriori estimation error. P=(eye(n)-L*C)*P1;