extracted lambda coefficient
added better process error covariance
added angular acceleration to state transition