Implemented KF naively