added LPF and velocity to simplePose