Obbart/universal_robots_ros_driver
1
0
Fork 0
mirror of https://gitlab.com/obbart/universal_robots_ros_driver.git synced 2026-04-10 10:00:48 +02:00
Code Releases Activity

Added ROS hooks for services

Browse Source
This commit is contained in:
Thomas Timm Andersen
2015-09-10 10:48:43 +02:00
parent b98e57a475
commit a7d3f78f0f
1 changed files with 9 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
src/ur_ros_wrapper.cpp
View File

@@ -32,15 +32,18 @@
class RosWrapper {
protected:
UrDriver robot_;
std::condition_variable msg_cond_;
ros::NodeHandle nh_;
actionlib::SimpleActionServer<control_msgs::FollowJointTrajectoryAction> as_;
actionlib::SimpleActionServer<control_msgs::FollowJointTrajectoryAction>::Goal goal_;
control_msgs::FollowJointTrajectoryFeedback feedback_;
control_msgs::FollowJointTrajectoryResult result_;
ros::Subscriber speedSub_;
UrDriver robot_;
ros::ServiceServer ioSrv_;
ros::ServiceServer payloadSrv_;
std::thread* rt_publish_thread_;
std::condition_variable msg_cond_;
public:
RosWrapper(std::string host) :
as_(nh_, "follow_joint_trajectory", false), robot_(msg_cond_, host) {
@@ -71,6 +74,9 @@ public:
speedSub_ = nh_.subscribe("joint_speed", 1, &RosWrapper::speedInterface,
this);
ioSrv_ = nh_.advertiseService("ur_driver/set_io", &RosWrapper::setIO, this);
payloadSrv_ = nh_.advertiseService("ur_driver/set_payload", &RosWrapper::setPayload, this);
rt_publish_thread_ = new std::thread(
boost::bind(&RosWrapper::publishRTMsg, this));
ROS_INFO("The action server for this driver has been started");
@@ -145,7 +151,7 @@ private:
return resp.success;
}
bool setPayloaf(ur_msgs::SetPayloadRequest& req,
bool setPayload(ur_msgs::SetPayloadRequest& req,
ur_msgs::SetPayloadResponse& resp) {
robot_.setPayloaf(req.payload);
resp.success = true;