EKF: try removing cmd_vel input...