take example x, xdot as sin, cos; remove dampening
Merge branch 'master' of github.com:fbmnds/KalmanFilter