Exemplo n.º 1
0
        private PointF[] FilterPoint(PointF pt)
        {
            _syntheticData.State[0, 0] = pt.X;
            _syntheticData.State[1, 0] = pt.Y;

            var prediction = _kalman.Predict();

            var predictPoint = new PointF(prediction[0, 0], prediction[1, 0]);

            var estimated = _kalman.Correct(_syntheticData.GetMeasurement());

            var estimatedPoint = new PointF(estimated[0, 0], estimated[1, 0]);

            var results = new PointF[2];

            results[0] = predictPoint;
            results[1] = estimatedPoint;

            _syntheticData.GoToNextState();

            return(results);
        }