modify not to return when set_odom_cmd is failed
Merge branch 'issue194' of github.com:irvs/ros_tms into issue194