Searched refs:kalmanGain (Results 1 – 1 of 1) sorted by relevance
213 double kalmanGain[2]; in KalmanEstimateChannel() local251 kalmanGain[0] = Mh[0] / hMh_sigma; in KalmanEstimateChannel()252 kalmanGain[1] = Mh[1] / hMh_sigma; in KalmanEstimateChannel()257 _theta[0] += kalmanGain[0] * measureRes; in KalmanEstimateChannel()258 _theta[1] += kalmanGain[1] * measureRes; in KalmanEstimateChannel()267 _thetaCov[0][0] = (1 - kalmanGain[0] * deltaFSBytes) * t00 - in KalmanEstimateChannel()268 kalmanGain[0] * _thetaCov[1][0]; in KalmanEstimateChannel()269 _thetaCov[0][1] = (1 - kalmanGain[0] * deltaFSBytes) * t01 - in KalmanEstimateChannel()270 kalmanGain[0] * _thetaCov[1][1]; in KalmanEstimateChannel()271 _thetaCov[1][0] = _thetaCov[1][0] * (1 - kalmanGain[1]) - in KalmanEstimateChannel()[all …]