Added the publish_trajectory_command.cpp and publish_twist_command.cpp
files