set_dynamics_mode_client.cpp

Go to the documentation of this file.

#include "ros/ros.h"
#include "microstrain_mips/SetDynamicsMode.h"
#include <cstdlib>


int main(int argc, char **argv){

  ros::init(argc, argv, "set_dynamics_mode_client");

  ros::NodeHandle n;
  ros::ServiceClient client = n.serviceClient<microstrain_mips::SetDynamicsMode>("SetDynamicsMode");
  microstrain_mips::SetDynamicsMode srv;

  srv.request.mode = atoll(argv[1]);

  if (client.call(srv))
  {
      if (srv.response.success)
      {
        ROS_INFO("success");
      }
  }
  else
  {
    ROS_INFO("Failed to call service");
  }
  return 0;
}