YarpOpenraveGrabber implement getCameraDescription

- roboticslab-uc3m/yarp-devices#244

Author: jgvictores

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());
 

libraries/YarpPlugins/YarpOpenraveGrabber/IFrameGrabberControlsImpl.cpp

@@ -11,7 +11,8 @@ namespace roboticslab
 
 bool YarpOpenraveGrabber::getCameraDescription(CameraDescriptor *camera)
 {
-    return false;
+    *camera = cameraDescriptor;
+    return true;
 }
 
 // ----------------------------------------------------------------------------

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;
 };