Added boundary check for setting payload

include/ur_modern_driver/ur_driver.h

@@ -50,7 +50,7 @@ public:
 	void setFlag(unsigned int n, bool b);
 	void setDigitalOut(unsigned int n, bool b);
 	void setAnalogOut(unsigned int n, double f);
-	void setPayload(double m);
+	bool setPayload(double m);
 
 	void setMaxVel(double vel);
 	void setMinPayload(double m);

src/ur_driver.cpp

@@ -12,8 +12,10 @@
 #include "ur_modern_driver/ur_driver.h"
 
 UrDriver::UrDriver(std::condition_variable& msg_cond, std::string host,
-		unsigned int safety_count_max, double max_time_step, double max_vel, double min_payload, double max_payload ) :
+		unsigned int safety_count_max, double max_time_step, double max_vel,
-		maximum_time_step_(max_time_step), maximum_velocity_(max_vel), minimum_payload_(min_payload), maximum_payload_(max_payload) {
+		double min_payload, double max_payload) :
+		maximum_time_step_(max_time_step), maximum_velocity_(max_vel), minimum_payload_(
+				min_payload), maximum_payload_(max_payload) {
 	rt_interface_ = new UrRealtimeCommunication(msg_cond, host,
 			safety_count_max);
 
@@ -142,12 +144,15 @@ void UrDriver::setAnalogOut(unsigned int n, double f) {
 	rt_interface_->addCommandToQueue(buf);
 }
 
-void UrDriver::setPayload(double m) {
+bool UrDriver::setPayload(double m) {
-	char buf[256];
+	if ((m < maximum_payload_) && (m > minimum_payload_)) {
-	sprintf(buf, "sec setOut():\n\tset_payload(%1.3f)\nend\n", m);
+		char buf[256];
-	printf("%s", buf);
+		sprintf(buf, "sec setOut():\n\tset_payload(%1.3f)\nend\n", m);
-	rt_interface_->addCommandToQueue(buf);
+		printf("%s", buf);
-
+		rt_interface_->addCommandToQueue(buf);
+		return true;
+	} else
+		return false;
 }
 
 void UrDriver::setMaxVel(double vel) {

src/ur_ros_wrapper.cpp

@@ -68,7 +68,7 @@ public:
 		{ //Using a very high value in order to not limit execution of trajectories being sent from MoveIt!
 			double max_velocity = 10.;
 			if (ros::param::get("~max_velocity", max_velocity)) {
-				ROS_INFO(
+				ROS_DEBUG(
 						"Max velocity accepted by ur_driver: %f [rad/s]", max_velocity);
 				robot_.setMaxVel(max_velocity);
 			}
@@ -79,11 +79,11 @@ public:
 			double min_payload = 0.;
 			double max_payload = 1.;
 			if (ros::param::get("~min_payload", min_payload)) {
-				ROS_INFO(
+				ROS_DEBUG(
 						"Min payload accepted by ur_driver: %f [kg]", min_payload);
 			}
 			if (ros::param::get("~max_payload", max_payload)) {
-				ROS_INFO(
+				ROS_DEBUG(
 						"Max payload accepted by ur_driver: %f [kg]", max_payload);
 			}
 			robot_.setMinPayload(min_payload);
@@ -189,9 +189,11 @@ private:
 
 	bool setPayload(ur_msgs::SetPayloadRequest& req,
 			ur_msgs::SetPayloadResponse& resp) {
-		robot_.setPayload(req.payload);
+		if (robot_.setPayload(req.payload))
-		resp.success = true;
+			resp.success = true;
-		return true;
+		else
+			resp.success = true;
+		return resp.success;
 	}
 
 	bool validateJointNames() {