Added a command velocity safety node