SAKF update

update to match SAKF filter