YarpOpenraveGrabber implement getCameraDescription

- roboticslab-uc3m/yarp-devices#244
roboticslab-uc3m · Feb 12, 2020 · 72dab2a · 72dab2a
1 parent c68d11d
commit 72dab2a
Show file tree

Hide file tree

Showing 3 changed files with 11 additions and 5 deletions.
diff --git a/libraries/YarpPlugins/YarpOpenraveGrabber/DeviceDriverImpl.cpp b/libraries/YarpPlugins/YarpOpenraveGrabber/DeviceDriverImpl.cpp
@@ -45,9 +45,11 @@ bool YarpOpenraveGrabber::open(yarp::os::Searchable& config)
 
     sensorBasePtr = vectorOfSensorPtr.at(sensorIndex)->GetSensor();
 
-    std::string tipo = sensorBasePtr->GetName();
+    std::string sensorName = sensorBasePtr->GetName();
 
-    printf("Sensor %d name: %s\n",sensorIndex,tipo.c_str());
+    printf("Sensor %d name: %s\n",sensorIndex,sensorName.c_str());
+    cameraDescriptor.deviceDescription = sensorName;
+    cameraDescriptor.busType = BUS_UNKNOWN;
 
     // printf("Sensor %d description: %s\n",sensorIter,psensorbase->GetDescription().c_str());
 

diff --git a/libraries/YarpPlugins/YarpOpenraveGrabber/IFrameGrabberControlsImpl.cpp b/libraries/YarpPlugins/YarpOpenraveGrabber/IFrameGrabberControlsImpl.cpp
@@ -11,7 +11,8 @@ namespace roboticslab
 
 bool YarpOpenraveGrabber::getCameraDescription(CameraDescriptor *camera)
 {
-    return false;
+    *camera = cameraDescriptor;
+    return true;
 }
 
 // ----------------------------------------------------------------------------

diff --git a/libraries/YarpPlugins/YarpOpenraveGrabber/YarpOpenraveGrabber.hpp b/libraries/YarpPlugins/YarpOpenraveGrabber/YarpOpenraveGrabber.hpp
@@ -83,14 +83,17 @@ class YarpOpenraveGrabber : YarpOpenraveBase,
 
 private:
 
-    // General Grabber parameters //
+    // General Grabber parameters
     int _height, _width;
 
-    //OpenRAVE//
+    // OpenRAVE
     OpenRAVE::SensorBasePtr sensorBasePtr;
     boost::shared_ptr<OpenRAVE::SensorBase::CameraSensorData> sensorDataPtr;
     boost::shared_ptr<OpenRAVE::SensorBase::CameraGeomData> modGeomDataPtr;
 
+    // YARP
+    CameraDescriptor cameraDescriptor;
+
     static const int NOT_SET;
 };