added accel to KF
added some visualization
added KF per particle