文件名称:KalmanGain
介绍说明－－下载内容均来自于网络，请自行研究使用
卡尔曼滤波在单片机上的应用
KalmanGain = EstimateCovariance * sqrt( 1 / ( EstimateCovariance * EstimateCovariance + MeasureCovariance * MeasureCovariance ))；
//计算本次滤波估计值
EstimateValue = EstimateValue + KalmanGain*（ Measure – EstimateValue ）；
//更新估计协方差
EstimateCovariance = sqrt(1 - KalmanGain) * EstimateCovariance
//更新测量方差
MeasureCovariance = sqrt(1 - KalmanGain) * MeasureCovariance
//返回估计值
return EstimateValue
-Kalman filter KalmanGain = EstimateCovariance* sqrt (1/(EstimateCovariance* EstimateCovariance+ MeasureCovariance* MeasureCovariance))
//Calculate the estimated value of this filter
EstimateValue = EstimateValue+ KalmanGain* (Measure- EstimateValue)
//Update the covariance
EstimateCovariance = sqrt (1- KalmanGain)* EstimateCovariance
//Update the measurement variance
MeasureCovariance = sqrt (1- KalmanGain)* MeasureCovariance
//Returns the estimated value
return EstimateValue
KalmanGain = EstimateCovariance * sqrt( 1 / ( EstimateCovariance * EstimateCovariance + MeasureCovariance * MeasureCovariance ))；
//计算本次滤波估计值
EstimateValue = EstimateValue + KalmanGain*（ Measure – EstimateValue ）；
//更新估计协方差
EstimateCovariance = sqrt(1 - KalmanGain) * EstimateCovariance
//更新测量方差
MeasureCovariance = sqrt(1 - KalmanGain) * MeasureCovariance
//返回估计值
return EstimateValue
-Kalman filter KalmanGain = EstimateCovariance* sqrt (1/(EstimateCovariance* EstimateCovariance+ MeasureCovariance* MeasureCovariance))
//Calculate the estimated value of this filter
EstimateValue = EstimateValue+ KalmanGain* (Measure- EstimateValue)
//Update the covariance
EstimateCovariance = sqrt (1- KalmanGain)* EstimateCovariance
//Update the measurement variance
MeasureCovariance = sqrt (1- KalmanGain)* MeasureCovariance
//Returns the estimated value
return EstimateValue
(系统自动生成,下载前可以参看下载内容)
下载文件列表
说明.txt