_filter.statePre = (Mat_<float>(4,1) << 0, 0, 0, 0);
_filter.statePost = (Mat_<float>(4,1) << 0, 0, 0, 0);
- _filter.transitionMatrix = (Mat_<float>(4,4) << 1, 0, 0.5f, 0, 0, 1, 0, 0.5f, 0, 0, 0.02f, 0, 0, 0, 0, 0.02f);
+ _filter.transitionMatrix = (Mat_<float>(4,4) << 1, 0, 0.25f, 0, 0, 1, 0, 0.25f, 0, 0, 0.02f, 0, 0, 0, 0, 0.02f);
_filter.processNoiseCov = (cv::Mat_<float>(4, 4) << 0.3f, 0, 0, 0, 0, 0.3f, 0, 0, 0, 0, 0.3f, 0, 0, 0, 0, 0.3f);
_filter.measurementMatrix = (cv::Mat_<float>(2, 4) << 1, 0, 0, 0, 0, 1, 0, 0);
_filter.measurementNoiseCov = cv::Mat::eye(2, 2, CV_32F);