rtt_ros_msgs/rtt_ros_deployment: added service eval (rtt_ros_msgs/Eval) to the rosdeployment service

This service evaluates arbitrary commands in the scripting service of the deployer.

Author: meyerj

rtt_ros_msgs/CMakeLists.txt

@@ -37,6 +37,7 @@ find_package(catkin REQUIRED COMPONENTS message_generation std_msgs)
 ## Generate services in the 'srv' folder
 add_service_files(
   FILES
+  Eval.srv
   RunScript.srv
   GetPeerList.srv
   )

rtt_ros_msgs/srv/Eval.srv

@@ -0,0 +1,3 @@
+string code
+---
+bool success

rtt_rosdeployment/CMakeLists.txt

@@ -8,7 +8,7 @@ include_directories(${catkin_INCLUDE_DIRS})
 orocos_use_package(ocl-deployment)
 
 orocos_plugin(rtt_rosdeployment src/rtt_rosdeployment_service.cpp)
-target_link_libraries(rtt_rosdeployment ${catkin_LIBRARIES})
+target_link_libraries(rtt_rosdeployment ${catkin_LIBRARIES} ${OROCOS-RTT_RTT-SCRIPTING_LIBRARY})
 
 orocos_generate_package(
   DEPENDS rtt_ros_msgs

rtt_rosdeployment/package.xml

@@ -25,7 +25,10 @@
   <export>
     <rtt_ros>
       <plugin_depend>rtt_rosnode</plugin_depend>
-      <plugin_depend>rtt_ros_msgs</plugin_depend>
+      <!--
+        rtt_ros_msgs is not an RTT plugin
+        <plugin_depend>rtt_ros_msgs</plugin_depend>
+      -->
     </rtt_ros>
   </export>
 </package>

rtt_rosdeployment/src/rtt_rosdeployment_service.cpp

@@ -3,7 +3,9 @@
 #include <rtt/plugin/Plugin.hpp>
 #include <rtt/plugin/ServicePlugin.hpp>
 #include <rtt/internal/GlobalService.hpp>
+#include <rtt/scripting/Scripting.hpp>
 
+#include <rtt_ros_msgs/Eval.h>
 #include <rtt_ros_msgs/RunScript.h>
 #include <rtt_ros_msgs/GetPeerList.h>
 
@@ -24,16 +26,23 @@ class ROSDeploymentService : public RTT::Service
 
   ros::NodeHandle nh_;
 
+  ros::ServiceServer eval_service_;
   ros::ServiceServer run_script_service_;
   ros::ServiceServer get_peer_list_service_;
 
+  bool eval_cb(
+      rtt_ros_msgs::Eval::Request& request,
+      rtt_ros_msgs::Eval::Response& response);
+
   bool run_script_cb(
       rtt_ros_msgs::RunScript::Request& request,
       rtt_ros_msgs::RunScript::Response& response);
 
   bool get_peer_list_cb(
       rtt_ros_msgs::GetPeerList::Request& request,
       rtt_ros_msgs::GetPeerList::Response& response);
+
+  RTT::OperationCaller<bool(std::string const&)> eval_;
 };
 
 
@@ -44,13 +53,25 @@ ROSDeploymentService::ROSDeploymentService(OCL::DeploymentComponent* deployer) :
 {
   if(deployer_) {
     // Create services
+    eval_service_ = nh_.advertiseService("eval",&ROSDeploymentService::eval_cb,this);
     run_script_service_ = nh_.advertiseService("run_script",&ROSDeploymentService::run_script_cb,this);
     get_peer_list_service_ = nh_.advertiseService("get_peer_list",&ROSDeploymentService::get_peer_list_cb,this);
+
+    eval_ = deployer_->getProvider<RTT::Scripting>("scripting")->eval;
   } else {
     RTT::log(RTT::Error) << "Attempted to load the rosdeployment service on a TaskContext which is not an OCL::DeploymentComponent. No ROS services will be advertised." << RTT::endlog();
   }
 }
 
+bool ROSDeploymentService::eval_cb(
+    rtt_ros_msgs::Eval::Request& request,
+    rtt_ros_msgs::Eval::Response& response)
+{
+  if (!eval_.ready()) return false;
+  response.success = eval_(request.code);
+  return true;
+}
+
 bool ROSDeploymentService::run_script_cb(
     rtt_ros_msgs::RunScript::Request& request,
     rtt_ros_msgs::RunScript::Response& response)