python卡尔曼滤波 库_OpenCV卡尔曼滤波python

下面的kalman.py代码是github中OpenCV 3.2 source中包含的示例。如果需要，应该很容易将语法改回2.4。#!/usr/bin/env python

"""

Tracking of rotating point.

Rotation speed is constant.

Both state and measurements vectors are 1D (a point angle),

Measurement is the real point angle + gaussian noise.

The real and the estimated points are connected with yellow line segment,

the real and the measured points are connected with red line segment.

(if Kalman filter works correctly,

the yellow segment should be shorter than the red one).

Pressing any key (except ESC) will reset the tracking with a different speed.

Pressing ESC will stop the program.

"""

# Python 2/3 compatibility

import sys

PY3 = sys.version_info[0] == 3

if PY3:

long = int

import cv2

from math import cos, sin, sqr