Searching for bug inside EKF....