added class KalmanFilter
implemented Kalman filter
calculating R matrix from variance in measurement noise
fixed kinematic transfer matrix
plotting orientation
zero velocity threshold filter
simplified state
updated Readme