modify not to return when set_odom_cmd is failed

when set_odom_cmd is failed, RP trust robot's odometry