Modified KF for change in direction