Adapted to new version of kf_yaw_kf