added cmd_vel_old_threshold param and logic to stop when the cmd_vel com...

...mand is too old