hand_commander.hpp

Go to the documentation of this file.

#pragma once

#include <ros/ros.h>
#include <vector>
#include <string>
#include <map>
#include <utility>

#include <boost/smart_ptr.hpp>
#include <boost/ptr_container/ptr_map.hpp>
#include <sr_robot_msgs/joint.h>
#include <urdf/model.h>

using ros::Publisher;
using ros::NodeHandle;

namespace shadowhandRosLib
{
  enum HandType
  {
    UNKNOWN,
    CAN,
    ETHERCAT
  };
}  // namespace shadowhandRosLib

namespace shadowrobot
{
class HandCommander
{
public:
  explicit HandCommander(const std::string &ns = "");

  ~HandCommander();

  void sendCommands(std::vector<sr_robot_msgs::joint> joint_vector);

  std::string get_controller_state_topic(std::string joint_name);

  std::pair<double, double> get_min_max(std::string joint_name);

  std::vector<std::string> get_all_joints();

private:
  NodeHandle node_;

  std::map<std::string, boost::shared_ptr<urdf::Joint> > all_joints;

  Publisher sr_hand_target_pub;
  boost::ptr_map<std::string, Publisher> sr_hand_target_pub_map;

  std::map<std::string, std::string> sr_hand_sub_topics;

  shadowhandRosLib::HandType hand_type;
  bool ethercat_controllers_found;

  void initializeEthercatHand();

  static const double TIMEOUT_TO_DETECT_CONTROLLER_MANAGER;
};  // end class ShadowhandSubscriber

}  // namespace shadowrobot

/* For the emacs weenies in the crowd.
Local Variables:
   c-basic-offset: 2
End:
*/